Time-jerk-optimal Trajectory Planning Algorithm for Manipulators
-
摘要: 针对工业机械臂执行效率以及运动过程中的冲击产生振动、机械磨损的问题,提出了一种机械臂的最优时间-冲击轨迹规划方法,优化机械臂关节运动时间和加加速度(冲击)两个耦合且矛盾的运动性能指标。通过逆运动学可以将机械臂执行的运动轨迹转换为在关节空间中的位置-时间序列,采用5次非均匀B样条函数在关节空间内构造插值曲线,用各阶B样条曲线控制顶点的约束代替机械臂的运动约束,利用NSGA-Ⅱ(Non-dominated sorting genetic algorithm Ⅱ,NSGA-Ⅱ)对目标函数进行优化。仿真结果表明,采用5次非均匀B样条函数插值,对运动时间和冲击进行优化的运动轨迹,提高了机械臂的执行效率,保证了运动过程中产生较小的冲击,使得机械臂的运动控制性能得到了提高。Abstract: Aiming at the efficiency of industrial manipulator and the vibration and mechanical wear caused by impact during motion, a time-jerk-optimal trajectory planning algorithm was proposed in this paper. Two mutually coupled and contradictory motion performance indicators of time and jerk were optimized. The trajectory of the task space can be transformed into the corresponding joint spatial position sequence by the inverse kinematics. Interpolation trajectory was constructed in the joint space by a five-order B-spline. The motion constraints of the manipulator were transformed into constraints on the control vertexes of five-order B-spline. The improved penalty function processed the constraints and optimized the objective function by NSGA-Ⅱ(Non-dominated Sorting Genetic Algorithm Ⅱ). Simulation results show that the five -order B-spline trajectory whose indicators of time and jerk are optimized improves the efficiency of the manipulator and guarantees the smallest possible impact during the movement. Finally, the motion control performance of the manipulator is improved.
-
Key words:
- manipulator /
- five-order B-spline /
- trajectory planning /
- optimization /
- NSGA-Ⅱ /
- simulation
-
表 1 工业机械臂D-H参数表
i ai-1 αi-1 di θi(变量范围) 1 0 0 0 0(±167°) 2 50 -π/2 0 -π/2(+90°/-130°) 3 270 π 0 0(+105°/-75°) 4 70 -π/2 299 0(±180°) 5 0 π/2 0 π/2(±110°) 6 0 -π/2 0 0(±360°) 表 2 工业机械臂各关节位置序列
节点 关节位置/(°) 关节1 关节2 关节3 关节4 关节5 关节6 1 15.99 -86.99 -3.07 0 90.07 -15.99 2 16.63 -92.59 5.40 0 87.19 -16.62 3 16.36 -98.03 13.22 0 84.81 -16.36 4 14.99 -103.13 20.32 0 82.81 -14.99 5 12.37 -107.63 26.57 0 81.06 -12.37 6 8.48 -111.13 31.85 0 79.28 -8.48 7 3.58 -113.20 36.03 0 77.17 -3.58 8 -1.80 -113.44 38.99 0 74.45 1.80 9 -6.94 -111.68 40.63 0 71.05 6.94 10 -11.21 -108.09 40.95 0 67.14 11.21 11 -14.26 -103.09 40.00 0 63.07 14.26 表 3 工业机械臂各关节运动学约束
约束项 关节1 关节2 关节3 关节4 关节5 关节6 v/(°·s-1) 230 230 250 320 320 420 a/(°·s-2) 65 5 95 9 105 100 j/(°·s-3) 75 7 65 8 95 8 -
[1] Cao B, Doods G I, Irwin G W. Time-optimal and smooth constrained path planning for robot manipulators[C]//Proceedings of 1994 IEEE International Conference on Robotics and Automation. San Diego, CA, USA: IEEE, 1994: 1853-1858 [2] 马睿, 胡晓兵, 殷国富, 等.六关节工业机器人最短时间轨迹优化[J].机械设计与制造, 2014(4):30-32, 35 doi: 10.3969/j.issn.1001-3997.2014.04.010Ma R, Hu X B, Yin G F, et al. The shortest time optimal planning of 6-DOF industrial robot's trajectory[J]. Machinery Design & Manufacture, 2014(4):30-32, 35(in Chinese) doi: 10.3969/j.issn.1001-3997.2014.04.010 [3] 徐海黎, 解祥荣, 庄健, 等.工业机器人的最优时间与最优能量轨迹规划[J].机械工程学报, 2010, 46(9):19-25 http://d.old.wanfangdata.com.cn/Periodical/jxgcxb201009003Xu H L, Xie X R, Zhuang J, et al. Global time-energy optimal planning of industrial robot trajectories[J]. Journal of Mechanical Engineering, 2010, 46(9):19-25(in Chinese) http://d.old.wanfangdata.com.cn/Periodical/jxgcxb201009003 [4] Tian L F, Collins C. An effective robot trajectory planning method using a genetic algorithm[J]. Mechatronics, 2004, 14(5):455-470 doi: 10.1016/j.mechatronics.2003.10.001 [5] Gasparetto A, Zanotto V. A technique for time-jerk optimal planning of robot trajectories[J]. Robotics and Computer-Integrated Manufacturing, 2008, 24(3):415-426 doi: 10.1016/j.rcim.2007.04.001 [6] Luo X, Fan X P. Two new algorithms for minimum time motion path planning of robot manipulators and their implementations on PVR-based control platform[J]. Control Theory & Applications, 2003, 20(5):700-706 http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=kzllyyy200305010 [7] 李小为, 胡立坤, 王琥.速度约束下PSO的六自由度机械臂时间最优轨迹规划[J].智能系统学报, 2015, 10(3):393-398 http://d.old.wanfangdata.com.cn/Periodical/xdkjyc201503010Li X W, Hu L K, Wang H. PSO-based time optimal trajectory planning for six degrees of freedom robot manipulators with speed constraints[J]. CAAI Transactions on Intelligent Systems, 2015, 10(3):393-398(in Chinese) http://d.old.wanfangdata.com.cn/Periodical/xdkjyc201503010 [8] Xu Z H, Li S, Chen Q W, et al. MOPSO based multi-objective trajectory planning for robot manipulators[C]//Proceedings of the 2nd International Conference on Information Science and Control Engineering. Shanghai, China: IEEE, 2015: 824-828 [9] Macfarlane S, Croft E A. Jerk-bounded manipulator trajectory planning:design for real-time applications[J]. IEEE Transactions on Robotics and Automation, 2003, 19(1):42-52 doi: 10.1109/TRA.2002.807548 [10] Petrinec K, Kovacic Z. Trajectory planning algorithm based on the continuity of jerk[C]//Proceedings of 2007 Mediterranean Conference on Control & Automation. Athens, Greece: IEEE, 2007: 1-5 [11] 张斌.基于多约束的机器人关节空间轨迹规划[J].机械工程学报, 2011, 47(21):1-6 http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=jxgcxb201121001Zhang B. Joint-space trajectory planning for robots under multiple constraints[J]. Journal of Mechanical Engineering, 2011, 47(21):1-6(in Chinese) http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=jxgcxb201121001 [12] 梁赫西, 黄晓东, 周密.七轴机械手最小能量直线轨迹算法优化[J].微型机与应用, 2015, 34(15):1-4 doi: 10.3969/j.issn.1674-7720.2015.15.001Liang H X, Huang X D, Zhou M. The optimizing of seven-axis manipulator minimum energy linear trajectory algorithm[J]. Microcomputer & Its Applications, 2015, 34(15):1-4(in Chinese) doi: 10.3969/j.issn.1674-7720.2015.15.001 [13] 杜钊君, 吴怀宇, 韩涛, 等.基于遗传算法的移动机械臂轨迹优化研究[J].机械设计与制造, 2013(5):133-136 doi: 10.3969/j.issn.1001-3997.2013.05.040Du Z J, Wu H Y, Han T, et al. Research on trajectory optimization of mobile manipulator based on genetic algorithm[J]. Machinery Design & Manufacture, 2013(5):133-136(in Chinese) doi: 10.3969/j.issn.1001-3997.2013.05.040 [14] 刘松国, 朱世强, 吴文祥.具有运动时间约束的机械手最优平滑轨迹规划[J].电机与控制学报, 2009, 13(6):897-902 doi: 10.3969/j.issn.1007-449X.2009.06.020Liu S G, Zhu S Q, Wu W X. Smoothness-optimal trajectory planning method with constraint on traveling time for manipulators[J]. Electric Machines and Control, 2009, 13(6):897-902(in Chinese) doi: 10.3969/j.issn.1007-449X.2009.06.020 [15] 付荣, 居鹤华.基于粒子群优化的时间最优机械臂轨迹规划算法[J].信息与控制, 2011, 40(6):802-808 http://d.old.wanfangdata.com.cn/Periodical/xxykz201106014Fu R, Ju H H. Time-optimal trajectory planning algorithm for manipulator based on PSO[J]. Information and Control, 2011, 40(6):802-808(in Chinese) http://d.old.wanfangdata.com.cn/Periodical/xxykz201106014 [16] 戴虹, 钱晋武, 张震, 等.GRNN在肌电预测踝关节运动中的应用[J].仪器仪表学报, 2013, 34(4):845-852 doi: 10.3969/j.issn.0254-3087.2013.04.020Dai H, Qian J W, Zhang Z, et al. Application of GRNN in ankle movement prediction based on surface electromyography[J]. Chinese Journal of Scientific Instrument, 2013, 34(4):845-852(in Chinese) doi: 10.3969/j.issn.0254-3087.2013.04.020 [17] 皮尔, 特莱尔.非均匀有理B样条[M].2版.赵罡, 穆国旺, 王拉柱, 译.北京: 清华大学出版社, 2010Piegl L, Tiller W. The nurbs book[M]. 2nd ed. Zhao G, Mu G W, Wang L Z, trans. Beijing: Tsinghua University Press, 2010(in Chinese) [18] 董莉, 宋晓勤, 韩杰.基于遗传粒子群优化的认知OFDM网络资源分配算法[J].应用科学学报, 2017, 35(3):288-298 doi: 10.3969/j.issn.0255-8297.2017.03.002Dong L, Song X Q, Han J. Resource allocation based on genetic algorithm and particle swarm optimization for cognitive OFDM network[J]. Journal of Applied Science, 2017, 35(3):288-298(in Chinese) doi: 10.3969/j.issn.0255-8297.2017.03.002 [19] 赵劲松, 朱汉银, 任旭辉, 等.插装式比例节流阀多目标遗传算法结构优化[J].中国机械工程, 2016, 27(2):215-221 doi: 10.3969/j.issn.1004-132X.2016.02.012Zhao J S, Zhu H Y, Ren X H, et al. Structural optimization of cartridge proportional throttle valve based on multi objective genetic algorithm[J]. China Mechanical Engineering, 2016, 27(2):215-221(in Chinese) doi: 10.3969/j.issn.1004-132X.2016.02.012 [20] Martín D, Rosete A, Alcalá-Fdez J, et al. QAR-CIP-NSGA-Ⅱ:A new multi-objective evolutionary algorithm to mine quantitative association rules[J]. Information Sciences, 2014, 258:1-28 doi: 10.1016/j.ins.2013.09.009 [21] Niku S B.机器人学导论-分析、系统及应用[M].孙富春, 朱继洪, 刘国栋, 等译.北京: 电子工业出版社, 2004 [22] Niku S B. Introduction to robotics analysis, systems, applications[M]. Sun F C, Zhu J H, Liu G D, et al, trans. Beijing: Publishing House of Electronics Industry, 2004(in Chinese)