Trajectory Planning for a Delta Robot Based on PH Curve
SU Tingting1,2, ZHANG Haojian1,2, WANG Yunkuan1,2, QIN Xiaofei3, WU Shaohong1, ZHENG Jun1, CHANG Jianzhang4, WANG Zhizeng5, SUN Hongsheng4
1. Institute of Automation, Chinese Academy of Sciences, Beijing 100190, China;
2. University of Chinese Academy of Sciences, Beijing 100049, China;
3. University of Shanghai for Science and Technology, Shanghai 200093, China;
4. Bohai Shipyard Group Co., Ltd, Huludao 125004, China;
5. Huludao Special Equipment Supervision and Inspection Institute, Huludao 125000, China
Abstract:A trajectory planning method based on PH (Pythagorean Hodographs) curve is proposed to solve the problem that the trajectory of Delta parallel robot in Cartesian space is not smooth when performing high-speed operations. The pick-and-place operation trajectory is determined by applying the PH curve to smoothing the transition portion between the vertical movement and the horizontal movement. The position of the trajectory interpolation point is determined by the trajectory planning for the one-dimensional curve displacement based on the polynomial motion law. In order to minimize the movement cycle time of the pick-and-place operation, the PH curve parameters are optimized to smooth the motion trajectory. The simulation results show that the pick-and-place operation can be completed with a short period, smooth trajectory and stable motion by the proposed method. The experimental results show that the maximum pickup speed is 90 times per minute, which achieves high-speed operations of parallel robots.
[1] Vischer P, Clavel R. Kinematic calibration of the parallel Delta robot[J]. Robotica, 1998, 16(2):207-218.
[2] Rey L, Clavel R. The Delta parallel robot[C]//1st European-American Forum on Parallel Kinematic Machines. Surrey, UK:Springer, 1999:401-417.
[3] Pierrot F, Reynaud C, Fournier A. Delta:A simple and efficient parallel robot[J]. Robotica, 1990, 8(2):105-109.
[4] 冯李航,张为公,龚宗洋,等.Delta系列并联机器人研究进展与现状[J].机器人,2014,36(3):375-384. Feng L H, Zhang W G, Gong Z Y, et al. Developments of Delta-like parallel manipulators-A review[J]. Robot, 2014, 36(3):375-384.
[5] 梅莱.并联机器人[M].2版.北京:机械工业出版社,2014:1-267. Merlet J P. Parallel robots[M]. 2nd ed. Beijing:China Machine Press, 2014:1-267.
[6] 张利敏.基于动力学指标的Delta高速并联机械手集成优化设计方法研究[D].天津:天津大学,2011.Zhang L M. Integrated optimal design of Delta robot using dynamic performance indices[D]. Tianjin:Tianjin University, 2011.
[7] 解则晓,商大伟,任凭.基于Lamé 曲线的Delta并联机器人拾放操作轨迹的优化与试验验证[J].机械工程学报,2015,51(1):52-59. Xie Z X, Shang D W, Ren P. Optimization and experimental verification of pick-and-place trajectory for a Delta parallel robot based on Lamé curves[J]. Journal of Mechanical Engineering, 2015, 51(1):52-59.
[8] 张祥.高速轻型并联机械手控制方法研究[D].天津:天津大学,2005. Zhang X. Research on control method of high speed lightweight parallel manipulator[D]. Tianjin:Tianjin University, 2005.
[9] 王怿,祝小平,周洲,等.3维动态环境下的无人机路径跟踪算法[J].机器人,2014,36(1):83-91.Wang Y, Zhu X P, Zhou Z, et al. UAV path following in 3-D dynamic environment[J]. Robot, 2014, 36(1):83-91.
[10] Jahanpour J, Imani B M. Real-time P-H curve CNC interpolators for high speed cornering[J]. International Journal of Advanced Manufacturing Technology, 2008, 39(3-4):302-316.
[11] Farouki R T, Sakkalis T. Pythagorean hodographs[J]. IBM Journal of Research and Development, 1990, 34(5):736-752.
[12] Shi J, Bi Q Z, Wang Y H, et al. Development of real-time look-ahead methodology based on quintic PH curve with G2 continuity for high-speed machining[J]. Applied Mechanics and Materials, 2013, 464:258-264.
[13] 蔡志娟.基于PH样条的五轴数控插补技术研究[D].哈尔滨:哈尔滨工业大学,2010.Cai Z J. Research on the five-axis CNC interpolation technology based on PH spline[D]. Harbin:Harbin Institute of Technology, 2010.
[14] 郑志浩,汪国昭.三次PH曲线的曲率单调性及过渡曲线构造[J].计算机辅助设计与图形学学报,2014,26(8):1219-1224.Zheng Z H, Wang G Z. On curvature monotony for a PH cubic curve and constructing transition curve[J]. Journal of Computer-Aided Design and Computer Graphics, 2014, 26(8):1219-1224.
[15] 段小娟.三次插值PH样条与F-曲线拐点和奇点的研究[D].杭州:浙江大学,2009.Duan X J. Research on the cubic interpolation PH spline and F-curve inflection point and singularity[D]. Hangzhou:Zhejiang University, 2009.
[16] 梅江平,臧家炜,乔正宇,等.三自由度Delta并联机械手轨迹规划方法[J].机械工程学报,2016,52(19):9-17.Mei J P, Zang J W, Qiao Z Y, et al. Trajectory planning of 3-DOF Delta parallel manipulator[J]. Journal of Mechanical Engineering, 2016, 52(19):9-17.