Velocity optimization algorithm of 4-DOF robot end-effectors
- 86 Downloads
To solve the problem velocity control for robot end-effectors trajectory planning in the Cartesian space, this paper studied the algorithm of the linear acceleration and deceleration. Moreover, it proposed a velocity optimization algorithm based on the displacement equivalent. Adjusting the speed size of the acceleration and deceleration, the algorithm reduced the velocity mutation due to the discretized interpolation equation. The algorithm then was applied to the linear and circular interpolation of 4-degree of freedom industrial robots, establishing the forward and inverse kinematics equation based on Denavit–Hartenberg (D–H) coordinate system with implementing the optimization algorithm in the motion control system. Next, the velocity of the end-effectors was tested using the acceleration sensor and data logger. The results of simulation and experiment showed that velocity optimization algorithm eliminated the acceleration point and decreased the deceleration point on the velocity mutation.
KeywordsDisplacement equivalent Velocity control Linear interpolation Circular interpolation
This work is funded by Zhejiang Province Public Welfare Technology Application Projects of China (2017C31036), and National Natural Science Foundation of China (NSFC) (U1609205, 51675488, 51307151), and Doctoral Research Foundation of Zhejiang Sci-Tech University (13022155-Y), and Zhejiang Province New Century 151 Project of China (11130031511703), and Zhejiang Province Key Major of Mechanic Engineering (ZSTUME01B07), and Zhejiang Provincial Natural Science Foundation of China (LY18E070006, LY18E050016).
- 1.Chen, Y., Wang, T., Wei, H., et al.: Linear and S-shape acceleration and deceleration for CNC machine tools. China Mech. Eng. 17(15), 1600–1604 (2006)Google Scholar
- 2.Chen, Y., Wei, H., Wang, Q.: Sampled-data algorithm of linear and S shape acceleration and deceleration for CNC controller. China Mech. Eng. 21(5), 567–570 (2010)Google Scholar
- 3.Yin, J., Luo, F.: Equivalent transformation algorithm for motion time periodization of acceleration and deceleration before interpolation. China Mech. Eng. 25(24), 3320–3325 (2014)Google Scholar
- 6.Liu, P., Yang, M., Song, K., et al.: Study of S-curve’s application on manipulator’s trajectory interpolation algorithm. Manuf. Autom. 34(10), 4–11 (2012)Google Scholar
- 7.Leng, H., Wu, Y., Pan, X.: Velocity planning algorithm for high speed machining of micro line blocks based on cubic polynomial model. Comput. Integr. Manuf. Syst. 14(2), 336–340 (2008)Google Scholar
- 9.Zheng, K., Zhong, H.: Velocity control method of 5-axis simultaneous computerized numerical control system. Comput. Integr. Manuf. Syst. 13(5), 950–966 (2007)Google Scholar
- 10.Wang, Y., Xiao, L., Zeng, S., et al.: An optimal federate model and solution for high-speed machining of small line blocks with look-ahead. J. Shanghai Jiaotong Univ. 38(6), 901–904 (2004)Google Scholar
- 11.Li, J., He, S., Wu, H.: Linear interpolation algorithm and its application in robot. J. Mech. Electr. Eng. 32(7), 966–970 (2015)Google Scholar
- 12.Leng, H., Wu, Y., Pan, X.: New single segment acceleration and deceleration control method based on cubic polynomial model. J. Zhejiang Univ. (Eng. Sci.) 42(8), 1440–1444 (2008)Google Scholar
- 16.Chen, G., Hu, X., Wang, M.: Trajectory planning and applications for the circular motion of manipulator. J. Huazhong Univ. Sci. Technol. (Nat. Sci. Ed.) 33(11), 63–66 (2005)Google Scholar