A dynamic programming approach to trajectory planning of robotic manipulators

This paper presents a solution to the problem of minimizing the cost of moving a robotic manipulator along a specified geometric path subject to input torque/force constraints, taking the coupled, nonlinear dynamics of the manipulator into account. The proposed method uses dynamic programming (DP) to find the positions, velocities, accelerations, and torques that minimize cost. Since the use of parametric functions reduces the dimension of the state space from 2n for an n - jointed manipulator, to two, the DP method does not suffer from the "curse of dimensionality." While maintaining the elegance of our previous trajectory planning method, we have developed the DP method for the general case where 1) the actuator torque limits are dependent on one another, 2) the cost functions can have an arbitrary form, and 3) there are constraints on the jerk, or derivative of the acceleration. Also, we have shown that the DP solution converges as the grid size decreases. As numerical examples, the trajectory planning method is simulated for the first three joints of the PACS arm, which is a cylindrical arm manufactured by the Bendix Corporation.

[1]  R. Bellman.  FUNCTIONAL EQUATIONS IN THE THEORY OF DYNAMIC PROGRAMMING. VI. A DIRECT CONVERGENCE PROOF , 1957 .

[2]  Daniel E. Whitney,et al.  Resolved Motion Rate Control of Manipulators and Human Prostheses , 1969 .

[3]  Donald E. Kirk,et al.  Optimal control theory : an introduction , 1970 .

[4]  J. Y. S. Luh,et al.  Resolved-acceleration control of mechanical manipulators , 1980 .

[5]  C. Lin,et al.  Optimum Path Planning for Mechanical Manipulators , 1981 .

[6]  R. Paul.  Robot manipulators : mathematics, programming, and control : the computer control of robot manipulators , 1981 .

[7]  J. S. Luh,et al.  Collision-free path planning for industrial robots , 1982, 1982 21st IEEE Conference on Decision and Control.

[8]  C. Lin,et al.  Formulation and optimization of cubic polynomial joint trajectories for industrial robots , 1983 .

[9]  Kang Shin,et al.  An efficient robot arm control under geometric path constraints , 1983, The 22nd IEEE Conference on Decision and Control.

[10]  S. Dubowsky,et al.  On the Optimal Control of Robotic Manipulators with Actuator Constraints , 1983, 1983 American Control Conference.

[11]  Tomás Lozano-Pérez,et al.  Spatial Planning: A Configuration Space Approach , 1983, IEEE Transactions on Computers.

[12]  J. Y. S. Luh,et al.  Minimum distance collision-free path planning for industrial robots with a prismatic joint , 1984 .

[13]  Kang G. Shin,et al.  Open-loop minimum-time control of mechanical manipulators and its application , 1984 .

[14]  Moshe Shoham.  The Mechanical Arm , 1984 .

[15]  Kang G. Shin,et al.  Minimum-time control of robotic manipulators with geometric path constraints , 1985 .