基于BP-RRT*-FN算法的机械臂避障轨迹规划OA
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.该算法能够提高多自由度机械臂在多障碍物空间的路径计算效率.
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.
屈昆仪;黄铝文;刘宇航;翟梦群;耿静;李雯敏
西北农林科技大学信息工程学院,陕西 咸阳 712100西北农林科技大学信息工程学院,陕西 咸阳 712100||陕西省农业信息智能感知与分析工程技术研究中心,陕西 咸阳 712100西北农林科技大学信息工程学院,陕西 咸阳 712100西北农林科技大学机械电子工程学院,陕西 杨凌 712100西北农林科技大学信息工程学院,陕西 咸阳 712100西北农林科技大学信息工程学院,陕西 咸阳 712100
信息技术与安全科学
机械臂采样空间划分避障轨迹规划分阶段局部搜索RRT*
manipulatorsampling space partitioningobstacle-avoidance trajectory planningstage-based local searchRRT*
《信息与控制》 2026 (4)
701-713,726,14
评论