基于分层协同策略的井下机器人路径规划

    Path planning for underground robots based on a hierarchical collaborative strategy

    • 摘要: 针对煤矿井下环境复杂、动态障碍物繁多,导致井下机器人路径规划效率低、安全性不足等问题,本研究构建了一种分层协同的路径规划算法。在全局规划中针对传统快速扩展随机树(RRT)算法随机性强、路径曲折的缺陷,引入人工势场策略,设计一种合力势场引导的RRT算法(APF-RRT),通过势场合力引导随机采样方向,减少盲目性,并融入动态步长调整机制,在提升规划效率的同时生成更平滑的全局路径。在局部规划中针对动态窗口法(DWA)在复杂环境中固定权重适应性差的问题,通过模糊控制的自适应动态权重调整策略,增强动态避障的安全性。最后,在MATLAB中搭建井下场景进行仿真验证。研究结果表明,机器人严格按照全局路径行走,在遇到动态障碍物时,能够以最短的绕行路径及时规避,既保证了全局路径的引导精度,又实现了局部避障的灵活性与高效性,有效提升井下机器人的自主规划能力与作业安全。

       

      Abstract: To address the issues of low path planning efficiency and insufficient safety in underground coal mines caused by complex environments and numerous dynamic obstacles, this study proposes a hierarchical collaborative path planning framework. In global planning, to address the shortcomings of the traditional Rapidly Expanding Random Tree(RRT) algorithm−namely, its high randomness and tortuous paths−this study introduces an artificial potential field strategy and designs a potential field-guided RRT algorithm(APF-RRT). By using the potential field to guide random sampling directions, the algorithm reduces randomness and incorporates a dynamic step size adjustment mechanism, thereby generating smoother global paths while improving planning efficiency. In local planning, to address the poor adaptability of the Dynamic Window Approach(DWA) in complex environments due to its fixed weights, it employs a fuzzy-controlled adaptive dynamic weight adjustment strategy to enhance the safety of dynamic obstacle avoidance. Finally, an underground scenario is simulated and validated in MATLAB. The results demonstrate that the robot strictly follows the global path and, upon encountering dynamic obstacles, can promptly avoid them via the shortest detour path. This approach ensures both the guidance accuracy of the global path and the flexibility and efficiency of local obstacle avoidance, effectively enhancing the autonomous planning capabilities and operational safety of underground robots.

       

    /

    返回文章
    返回