|
|
论文:2020,Vol:38,Issue(2):392-400 |
|
|
引用本文： |
|
|
马宇豪, 梁雁冰. 一种基于六次多项式轨迹规划的机械臂避障算法[J]. 西北工业大学学报 |
|
|
MA Yuhao, LIANG Yanbing. An Obstacle Avoidance Algorithm for Manipulators Based on Six-Order Polynomial Trajectory Planning[J]. Northwestern polytechnical university |
|
|
|
|
|
|
|
| 一种基于六次多项式轨迹规划的机械臂避障算法 |
|
| 马宇豪1,2, 梁雁冰1 |
|
1. 西安光学精密机械研究所 光电跟踪与测量技术研究室, 陕西 西安 710119;
2. 中国科学院大学 材料科学与光电技术学院, 北京 100049 |
| 摘要: |
| 针对机械臂避障轨迹规划的一系列需求，提出了一种基于六次多项式轨迹规划的机械臂避障算法。首先，采用六次多项式对机械臂轨迹进行规划。设曲线方程中六次项系数为待定参数，通过调整参数，改变曲线形状，使机械臂绕过障碍物的同时优化轨迹的性能指标，从而将机械臂避障轨迹规划问题转化为约束条件下的多目标优化问题；其次，综合碰撞检测结果、运动学指标，通过加权系数法建立适应度函数；最后，通过遗传算法进行优化，在关节空间中规划出一条无碰撞，同时运动学、轨迹长度、转动角度等要求一起协同优化的理想运动轨迹。此外，通过MATLAB对该算法进行了仿真实验验证，结果表明，该方法能够有效地规划出满足机械臂性能要求的无障碍运动轨迹。 |
| 关键词:
机械臂
避障
轨迹规划
六次多项式
遗传算法
|
|
| An Obstacle Avoidance Algorithm for Manipulators Based on Six-Order Polynomial Trajectory Planning |
|
| MA Yuhao1,2, LIANG Yanbing1 |
|
1. Laboratory of Precision Physical Quantity Measurement, Xi'an Institute of Optics and Precision Mechanics, Xi'an 710119, China;
2. College of Materials Science and Opto-Electronic Technology, University of Chinese Academy of Sciences, Beijing 100049, China |
| Abstract: |
| Aiming at a series of requirements of obstacle avoidance trajectory planning of manipulators, a new algorithm based on six-order polynomial trajectory planning is proposed. Firstly, the six-order polynomial is used for the trajectory planning of the manipulator. Assuming that the coefficients of the sixth order term in the curve equation are undetermined parameters, by adjusting these parameters, the shape of the curve can be changed to make manipulators avoid the obstacle and to optimize performance indicators of the trajectory simultaneously. Thus, the obstacle avoidance trajectory planning of manipulators is transformed into a multi-objective optimization problem. Secondly, combining collision detection results and kinematics indexes, a fitness function is defined by the weighting coefficient method. At last, an ideal collision-free trajectory that is collaborative optimized in kinematics, trajectory length and rotation angle is planned in the joint space through genetic algorithm optimization. Additionally, the algorithm is validated by simulation experiments with MATLAB, the results show that the method of this study can effectively plan obstacle-free trajectories satisfying the performance requirements of the manipulator. |
| Key words:
manipulator
obstacle avoidance
trajectory planning
six-order polynomial
genetic algorithm
|
|
| 收稿日期: 2019-02-25
修回日期:
|
| DOI: 10.1051/jnwpu/20203820392 |
| 通讯作者:
Email： |
| 作者简介: 马宇豪(1992-),西安光学精密机械研究所硕士研究生,主要从事六关节机械臂建模分析及避障轨迹规划算法与机械臂轨迹跟踪控制算法研究。
|
|
|
|
|
|
|
|
参考文献: |
|
|
[1] 蔡鹤皋. 机器人将是21世纪技术发展的热点[J]. 中国机械工程, 2000(1):67-69 CAI Hegao. Robot Will be a Hot Spot of Technological Development in the Twenty First Century[J]. China Mechanical Engineering, 2000(1):67-69(in Chinese)
[2] 祁若龙, 周维佳, 王铁军. 一种基于遗传算法的空间机械臂避障轨迹规划方法[J]. 机器人, 2014, 36(3):263-270 QI Ruolong, ZHOU Weijia, WANG Tiejun. An Obstacle Avoidance Trajectory Planning Scheme for Space Manipulators Based on Genetic Algorithm[J]. Robot, 2014, 36(3):263-270(in Chinese)
[3] DONG H, DU Z J. Obstacle Avoidance Path Planning of Planar Redundant Manipulators Using Workspace Density[J]. International Journal of Advanced Robotic Systems, 2015, 12:9
[4] LIU J, LIU R, SHEN X, et al. Research on Obstacle Avoidance of Space Manipulators Based on Cylindrical Bounding Box Model[C]//2018 IEEE International Conference on Mechatronics and Automation, Changchun, 2018:1926-1931
[5] ISMAIL M, LAHOUAR S, ROMDHANE L. Collision-Free and Dynamically Feasible Trajectory of a Hybrid Cable-Serial Robot with Two Passive Links[J]. Robot Auton Syst, 2016, 80:24-33
[6] ADELI Hossein, TABRIZI M H N, MAZLOOMIAN Alborz, et al. Path Planning for Mobile Robots Using Iterative Artificial Potential Field Method[J]. International Journal of Computer Science Issue, 2011,8(44):28-32
[7] VERAS Lgdo, MEDEIROS Fll, GUIMARAES Lnf. Rapidly Exploring Random Tree with a Sampling Method Based on Sukharev Grids and Convex Vertices of Safety Hulls of Obstacles[J]. International Journal of Advanced Robotic Systems, 2019, 16(1):1-19
[8] PARK B, CHUN W K. Efficient Environment Representation for Mobile Robot Path Planning Using CVT-PRM with Halton sampling[J]. Electronics Letters, 2012, 48(22):1397-1399
[9] CHEN Zhuo, SU Weihua, LI Bin, et al. An Intermediate Point Obstacle Avoidance Algorithm for Serial Robot[J]. Advances in Mechanical Engineering, 2018, 10(5):1-15
[10] 孙玥, 魏欣. 基于五次多项式的码垛机器人轨迹规划[J]. 包装工程, 2017, 38(21):159-163 SUN Yue, WEI Xin. Trajectory Planning of Palletizing Robot Based on Quintic Polynomial[J]. Packaging Engineering, 2017, 38(21):159-163(in Chinese)
[11] TANG Hong, LI Liangzhi, XIAO Nanfeng. Smooth Sensor Motion Planning for Robotic Cyber Physical Social Sensing[J]. Sensors, 2017, 17(2):393
[12] ZHANG Wenjia, SHANG Weiwei, ZHANG Bin, et al. Stiffness-Based Trajectory Planning of a 6-DOF Cable-Driven Parallel Manipulator[J]. Journal of Mechanical Engineering Science, 2017, 231(21):3999-4011
[13] REN Weide, SUN Wenxin. Application of an Improved Ant Colony Algorithm in TSP Problem Solving[J]. Chemical Engineering Transactions, 2016, 51:73-378
[14] FRANZIN A, STUTZLE T. Revisiting Simulated Annealing:a Component-Based Analysis[J]. Computers & Operations Research, 2019, 104:191-206
[15] 方群, 徐青. 基于改进粒子群算法的无人机三维航迹规划[J]. 西北工业大学学报, 2017, 35(1):66-73 FANG Qun, XU Qing. 3D Route Planning for UAV Based on Improved PSO Algorithm[J]. Journal of Northwestern Polytechnical University, 2017, 35(1):66-73(in Chinese) |
|
|
|
相关文献: |
|
|
1．朱战霞, 靖飒, 仲剑飞, 王明明.基于碰撞检测的空间冗余机械臂避障路径规划[J]. 西北工业大学学报, 2020,38(1): 183-190 |
|
|
|
|
|
|
