NA-OR:A path optimization method for manipulators via node attraction and obstacle repulsion

作     者：XIAO GuangZhou WU Tong WENG Rui ZHANG RuiXian HAN YueJiang DONG YiFei LIANG Ye XIAO GuangZhou;WU Tong;WENG Rui;ZHANG RuiXian;HAN YueJiang;DONG YiFei;LIANG Ye

作者机构：School of AstronauticsHarbin Institute of TechnologyHarbin 150001China Faculty of ComputingHarbin Institute of TechnologyHarbin 150001China 

出 版 物：《Science China(Technological Sciences)》 (中国科学（技术科学英文版）)

年 卷 期：2023年第66卷第5期

页      面：1205-1213页

核心收录：

学科分类：08[工学] 080202[工学-机械电子工程] 0802[工学-机械工程] 0835[工学-软件工程] 0811[工学-控制科学与工程] 

基　　金：supported by the National Natural Science Foundation of China(Grant Nos.62225305,12072088,62003117,and 62003118) the National Defense Basic Scientific Research Program of China(Grant No.JCKY2020603B010) the Natural Science Foundation of Heilongjiang Province,China(Grant No.ZD2020F001) the Lab of Space Optoelectronic Measurement&Perception(Grant No.LabSOMP-2021-06)。 

主　　题：manipulator path planning path optimization obstacle avoidance path curvature safety margin 

摘      要：This paper is concerned with the issue of path optimization for manipulators in multi-obstacle environments.Aimed at overcoming the deficiencies of the sampling-based path planning algorithm with high path curvature and low safety margin,a path optimization method,named NA-OR,is proposed for manipulators,where the NA(node attraction)and OR(obstacle repulsion)functions are developed to refine the path by iterations.In the iterations of path optimization,the node attraction function is designed to pull the path nodes toward the center of their neighbor nodes,thereby reducing the path curvature and improving the smoothness.Also,the obstacle repulsion function is developed to push the path nodes out of the potentially unsafe region by generating a repulsive torque on the path nodes,thus improving the safety margin of the motion.By introducing the effect of NAOR,the optimized path has a significant improvement in path curvature and safety margin compared with the initial path planned by Bi-RRT,which meaningfully enhances the operation ability of manipulators for the applications that give a strong emphasis on security.Experimental results on a 6-DOF manipulator in 4 scenarios demonstrate the effectiveness and superiority of the proposed method in terms of the path cost,safety margin,and path smoothness.