改进RRT-Connect的机械臂路径规划算法研究

Research on improved RRT-Connect path planning algorithm for robotic arm

  • 摘要: 针对机械臂路径规划中快速扩展随机树(rapidly-exploring random tree,RRT)算法存在的规划效率偏低、迭代次数冗余和节点冗余度高等问题,提出一种基于三棵树协同增长机制的改进路径规划算法。改进算法采用起点相连树、中心扩展树和终点相连树的三树协同架构,同步构建起点相连树与终点相连树,实现向中心树的双向协同靠拢;设计适配性限定采样空间并融合目标偏置扩展技术,显著提升树节点生成的有效性与生长的定向性;路径生成后,采用反向搜索剪枝完成路径粗优化,结合正向插值剪枝实现路径精优化,通过二者协同作用缩短路径长度,最终采用三次B样条曲线完成路径平滑处理。基于Matlab和机器人操作系统2(Robot Operating System 2, ROS2)平台的MoveIt2的三维随机地图仿真实验表明,与传统算法相比,改进算法在路径长度略微减少的前提下,规划时间缩短40%~70%,迭代次数减少50%~70%,有效提升机械臂避障路径规划的效率和质量。

     

    Abstract: Aiming at the problems of low planning efficiency, redundant iteration times and high node redundancy existing in the random tree expansion-based RRT algorithm for manipulator path planning, an improved path planning algorithm based on a three-tree cooperative growth mechanism is proposed. The improved algorithm adopts a three-tree cooperative architecture consisting of a start-connected tree, a central expansion tree and an end-connected tree, synchronously constructs the start point-connected tree and the end point-connected tree, and realizes bidirectional cooperative convergence towards the central tree. An adaptive limited sampling space is designed and fused with the target-biased expansion technology to significantly improve the effectiveness of tree node generation and the directionality of tree growth. After path generation, reverse search pruning is used to complete the rough path optimization, and forward interpolation pruning is combined to achieve precise path optimization. The cooperative effect of the two shortens the path length, and finally, the cubic B-spline curve is used to complete the path smoothing process. Simulation experiments on 3D random maps based on Matlab and MoveIt2 of the ROS2 platform show that, compared with traditional algorithms, the improved algorithm shortens the planning time by 40% to 70% and reduces the number of iterations by 50% to 70% on the premise of a slight reduction in path length, which effectively improves the efficiency and quality of manipulator obstacle avoidance path planning.

     

/

返回文章
返回