基于BP-RRT*-FN算法的机械臂避障轨迹规划

Obstacle-avoidance Trajectory Planning of Manipulator Based on BP-RRT*-FN Algorithm

  • 摘要: 针对多自由度机械臂在狭窄空间中存在的路径计算效率不高的问题,提出了一种改进的BP-RRT*-FN(back propagation-rapidly-exploring random tree*-fast node)避障轨迹规划算法。为实现在3维空间运动轨迹规划更快速准确的收敛,利用距离加权函数计算节点采样概率,结合球包络障碍物和轴向包络法计算出无碰撞路径。通过阶段局部搜索,训练BP网络,预测每个阶段局部搜索的节点样本数量,自动进入下一阶段搜索。为减少冗余采样节点的产生,提高路径优化效率,应用FN算法随机删除节点。仿真结果表明,平均采样节点分别减少了24.96%、25.30%,路径计算时间分别减少了6.47 s、3.87 s。基于DOFBOT(degree of freedom RoBOT)六自由度机械臂的实验结果表明,在完成避障运动的情况下,机械臂平均抓取时间减少了3.58 s,平均搜索时间减少了3.21 s。该算法能够提高多自由度机械臂在多障碍物空间的路径计算效率。

     

    Abstract: To address the inefficiency of path computation for multi-degree-of-freedom manipulators in narrow environments, an improved BP-RRT-FN (back propagation-rapidly-exploring random tree*-fast node) obstacle-avoidance trajectory planning algorithm is proposed. To achieve more rapid and accurate convergence in 3D trajectory planning, the node sampling probability is calculated using a distance weighting function. Then, by combining the spherical envelope obstacle model and the axial envelope method, the algorithm calculates an obstacle-free path. Through staged local search, the BP network is trained to predict the number of nodes to be sampled in each local search stage, enabling the algorithm to automatically proceed to the next search stage. To reduce the generation of redundant sampled nodes and improve path optimization efficiency, the FN algorithm is applied to randomly deleting nodes. Simulation results show that the average number of sampled nodes is reduced by 24.96% and 25.30% in two respective scenarios, and the path calculation time is reduced by 6.47 s and 3.87 s, correspondingly. Experimental results on a six-degree-of-freedom manipulator indicate that, during obstacle avoidance movements, the average grasping time and the average search time are reduced by 3.58 s and 3.21 s, respectively. This algorithm can improve the path calculation efficiency of multi-DOF manipulators in multi-obstacle spaces.

     

/

返回文章
返回