煤矿智能安全巡检机器人导航定位及协同作业研究

    Navigation positioning and collaborative operation of intelligent safety inspection robots in coal mines

    • 摘要: 煤矿矿井安全巡检是煤矿安全检查的核心环节,对于实现煤矿安全生产、保障矿工人身安全具有重要意义。针对煤矿智能安全巡检机器人在定位精度与多机器人协作方面的不足,提出了一种基于多源定位信息融合与领航−跟随控制法的巡检机器人融合定位与协同作业模型。为解决矿井井下定位信号不稳定及定位精度低的问题,采用惯性导航系统、激光雷达定位系统、超宽带定位系统3种定位系统进行井下定位,并通过扩展卡尔曼滤波器与加权融合将3种定位系统的数据信息进行融合,用以执行巡检机器人的导航定位。在狭长且复杂的井下环境中,单个机器人的巡检难度极高,并且耗时较长,往往需要通过多机器人协同作业的方式进行安全巡检。为实现更高效协调的多机器人协同作业,采用领航−跟随控制法进行多机器人编队,并采用基于有向图的图论方法对领航−跟随控制法进行改进,得到了基于图论的改进领航−跟随控制算法。在仿真试验中,所提模型获得轨迹在x方向的最大均方根误差为0.578 m,平均均方根误差为0.295 m,在y方向的最大均方根误差为0.155 m,均具有较小的误差,说明模型具有较高的定位精度。在不同场景的试验结果中,采用所提模型进行定位的机器人在L形巷道下的x分量位置误差均值最大值为0.380 m,在联络型巷道下的x分量位置误差均值最大值为0.442 m,仍具有较小误差,进一步验证了模型具有优越的定位性能。此外,研究结果表明:在加入障碍物后,4个跟随者机器人在避障中的最大偏移量在1.025 m以内,具有较小的误差;避障后,跟随者机器人迅速收敛至理想轨迹,避障和恢复时间均在20 s左右,具有较快的收敛速度。

       

      Abstract: Safety inspection of coal mine shafts is the core link of coal mine safety checks, which is of great significance for achieving safe production in coal mines and ensuring the personal safety of miners. Aiming at the deficiencies of intelligent safety inspection robots in coal mines in terms of positioning accuracy and multi-robot collaboration, a fusion positioning and collaborative operation model for inspection robots based on multi-source positioning information fusion and navigation-following control method is proposed. To address the issues of unstable positioning signals and low positioning accuracy in underground mines, this study adopts three positioning systems, namely inertial navigation system, liDAR positioning system and ultra-wideband positioning system, for underground positioning. The data information of the three positioning systems is fused through the extended Kalman filter and weighted fusion to perform the navigation and positioning of inspection robots. In the long and complex underground environment, the inspection of a single robot is extremely difficult and time-consuming. Safety inspections often need to be carried out through the collaborative operation of multiple robots. To achieve more efficient and coordinated multi-robot collaborative operations, the research adopts the navigation-following control method for multi-robot formation and improves the navigation-following control method by using the graph theory method based on directed graphs, obtaining an improved navigation-following control algorithm based on graph theory for robot collaborative operation formation. In the simulation experiment, it was proposed that the maximum root mean square error value of the trajectory obtained by the model in the x direction was 0.578 m, the average root mean square error value was 0.295 m, and the maximum root mean square error value in the y direction was 0.155 m. Both had relatively small errors, indicating that the proposed model had high positioning accuracy. In the experimental results of different scenarios, the mean maximum value of the x-component position error of the robot using the model proposed in the research in the L-shaped roadway is 0.380 m, and the mean maximum value of the x-component position error in the connecting roadway is 0.442 m. It still has a relatively small error, further verifying that the model has superior positioning performance. Furthermore, the research results indicate that after adding obstacles, the maximum offset of the four follower robots in obstacle avoidance is within 1.025 meters, with a relatively small error. After obstacle avoidance, the follower robot quickly converges to the ideal trajectory. Both the obstacle avoidance and recovery time are approximately 20 seconds, demonstrating a relatively fast convergence speed.

       

    /

    返回文章
    返回