Trajectory Planning for Industrial Robot Manipulators Considering Assigned Velocity and Allowance Under Joint Acceleration Limit

  • Munasinghe, S.Rohan (Department of Advanced Systems Control Engineering, Graduate School of Science and Engineering, Saga University) ;
  • Nakamura, Masatoshi (Department of Advanced Systems Control Engineering, Graduate School of Science and Engineering, Saga University) ;
  • Goto, Satoru (Department of Advanced Systems Control Engineering, Graduate School of Science and Engineering, Saga University) ;
  • Kyura, Nobuhiro (Department of Electrical Engineering, Kinki University)
  • Published : 2003.03.01

Abstract

This paper presents an effective trajectory planning algorithm for industrial robot manipulators. Given the end-effector trajectory in Cartesian space, together with the relevant constraints and task specifications, the proposed method is capable of planning the optimum end-effector trajectory. The proposed trajectory planning algorithm considers the joint acceleration limit, end-effector velocity limits, and trajectory allowance. A feedforward compensator is also incorporated in the proposed algorithm to counteract the delay in joint dynamics. The algorithm is carefully designed so that it can be directly adopted with the existing industrial manipulators. The proposed algorithm can be easily programmed for various tasks given the specifications and constraints. A three-dimensional test trajectory was planned with the proposed algorithm and tested with the Performer MK3s industrial manipulator. The results verified effective manipulator performance within the constraints.

Keywords

References

  1. IBM J. Res. Develop. v.23 no.4 Planning and execution of straight line manipulator trajectories R. H. Taylor https://doi.org/10.1147/rd.234.0424
  2. IEEE Trans. on Sys., Man, and Cyber. v.9 no.11 Manipulator Cartesian path control R. Paul https://doi.org/10.1109/TSMC.1979.4310109
  3. Trans. on the ASME v.102 Optimum path planning for mechanical manipulators J. Y. S. Luh;C. S. Lin
  4. IEEE/ASME Trans. on Mechatronics v.5 no.4 Enhanced control of SCARA robot under torque saturation constraint M. Nakamura;S. R. Munasinghe;S. Goto;N. Kyura https://doi.org/10.1109/3516.891055
  5. IEEE Int. Conf. on Syst., Man and Syber.(SMC'99) High speed precise control of robot arms with assigned speed under torque constraint by trajectory generation in joint coordinates S. R. Munasinghe;M. Nakamura;S. Goto;S. Aoki;N. Kyura
  6. IEEE Trans. on Syst., Man, and Cyber. v.31 no.2 Optimum contouring of industrial robot arms under assigned velocity and torque constraints S. R. Munasinghe;M. Nakamura;S. Goto;N. Kyura https://doi.org/10.1109/5326.941840
  7. IEEE Trans. on Automat. Cntr. v.30 no.6 Minimum-time control of robotic manipulators with geometric path constraints K. G. Shin;N. D. Mckay https://doi.org/10.1109/TAC.1985.1104009
  8. IEEE Trans. on Automat. Cntr. v.31 no.6 A dynamic programming approach to trajectory planning of robotic manipulators K. G. Shin;N. D. Mckay https://doi.org/10.1109/TAC.1986.1104317
  9. Robotics; Control, Sensing, Vision and Intelligence K. S. Fu;R. C. Gonzalez;C. S. G. Lee
  10. IEEE Trans. on Syst., Man and Cyber. :Cybernetics v.28 no.2 A comparative study of three methods for robot kinematics N. A. Aspragathos;J. K. Dimitros https://doi.org/10.1109/3477.662755
  11. Int. Journal of Control v.72 no.16 Robust control of robot manipulators: a survey H. G. Sage;M. F. D. Mathelin;E. Ostertag https://doi.org/10.1080/002071799220137
  12. IEEE Trans. on Mechatro. v.2 no.3 Second-order kinematic control of robot manipulators with Jacobian damped last-squares inverse: Theory and experiments F. Caccavale;S. Chiaverini;B. Siciliano
  13. IEEE Trans. on Automat. Cntr. v.28 no.12 Formulation and optimization of cubic polynomial joint trajectories for industrial robots C. S. Lin;P. R. Chang;J. Y. S. Luh https://doi.org/10.1109/TAC.1983.1103181
  14. Proc. Annual Conf. of the Soc. of Inst. and Cntlr. Engineers (SICE), CDROM Determination of maximum tangential velocity at trajectory corners in robot manipulator operation under torque constraint S. R. Munasinghe;M. Nakamura
  15. Proc. Annual Conf. of the Soc. of Inst. and Cntlr. Engineers (SICE), Kyushu Branch Pole selection for modified taught data method for mechatronic servo systems by considering bounded control input S. R. Munasinghe;M. Nakamura;S. Goto;N. Kyura