基于改进APF-IRRT*的机械臂路径规划研究

Research on path planning of manipulator based on improved APF-IRRT*

  • 摘要: 针对传统Informed-RRT*(informing rapidly-exploring random trees with path distance lower bounds)算法在机械臂避障路径规划中目标导向性不足、随机性大、规划效率低以及路径冗余造成运动不平滑等问题,提出一种改进的APF-Informed RRT*算法。在采样阶段,引入人工势场法引导采样点,提高随机树扩展的目标导向性。在树生长阶段,通过碰撞检测缓存键和自适应变步长策略,缓存碰撞检测结果,并生成唯一标识为缓存键,通过与障碍物的距离动态调整步长,减少碰撞检测次数,提高搜索效率。在优化阶段,采用分段式贪心算法和三次B样条曲线优化路径。通过与Informed-RRT*、GoalBias-RRT*和RRT*算法在三维环境下的仿真对比实验。结果表明,相较于Informed-RRT*算法,APF-Informed RRT*算法路径长度减少14.08%,时间节约96.17%;与RRT*和GoalBias-RRT*算法相比,APF-Informed RRT*算法路径长度分别减少19.89%和12.24%,时间分别节约88.52%和12.5%,算法的搜索效率得到显著的提升。将算法应用到AUBO i5机械臂平台,机械臂能够成功避开障碍物并准确到达目标点,且各关节的运动曲线平滑,进一步证明了改进算法的有效性。

     

    Abstract: To address the issues of insufficient goal orientation, high randomness, low planning efficiency, and path redundancy leading to non-smooth motion in the traditional Informed-RRT* algorithm for obstacle avoidance path planning of robotic arms, an improved APF-Informed RRT* algorithm is proposed. In the sampling stage, the artificial potential field method is introduced to guide the sampling points, enhancing the goal orientation of the random tree expansion. In the tree growth stage, a collision detection cache key and an adaptive variable step size strategy are proposed. Collision detection results are cached and a unique identifier, the cache key, is generated. The step size is dynamically adjusted based on the distance to obstacles to reduce the number of collision detections and improve search efficiency. In the optimization stage, a piecewise greedy algorithm and cubic B-spline curve are used to optimize the path. Through simulation experiments in a three-dimensional environment comparing with Informed-RRT*, GoalBias-RRT*, and RRT* algorithms, the results show that the path length is reduced by 14.08% compared to Informed-RRT*, and the time is saved by 96.17%. Compared with RRT* and GoalBias-RRT*, the path lengths are reduced by 19.89% and 12.24% respectively, and the time is saved by 88.52% and 12.5% respectively. The search efficiency of the algorithm is significantly improved. When the algorithm is applied to the AUBO i5 robotic arm platform, the robotic arm can successfully avoid obstacles and accurately reach the target point, and the motion curves of each joint are smooth, further demonstrating the effectiveness of the improved algorithm.

     

/

返回文章
返回