高级检索
赵卫东,刘立磊,吕红兵. 融合改进RRT-Connect与APF的路径规划算法[J]. 安徽工业大学学报(自然科学版),xxxx,x(x):x-xx. DOI: 10.12415/j.issn.1671-7872.24088
引用本文: 赵卫东,刘立磊,吕红兵. 融合改进RRT-Connect与APF的路径规划算法[J]. 安徽工业大学学报(自然科学版),xxxx,x(x):x-xx. DOI: 10.12415/j.issn.1671-7872.24088
ZHAO Weidong, LIU Lilei, LYU Hongbing. Path Planning Algorithm of Integrating Improved RRT-Connect and APF[J]. Journal of Anhui University of Technology(Natural Science). DOI: 10.12415/j.issn.1671-7872.24088
Citation: ZHAO Weidong, LIU Lilei, LYU Hongbing. Path Planning Algorithm of Integrating Improved RRT-Connect and APF[J]. Journal of Anhui University of Technology(Natural Science). DOI: 10.12415/j.issn.1671-7872.24088

融合改进RRT-Connect与APF的路径规划算法

Path Planning Algorithm of Integrating Improved RRT-Connect and APF

  • 摘要: 为提高无人驾驶车辆路径规划效率和追踪路径时的安全性,提出1种融合改进双向快速扩展随机树(RRT-Connect)和人工势场(APF)的优化算法。采用动态步长策略,根据节点与障碍物之间的距离选择合适的步长扩展随机树,提高路径搜索效率;利用APF引力分量引导随机树向目标点方向偏置采样,加快算法采样效率;利用APF斥力分量引导随机树远离障碍物采样,优化路径避障性能;通过双向剪枝策略并引入三次B样条曲线进一步优化规划路径的长度和平滑度;通过优化APF斥力函数来增加无人车与目标点间距离的斥力分量,使车辆在追踪路径时避开动态障碍物,并稳定停在目标点处。基于机器人操作系统(ROS),在不同障碍物环境下进行仿真测试,验证融合改进优化算法的有效性。结果表明:相较于RRT算法和RRT-Connect算法,动态步长策略和采样函数优化使融合改进优化算法的路径节点减少约30%和12%,路径缩短约30%和13%,搜索时间缩短约50%和3%;经双向剪枝策略处理的路径再经三次B样条平滑处理,路径的平滑度进一步提升、长度进一步缩短;优化斥力函数可有效解决目标点不可达问题,同时提升局部算法在动态环境中的避障能力。

     

    Abstract: To improve the efficiency of path planning for unmanned vehicles and the safety during path tracking, an improved optimization algorithm was proposed that combines the improved bidirectional rapidly-exploring random tree (RRT-Connect) and artificial potential field (APF). A dynamic step strategy was employed to select appropriate step size for expanding the random tree based on distances between nodes and obstacles, and improving path search efficiency. The APF attraction component was used to guide the random tree towards the target direction for biased sampling, and accelerating algorithmic sampling efficiency. Meanwhile, the APF repulsion component was used to guide the random tree away from obstacles to optimize path obstacle avoidance performance.The length and smoothness of the planned path was further optimize by implementing a bidirectional pruning strategy and introducing cubic B-spline curves.By optimizing the APF repulsion function to increase the repulsive component of the distance between the unmanned vehicle and the target point, the vehicle could avoid dynamic obstacles and stably stop at the target point while tracking the path.Based on the robot operating system (ROS), simulation tests were conducted in different obstacle environments to verify the effectiveness of the fusion improvement optimization algorithm. The results show that compared to the RRT algorithm and RRT-Connect algorithm, the dynamic step size strategy and sampling function optimization reduces the number of path nodes by about 30% and 12%, shortens the path by about 30% and 13%, and shortens the search time by about 50% and 3% for the fusion improvement optimization algorithm, respectively.The path processed through bidirectional pruning and cubic B-spline smoothing further enhance smoothness and reduce length.Optimizing the repulsive function can effectively solve the problem of unreachable target points and improve the obstacle avoidance ability of local algorithms in dynamic environments.

     

/

返回文章
返回