分层平滑优化双向A*引导DWA的煤矿机器人路径规划

  • 摘要: 针对现有A*算法无法应对井下未知障碍物,DWA算法存在冗余路段、易陷入陷阱,以及DWA融合全局路径规划算法计算量较大等问题,提出了一种分层平滑优化双向 A*引导 DWA(HSTA*-G-DWA)的煤矿救援机器人路径规划方法。首先,在双向A*算法的代价函数中引入动态加权因子和归正因子并构建碰撞约束函数剔除路径搜索过程中无关扩展节点的搜索,以提升路径搜索效率和安全性。其次,利用分层平滑优化策略消除路径中的冗余点和转折点,减少路径点数量和路径长度。之后,通过三次B样条曲线对路径进行进一步平滑处理。然后,煤矿救援机器人若探测到未知障碍物则利用全局路径引导DWA 实现局部动态避障,否则引导其跟随初始全局路径运动。最后,实验结果表明,所提算法在保证全局最优的基础上提高了实时寻路效率,提升了轨迹的安全性与平滑性。

     

    Abstract: Aiming at the problems that A* algorithm cannot deal with unknown obstacles underground, DWA algorithm has redundant sections and is easy to fall into traps, and DWA combined with global path planning algorithm has large calculation, a hierarchical smooth optimization bidirectional A* guided DWA(HSTA*-G-DWA)path planning method for coal mine rescue robot was proposed. Firstly, the dynamic weighting factor and normalization factor are introduced into the cost function of bidirectional A * algorithm, and the collision constraint function is constructed to eliminate the search of unrelated extension nodes in the path search process, so as to improve the efficiency and security of path search. Secondly, the hierarchical smoothing optimization strategy is used to eliminate redundant points and turning points in the path, and reduce the number of path points and path length. After that, the path is further smoothed by cubic B-spline curve. Thirdly, if the Coal mine rescue robot detects an unknown obstacle, it uses the global path to guide DWA to achieve local dynamic obstacle avoidance, otherwise it tracks the initial global path. Finally, the experimental results demonstrate that the proposed algorithm enhances real-time pathfinding efficiency while ensuring global optimization, as well as improving trajectory security and smoothness.

     

/

返回文章
返回