基于信息增益与拓扑简化的井下机器人自主探索与安全导航方法

Autonomous exploration and safe navigation method for underground robots based on information gain and topology simplification

  • 摘要: 随着智能矿山建设的不断深入,井下巡检机器人的应用对提升矿山安全、保障作业效率具有重要意义。针对井下复杂未知环境中机器人自主探索与安全导航的需求,重点解决在井下结构化复杂的环境中,有效识别未知区域与已知区域的分界以及在导航过程中严格遵守井下交通及安全规范的难点,实现井下巡检机器人自主构图和边界探索。系统框架主要包括建图模块、自主探索模块、规则导航模块和局部协同模块。首先,利用基于Fast-Lio的全局地图构建方法,融合激光雷达与IMU数据,通过误差状态卡尔曼滤波实时构建井下环境的稠密三维地图,为后续路径规划提供精准定位信息。其次,针对井下环境复杂且易受限的特点,创新性地提出一种基于信息增益的边界拓展算法。该算法通过在已探索区域与未知区域交界处生成候选目标点,并依据从候选点获得的未知体素数量计算信息增益,选取在遵循安全作业规则前提下具有较高探索价值的目标,指导机器人持续延伸已知区域。随后,结合井下固定交通规则,采用基于简化拓扑的约束导航方法,将复杂连续环境抽象为节点与连边组成的拓扑图,缩减搜索空间,并通过规则约束明确可通行区域,实现机器人在路径规划过程中遵循“靠右行驶”等安全要求。此外,针对动态障碍物的存在,系统设计了局部路径簇采样策略,通过对局部路径进行平滑化处理及多项代价评估,筛选出最优轨迹,确保机器人在动态环境中能够及时作出调整并保持安全行驶。在仿真实验中,相较于基于RRT采样视点和传统前沿规划方法,所提探索算法在轨迹长度方面分别减少约42.8%与26.8%,探索时间分别缩短34.8%和18.6%。同时,基于拓扑空间简化的A*算法在满足行驶安全规则的前提下,实现了路径规划时间降低近98%,并实现大幅的地图内存占用降低。在未来的工作中,将进一步研究在崎岖复杂采掘面地形下的巡检机器人安全导航任务。

     

    Abstract: With the continuous advancement of intelligent mine construction, the application of underground inspection robots plays a significant role in improving mine safety and ensuring operational efficiency. It addresses the challenges of autonomous exploration and safe navigation in complex and unknown underground environments, with a focus on effectively identifying the boundary between unknown and known areas and strictly adhering to underground traffic and safety regulations during navigation. A system framework is constructed, consisting of a mapping module, an autonomous exploration module, a rule-based navigation module, and a local coordination module. Firstly, a global map construction method based on Fast-LIO is employed, which fuses LiDAR and IMU data through an error-state Kalman filter to build a dense 3D map of the underground environment in real time, providing accurate localization information for subsequent path planning. Secondly, considering the complexity and spatial limitations of underground environments, an innovative boundary expansion algorithm based on information gain is proposed. The algorithm generates candidate target points at the frontier between known and unknown regions, calculates their information gain based on the number of unknown voxels, and selects high-value targets under safety constraints to guide the robot in continuously expanding the known area. Subsequently, in accordance with fixed underground traffic regulations, a constraint navigation method based on simplified topological abstraction is used to model the environment as a topological graph of nodes and edges. This reduces the search space and defines passable areas through rule constraints, ensuring the robot follows safety requirements such as “keep to the right” during path planning. Furthermore, to address dynamic obstacles, a local path cluster sampling strategy is designed. By smoothing local paths and evaluating multiple cost metrics, the optimal trajectory is selected to ensure the robot can make timely adjustments and navigate safely in dynamic environments. In simulation experiments, compared to RRT-based viewpoint sampling and traditional frontier-based exploration methods, the proposed exploration algorithm reduces trajectory length by approximately 42.8% and 26.8%, and decreases exploration time by 34.8% and 18.6%, respectively. Meanwhile, the simplified topological A* algorithm achieves nearly a 98% reduction in planning time and significantly reduces map memory usage, all while complying with traffic rules. Future work will further explore the safe navigation tasks of inspection robots operating in rugged and complex mining face terrains.

     

/

返回文章
返回