Abstract：In the RRT (rapidly-exploring random tree) method, the determination of the step size depends too much on program debugging, and collision detection failure may occur due to the fixed step size. For this problem, an attractive adaptive step size RRT for cooperative path planning of the dual-arm robot is proposed. Firstly, the step size norm inequality between the configuration space and the workspace is established to constrain the step size generated by the dual-arm robot in the workspace, and thus the effective collision detection is guaranteed. Then, a passive growth method of random tree is proposed to reduce the dimension of planning space while ensuring cooperative motion of the dual-arm robot. Finally, the attractive force function is introduced at the nodes of the random tree to speed up the fusion of the algorithm. The simulation results show that the attractive force self-adaptive step size RRT method can constrain the step size in the workspace effectively to ensure the effectiveness of collision detection. On the premise of no collision, the attractive adaptive step size RRT method reduces the number of iterations, the running time and the path length compared with other algorithms. The proposed algorithm is applied to the prototype experiment of the dual-arm robot. The experiment results show that the dual-arm robot can complete the obstacle avoidance motion on the premise of maintaining the position coordination, which verifies the effectiveness of the algorithm.
 欧阳帆.双机器人协调运动方法的研究[D].广州:华南理工大学,2013. Ouyang F. Research on coordinated motion of dual robots[D]. Guangzhou:South China University of Technology, 2013.  张瑞星,李秀娟,高唤.双焊接机器人协同路径规划研究[J].组合机床与自动化加工技术,2019(6):81-85. Zhang R X, Li X J, Gao H. Research on cooperative path planning of double welding robot[J]. Modular Machine Tool and Automatic Manufacturing Technique, 2019(6):81-85.  Peng Y C, Carabis D S, Wen J T. Collaborative manipulation with multiple dual-arm robots under human guidance[J]. International Journal of Intelligent Robotics and Applications, 2018, 2(2):252-266.  谢生良,刘祚时.双臂机器人工作空间的分析与仿真[J].机械传动,2018,42(6):139-143. Xie S L, Liu Z S. Analysis and simulation of workspace of dual-arm robot[J]. Journal of Mechanical Transmission, 2018, 42(6):139-143.  Andreas V, Knut G. An optimization-based approach to dual-arm motion planning with closed kinematics[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2018:8346-8351.  Sanchez G, Latombe J C. Using a PRM planner to compare centralized and decoupled planning for multi-robot systems[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2002:2112-2119.  Lim S J, Han C S. Operational space path planning of the dual-arm robot for the assembly task[J]. International Journal of Precision Engineering and Manufacturing, 2014, 15(10):2071-2075.  Steven B, Wasif N, Stuart F. Improved APF strategies for dual-arm local motion planning[J]. Transactions of the Institute of Measurement and Control, 2015, 37(1):73-90.  LaValle S M. Rapidly-exploring random trees:A new tool for path planning[R]. Ames, USA:Computer Science Department, Iowa State University, 1998.  Karaman S, Frazzoli E. Sampling-based algorithms for optimal motion planning[J]. International Journal of Robotics Research, 2011, 30(7):846-894.  Kuffner J, LaValle S M. RRT-connect:An efficient approach to single-query path planning[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2000:995-1001.  王坤,黄勃,曾国辉,等.基于改进RRT-Connect的快速路径规划算法[J].武汉大学学报,2019,65(3):283-289. Wang K, Huang B, Zeng G H, et al. Faster path planning based on improved RRT-Connect algorithm[J]. Journal of Wuhan University, 2019, 65(3):283-289.  莫栋成,刘国栋.改进的RRT-connect双足机器人路径规划算法[J].计算机应用,2013,33(8):2289-2292. Mo D C, Liu G D. Improved RRT-connect path planning algorithm for biped robot[J]. Journal of Computer Applications, 2013, 33(8):2289-2292.  王维,李焱.基于RRT的虚拟人双臂操控规划方法[J].系统仿真学报,2009,21(20):6515-6518. Wang W, Li Y. RRT-based manipulation planning method for both arms of virtual human[J]. Journal of System Simulation, 2009, 21(20):6515-6518.  杜爽,尚伟伟,刘坤,等.基于双向RRT算法的仿人机器人抓取操作[J].中国科学技术大学学报,2016,46(1):12-20. Du S, Shang W W, Liu K, et al. Bidirectional RRT algorithm based grasping manipulation of humanoid robots[J]. Journal of University of Science and Technology of China, 2016, 46(1):12-20.  Kim D H, Lim S J, Lee D H, et al. A RRT-based motion planning of dual-arm robot for (Dis) assembly tasks[C]//IEEE Conference on Intelligence and Safety for Robotics. Piscataway, USA:IEEE, 2013:6pp.  Chen P F, Zhao H, Zhao X, et al. Dimensionality reduction for motion planning of dual-arm robots[C]//IEEE International Conference on Mechatronics and Automation. Piscataway, USA:IEEE, 2018:718-723.  刘成菊,韩俊强,安康.基于改进RRT算法的RoboCup机器人动态路径规划[J].机器人,2017,39(1):8-15. Liu C J, Han J Q, An K. Dynamic path planning based on an improved RRT algorithm for RoboCup robot[J]. Robot, 2017, 39(1):8-15.  Hao J, Zhang Y K, Wang J Z, et al. Path planning of industrial robot based on improved RRT algorithm in complex environments[J]. IEEE Access, 2018(6):53296-53306.  申浩宇,吴洪涛,陈柏,等.冗余度双臂机器人协调避障算法[J]. 农业机械学报,2015,46(9):356-361. Shen H Y, Wu H T, Chen B, et al. Obstacle avoidance algorithm for coordinated motion of redundant dual-arm robot[J]. Transactions of the Chinese Society of Agricultural Machinery. 2015, 46(9):356-361.  Wang H X, Li R F, Gao Y F, et al. Comparative study on the redundancy of mobile single and dual-arm robots[J]. International Journal of Advanced Robotic Systems, 2016, 13(6):1-19.  李洋,徐达,周诚.基于自适应步长RRT的双机器人协同路径规划[J].农业机械学报,2019,50(3):358-367. Li Y, Xu D, Zhou C. Cooperation path planning of dual-robot based on self-adaptive stepsize RRT[J]. Transactions of the Chinese Society for Agricultural Machinery. 2019, 50(3):358-367.  Zang X Z, Yu W T, Zhang L, et al. Path planning based on Bi-RRT algorithm for redundant manipulator[C]//International Conference on Electrical, Automation and Mechanical Engineering. Paris, France:Atlantis-Press, 2015:189-191.  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.