Abstract
This paper presents a practical time-optimal and smooth trajectory planning algorithm and then applies it to robot manipulators. The proposed algorithm uses the time-optimal theory based on the dynamics model to plan the robot’s motion trajectory, constructs the trajectory optimization model under the constraints of the geometric path and joint torque, and dynamically selects the optimal trajectory parameters during the solving process to prominently improve the robot’s motion speed. Moreover, the proposed algorithm utilizes the input shaping algorithm instead of the jerk constraint in the trajectory optimization model to achieve a smooth trajectory. The input shaping of trajectory parameters during postprocessing not only suppresses the residual vibration of the robot but also takes the signal delay caused by traditional input shaping into account. The combination of these algorithms makes the proposed time-optimal and smooth trajectory planning algorithm ensure absolute time optimality and achieve a smooth trajectory. The results of an experiment on a six-degree-of-freedom industrial robot indicate the validity of the proposed algorithm.
Similar content being viewed by others
References
J. E. Bobrow, S. Dubowsky, and J. S. Gibson, “Timeoptimal control of robotic manipulators along specified paths,” The International Journal of Robotics Research, vol. 4, no. 3, pp. 3–17, 1985.
K. G. Shin and N. D. Mckay, “Minimum-time control of robotic manipulators with geometric path constraints,” IEEE Transactions on Automatic Control, vol. 30, no. 6, pp. 531–541, 1985.
T. Kunz and M. Stilman, “Time-optimal trajectory generation for path following with bounded acceleration and velocity,” Robot: Science and Systems Conference, vol. 8, pp. 9–13, 2012.
D. Verscheure, B. Demeulenaere, J. Swevers, J. de Schutter, and M. Diehl, “Time-optimal path tracking for robots: a convex optimization approach,” IEEE Transactions on Automatic Control, vol. 54, no. 10, pp. 2318–2327, 2009.
H. Pham and Q. C. Pham, “A new approach to timeoptimal path parameterization based on reachability analysis,” IEEE Transactions on Robotics, pp. 1–15, 2018.
R. Verschueren, N. V. Duijkeren, J. Swevers, and M. Diehl, “Time-optimal motion planning for n-DOF robot manipulators using a path-parametric system refor-mulation,” Proc. of American Control Conference, IEEE, 2016.
P. Shen, X. Zhang, and Y. Fang, “Complete and time-optimal path-constrained trajectory planning with torque and velocity constraints: theory and applications,” IEEE/ASME Transactions on Mechatronics, pp. 1–11, 2018.
Q. C. Pham and O. Stasse, “Time-optimal path parameterization for redundantly actuated robots: a numerical integration approach,” IEEE/ASME Transactions on Mechatronics, vol. 20, no. 6, pp. 3257–3263, 2015.
J.-J. E. Slotine and H. S. Yang, “Improving the efficiency of time-optimal path following algorith-ms,” IEEE Transactions on Robotics & Automation, vol. 5, no. 1, pp. 118–124, 2002.
Q. C. Pham, “A general, fast, and robust implementation of the time-optimal path parameterization algorithm,” IEEE Transactions on Robotics, vol. 30, no. 6, pp. 1533–1540, 2014.
D. Constantinescu and E. A. Croft, “Smooth and timeoptimal trajectory planning for industrial manipulators along specified paths,” Journal of Robotic Systems, vol. 17, no. 5, pp. 233–249, 2000.
A. Gasparetto, A. Lanzutti, R. Vidoni, and V. Zanotto, “Experimental validation and comparative analysis of optimal time-jerk algorithms for trajectory planning,” Robotics and Computer Integrated Manufacturing, vol. 28, no. 2, pp. 164–181, 2012.
H. Liu, X. Lai, and W. Wu, “Time-optimal and jerkcontinuous trajectory planning for robot manipul-ators with kinematic constraints,” Robotics and Computer-integrated Manufacturing, vol. 29, no. 2, pp. 309–317, 2013.
L. Liu, C. Chen, X. Zhao, and Y. Li, “Smooth trajectory planning for a parallel manipulator with joint friction and jerk constraints,” International Journal of Control, Automation and Systems, vol. 14, no. 4, pp. 1022–1036, 2016.
Y. S. Lu and Y. Y. Lin, “Smooth motion control of rigid robotic manipulators with constraints on high-order kinematic variables,” Mechatronics, no. 49, pp. 11–25, 2018.
O. J. M. Smith, “Posicast control of damped oscillatory systems,” Proc. the IRE, vol. 45, no. 9, pp. 1249–1255, 1957.
N. Singer and W. Seering, “Preshaping command inputs to reduce system vibration,” ASME Journal of Dynamic System, Measurement and Control, no. 12, pp. 76–82, 1990.
W. Singhose, W. Seering, and N. Singer, “Residual vibration reduction using vector diagrams to generate shaped inputs,” Journal of Mechanical Design, vol. 116, pp. 654–659, 1994.
W. P. Li, B. Luo, and H. Huang, “Active vibration control of flexible joint manipulator using input shaping and adaptive parameter auto disturbance rejection controller,” Journal of Sound and Vibration, vol. 363, pp. 97–125, 2015.
A. Tzes and S. Yurkovich, “An adaptive input shaping control scheme for vibration suppression in slewing flexible structures,” IEEE Transactions on Control Systems Technology, vol. 1, no. 2, pp. 114–121, 2015.
T. Solatges, S. Rubrecht, M. Rognant, and P. Bidaud, “Adaptive input shaper design for flexible robot manipulators,” Proc. of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 444–449, 2017.
C. D. Sousa and C. Rui, “Physical feasibility of robot base inertial parameter identification: a linear-matrix inequality approach,” International Journal of Robotics Research, vol. 33, no. 6, pp. 931–944, 2014.
B. Subudhi and A. S. Morris, “Dynamic modeling, simulation and control of a manipulator with flexible links and joints,” Robotics & Autonomous Systems, vol. 41, no. 4, pp. 257–270, 2002.
W. Singhose, “Command shaping for flexible systems: a review of the first 50 years,” International Journal of Precision Engineering & Manufacturing, vol. 10, no. 4, pp. 153–168, 2009.
M. J. Maghsoudi, Z. Mohamed, M. O. Tokhi, A. R. Husain, and M. S. Z. Abidin, “Control of a gantry crane using input-shaping schemes with distributed delay,” Transactions of the Institute of Measurement and Control, vol. 39, no. 3, pp. 361–370, 2017.
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher’s Note Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Recommended by Associate Editor Juhoon Back under the direction of Editor Myo Taeg Lim. This work was supported by the National Science and Technology Major Project of China (Grant No. 2015ZX04005006) and by the Major Project of Science and Technology Plan of Guangdong Province (Grant No. 2014B090920002).
Tie Zhang is a Professor and Doctoral Supervisor at the South China University of Technology. He received his B.S. degree in mechanical engineering from the North University of China in 1989, and his M.S. and Ph.D. degrees both in mechanical engineering from the South China University of Technology, in 1992 and 2001, respectively. His research interests include robot manipulator modeling and control, robotics application, and cooperative robots.
Meihui Zhang is currently working toward an M.S. degree in mechanical engineering at the South China University of Technology. He received his B.S. degree in mechanical engineering from the Taiyuan University of Technology in 2016. His research interests include robot manipulator modeling and control, trajectory planning and vibration control.
Yanbiao Zou is an Associate Professor at the South China University of Technology. He received his B.S. degree in electro-mechanical engineering from the China University of Petroleum in 1991, and a Ph.D. degree in mechanical design and theory from the South China University of Technology in 2005. His research interests include robot manipulator modeling and control, machine vision and machine learning.
Rights and permissions
About this article
Cite this article
Zhang, T., Zhang, M. & Zou, Y. Time-optimal and Smooth Trajectory Planning for Robot Manipulators. Int. J. Control Autom. Syst. 19, 521–531 (2021). https://doi.org/10.1007/s12555-019-0703-3
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s12555-019-0703-3