Peng Peng,Zhang Zhian,Huang Xuegong.Dynamic Obstacle Avoidance Path Planning of Dual-Manipulator based on APF-RRT[J].Journal of Mechanical Transmission,2022,46(04):48-54.
Peng Peng,Zhang Zhian,Huang Xuegong.Dynamic Obstacle Avoidance Path Planning of Dual-Manipulator based on APF-RRT[J].Journal of Mechanical Transmission,2022,46(04):48-54. DOI: 10.16578/j.issn.1004.2539.2022.04.007.
Dynamic Obstacle Avoidance Path Planning of Dual-Manipulator based on APF-RRT
针对传统人工势场法(Artificial potential field method,APF)在6自由度双机械臂系统避障路径规划中容易陷入局部极小值这一缺陷,提出了一种改进APF与改进快速扩展随机树算法(Rapidly-exploring random trees,RRT)相结合进行避障路径规划的方法。分析了双机械臂的工作空间,确认了双臂干涉的可能性。对于双机械臂的路径规划,利用改进后的APF对主机械臂进行路径规划,并将其作为从机械臂的动态障碍物,为从机械臂规划运动路径;利用改进后的RRT自适应地选择临时目标点,解决了从机械臂路径规划时陷入局部极小值的问题;利用改进的APF对从机械臂的剩余路径进行了规划。仿真分析表明,改进后的APF-RRT算法能比传统算法更加快速准确地解决双臂系统的避障路径规划问题。
Abstract
Aiming at the defect that the traditional artificial potential field method(APF) is easy to fall into the local minimum in the obstacle avoidance path planning of the 6-DOF dual-manipulator system,an improved APF algorithm combined with an improved rapidly-exploring random trees(RRT) algorithm is proposed for obstacle avoidance path planning. The working space of the dual-manipulator system is analyzed,and the possibility of the interference of the dual-manipulator system is confirmed. For the path planning of the dual-manipulator,the improved APF is used to plan the path of the main manipulator,and it is used as the dynamic obstacle of the slave manipulator to plan the motion path of the slave manipulator. The improved RRT is used to adaptively select the temporary target points to solve the problem of falling into the local minimum when planning the path of the slave manipulator. The improved APF is used to plan the remaining path of the slave manipulator. Simulation analysis shows that the improved APF-RRT algorithm can solve the obstacle avoidance path planning problem of the dual-manipulator system more quickly and accurately than the traditional algorithm.
关键词
双机械臂人工势场法快速扩展随机树路径规划局部极小值临时目标点
Keywords
Dual-manipulatorArtificial potential fieldRRTPath planningLocal minimumTemporary target point
references
杨乾熙.基于机械臂的工业生产自动化现状分析[J].内燃机与配件,2020(19):68-69.
YANG Qianxi.Analysis of the status quo of industrial production automation based on manipulator[J].Internal Combustion Engine and Parts,2020(19):68-69.
CHEN Manyi,ZHANG Qiao,ZHANG Gong,et al.Re-search on obstacle avoidance path planning of manipulator in multiple obstacles environment[J].Computer Integrated Manufacturing Systems,2021,27(4):990-998.
NASRINAHAR A,CHUAH J H.Intelligent motion planning of a mobile robot with dynamic obstacle avoidance[J].Journal on Vehicle Routing Algorithms,2018,1(2/3/4):89-104.
PAN Z,LI D,YANG K,et al.Multi-robot obstacle avoidance based on the improved artificial potential field and PID adaptive tracking control algorithm[J].Robotica,2019,37(11):1883-1903.
ZHU Y,ZHANG T,SONG J Y,et al.A new method for mobile robots to avoid collision with moving obstacle[J].Artificial Life and Robotics,2012,16(4):507-510.
CAO Bo,BI Shusheng,ZHENG Jingxiang,et al.Obstacle avoidance algorithm for redundant manipulator of improved artificial potential field method[J].Journal of Harbin Institute of Technology,2019,51(7):184-191.
HAN Feng,ZHAO Jing.Research on obstacle avoidance and point reaching of manipulator based on fuzzy artificial potential field[J].Manufacturing Automation,2019,41(12):27-30.
SHI Yafei,ZHANG Li,LIU Zixuan,et al,Research of dynamic obstacle avoidance of manipulator based on artificial potential field method of velocity field[J].Journal of Mechanical Transmission,2020,44(4):38-44.
HE Zhaochu,HE Yuanlie,ZENG Bi.Obstacle avoidence path planning for robot arm based on mixed algorithm of artificial potential field method and RRT[J].Industrial Engineering Journal,2017,20(2):56-63.
MA Huili,LU Zhaoquan,WANG Shouting.Research on manipulator path planning based on improved RRT algorithms[J].Machine Design and Research,2020,36(4):42-46.
CHEN Bozhi,LU Liang,LEI Xinyu,et al.Simultaneousobstacle-avoidance motion planning approach for dual arm robots based on improved RRT algorithm[J].China Mechanical Engineering,2018,29(10):1220-1226.
ZHOU Lü,ZHOU Yuming,WANG Liang,et al.Dualarmrobot workspace analysis based on the monte carlo method[J].Journal of Mechanical Transmission,2014,38(6):85-87.
WANG Kun,HUANG Bo,ZENG Guohui,et al.Fasterpath planning based on improved RRT-connect algorithm[J].Journal of Wuhan University(Natural Science Edition),2019,65(3):283-289.
AN B,KIM J,PARK C.An adaptive step size RRT planning algorithm for open-chain robots[J].IEEE Robotics and Automation Letters,2018,3(1):312-319.