J Shanghai Jiaotong Univ Sci ›› 2022, Vol. 27 ›› Issue (5): 614-620.doi: 10.1007/s12204-022-2416-7

• Automation System & Theory • Previous Articles     Next Articles

Path Planning and Optimization of Humanoid Manipulator in Cartesian Space

LI Shiqi1 (李世其), LI Xiao1∗ (李肖), HAN Ke1 (韩可), XIONG Youjun2 (熊友军), XIE Zheng2 (谢铮), CHEN Jinliang2 (陈金亮)   

  1. (1. School of Mechanical Science and Engineering, Huazhong University of Science and Technology, Wuhan 430074, China; 2. Ubtech Robotics Co., Ltd., Shenzhen 518000, Guangdong, China)
  • Received:2021-05-18 Online:2022-09-28 Published:2022-09-03

Abstract: To solve the problems of low efficiency and multi-solvability of humanoid manipulator Cartesian space path planning in physical human-robot interaction, an improved bi-directional rapidly-exploring random tree algorithm based on greedy growth strategy in 3D space is proposed. The workspace of manipulator established based on Monte Carlo method is used as the sampling space of the rapidly-exploring random tree, and the opposite expanding greedy growth strategy is added in the random tree expansion process to improve the path planning efficiency. Then the generated path is reversely optimized to shorten the length of the planned path, and the optimized path is interpolated and pose searched in Cartesian space to form a collision-free optimized path suitable for humanoid manipulator motion. Finally, the validity and reliability of the algorithm are verified in an intelligent elderly care service scenario based on Walker2, a large humanoid service robot.

CLC Number: