排爆机械臂多目标轨迹规划研究

PDF(2539 KB)

振动与冲击 ›› 2016, Vol. 35 ›› Issue (2) : 116-123.

论文

排爆机械臂多目标轨迹规划研究

马振书1，张云峰2，孙华刚1，陆继山2

作者信息 +

Research on multi-objective trajectory planning of EOD manipulators

MA Zhen-shu1，ZHANG Yun-feng2，SUN Hua-gang1, LU Ji-shan2

Author information +

文章历史 +

摘要

针对排爆机械臂轨迹规划问题，提出多目标轨迹规划方法。建立三次样条曲线分段轨迹描述方程，采用外加虚拟点法保证三次样条曲线可任意指定轨迹初始速度、加速度，提出灵活性优化目标以提高机构灵活性；将优化目标及运动学约束以轨迹方程参数表示，转化为对各段运动时间的寻优；采用CNSGA-II对排爆机械臂运动进行多目标轨迹优化，处理非线性约束最优化，建立排爆机械臂多目标轨迹规划算法流程。结果表明，该方法能有效提高规划结果灵活性，各项目标均优于线性加权单目标规划，所得轨迹平滑可控。

Abstract

A multi-ojective optimization technique is presented to solve the problem of EOD manipulators’ trajectory planning.At first, cubic splines are used to connect every pair of consecutive via-points. Two virtual points are introduced to ensure the initial and final conditions for velocity and acceleration can be respected. Manipulability objective is developed to enhance the manipulability of mechanism. The objective functions and kinematic constraints are presented by parameters of cubic spine, so that the problem transform into the optimization of every time interval. Second, constraint NSGA-II is adopted to plan the multi-objective trajectory， which is suitable to solving optimization problems with nonlinear constraints. The process of algorithm based on NSGA-II is created. Finally, compared to traditional method, simulation results proposed that the developed technique improve the manipulability effectively and every optimizing index is better than the results of linear weighting coefficient technique. The obtained trajectories are smooth enough and easy to control.

导出引用

马振书1，张云峰2，孙华刚1，陆继山2. 排爆机械臂多目标轨迹规划研究[J]. 振动与冲击, 2016, 35(2): 116-123

MA Zhen-shu1，ZHANG Yun-feng2，SUN Hua-gang1, LU Ji-shan2. Research on multi-objective trajectory planning of EOD manipulators[J]. Journal of Vibration and Shock, 2016, 35(2): 116-123

参考文献

[1]范路桥,姚锡凡,祁亨年,等.排爆机器人的研究现状及其关键技术[J].机床与液压,2008,36(6):139-143.
FAN Lu-qiao, YAO Xi-fan, QI Heng-nian, et al. Research progress and key techniques of explosive ordnance disposal robot[J].Machinetool & Hydraulics,2008,36(6):139-143.
[2]范路桥,姚锡凡,蒋梁中,等.半智能排爆机器人的单手双目手眼系统[J].华南理工大学学报:自然科学版,2008,36(4): 40- 44.
FAN Lu-qiao,YAO Xi-fan,JIANG Liang-zhong,et al. Single- hand and binocular eye-in-hand system for semi-intelligent EOD robot[J]. Journal of South China University of Technology :Natural Science Edition ,2008,36(4):40-44.
[3]申加刚,董再励,郝颖明,等.排爆作业机器人模拟训练系统研究[J].机器人,2005,27(5):426-430.
SHEN Jia-gang, DONG Zai-li, HAO Ying-ming, et al. Research on a virtual training simulator for explosive- handling Robot[J].Robot, 2005,27(5):426-430.
[4]曾建军,杨汝清,张伟军.有限人参与下的排爆机器人半自主抓取[J].上海交通大学学报,2007,41(8):1238-1342.
ZENG Jian-jun, YANG Ru-qing, ZHANG Wei-jun. Research of semi-automatic bomb fetching with limited support of human in explosive ordnance disposal robot[J]. Journal of Shanghai Jiaotong University, 2007,41(8):1238-1342.
[5]陈国梁,王心汉,王敏.机械手圆周运动的轨迹规划与实现[J].华中科技大学学报:自然科学版,2005,33(11):63-66.
CHEN Guo-liang, WANG Xin-han, WANG Min. Trajectory planning for the circular motion of manipulator and its implementation[J]. J.Huazhong Univ. of Sci. & Tech.:Nature Science Edition,2005,33(11):63-66.
[6]任敬轶,孙汉旭.一种新颖的笛卡尔空间轨迹规划方法[J].机器人，2002,24(3):217-221.
REN Jing-yi, SUN Han-xu.A novel method of trajectory planning in cartesian space[J].Robot,2002,24(3):217-221.
[7] Solteiro Pires E J, de Moura Oliveira P B, Tenreiro Machado J A.Manipulator trajectory planning using a MOEA[J]. Applied Soft Computing ,2007(7):659-667.
[8] Gasparetto A, Zanotto V. A technique for time-jerk optimal planning of robot trajectories[J]. Robotics and Computer- Integrated Manufacturing ,2008(24):415-426.
[9] Rossi C, Savino S. Robot trajectory planning by assigning positions and tangential velocities[J]. Robotics and Computer-Integrated Manufacturing, 2013 (29):139-156.
[10] Niku S B,著.孙富春,朱纪洪,刘国栋,等译.机器人学导论分析、控制及应用(第二版)[M].北京：电子工业出版社，2013.
[11] Gasparetto A, Zanotto V. Optimal trajectory planning for industrial robots[J]. Advances in Engineering Software , 2010(41):548-556.
[12] Shiller Z, Chang H, Wong V. The practical implementa- tion of time-optimal control for robotic manipulators[J]. Robotics & Computer-Integreted Manufacturing,1996,
12(1):29-39.
[13] Lee Y D, Lee B H, Kim H G. An evolutionary approach for time optimal trajectory planning of a robotic manipulator [J].Information Science,1999(113):245-260.
[14] Oen K T, Wang L C T. Optimal dynamic trajectory planning for linearly actuated platform type parallel manipulators having task space redundant degree of freedom [J]. Mechanism and Machine Theory ,2007(42): 727-750.
[15] Boscariol P, Gasparetto A. Model-based trajectory planning for flexible-link mechanisms with bounded jerk[J]. Robotics and Computer-Integrated Manufacturing, 2013(29): 90-99.
[16] Gasparetto A , Zanotto V. A new method for smooth trajectory planning of robot manipulators[J]. Mechanism and Machine Theory ,2007 (42):455-471.
[17] Gasparetto A, Lanzutti A, Vidoni R, et al. Experimental validation and comparative analysis of optimal time-jerk algorithms for trajectory planning[J]. Robotics and Computer-Integrated Manufacturing, 2012(28):164-181.
[18]庞慧.危险弹药处理机器人工作装置的性能分析及优化[D].天津:河北工业大学,2010.
[19] Corke P. Robotics, vision and control[M]. Berlin: Springer, 2011.
[20] Deb K, Agrawal S, Pratap A, et al. A fast elitist nondominated sorting genetic algorithm for multi-objective optimization: NSGA-II[J]. Evolutionary Computation, 2002,6(2):182-197.