司垒,王忠宾,魏东,等. 基于IMU-LiDAR紧耦合的煤矿防冲钻孔机器人定位导航方法[J]. 煤炭学报,2024,49(4):2179−2194. DOI: 10.13225/j.cnki.jccs.2023.0832
引用本文: 司垒,王忠宾,魏东,等. 基于IMU-LiDAR紧耦合的煤矿防冲钻孔机器人定位导航方法[J]. 煤炭学报,2024,49(4):2179−2194. DOI: 10.13225/j.cnki.jccs.2023.0832
SI Lei,WANG Zhongbin,WEI Dong,et al. Positioning and navigation method of underground drilling robot for rock-burst prevention based on IMU-LiDAR tight coupling[J]. Journal of China Coal Society,2024,49(4):2179−2194. DOI: 10.13225/j.cnki.jccs.2023.0832
Citation: SI Lei,WANG Zhongbin,WEI Dong,et al. Positioning and navigation method of underground drilling robot for rock-burst prevention based on IMU-LiDAR tight coupling[J]. Journal of China Coal Society,2024,49(4):2179−2194. DOI: 10.13225/j.cnki.jccs.2023.0832

基于IMU-LiDAR紧耦合的煤矿防冲钻孔机器人定位导航方法

Positioning and navigation method of underground drilling robot for rock-burst prevention based on IMU-LiDAR tight coupling

  • 摘要: 防冲钻孔机器人是冲击地压矿井卸压的关键设备,其在复杂卸压巷道的精确地图构建和的稳定导航是实现钻孔作业智能化的基础和前提。在分析激光雷达点云畸变成因和同步定位与地图构建(SLAM)算法缺陷的基础上,设计了基于惯性测量单元(IMU)连续时间轨迹的点云畸变矫正方法,建立了激光雷达和IMU的数据融合模型,提出了基于IMU-LiDAR紧耦合的防冲钻孔机器人定位建图方法。根据煤矿卸压巷道特点建立了密闭坡道模型,开展了建图效果仿真分析,结果表明,所提算法在定位精度、轨迹误差方面均优于现有常用算法。在此基础上,设计了基于改进人工势场法和快速扩展随机树的动态路径规划方法,建立了适用于防冲钻孔机器人的路径规划与导航融合方案,并设计了2种仿真运动场景,结果表明,所提路径规划方法在全局路径规划和动态路径规划的平均路径长度、平均运行时间、平均生成节点数等方面均具有较好的综合性能。为了进一步验证防冲钻孔机器人定位导航方法的实用性,在校内模拟巷道、地面实验基地和井下卸压巷道等场景下开展了多组对比实验,结果表明:将IMU数据与LiDAR数据紧耦合后,所提方法的定位建图精度明显提高,在特征退化场景中具有优越的定位建图性能,且规划路径的运算效率和路径代价方面均具有良好的表现,验证了所提定位导航方法在多种场景中的可行性和优越性。

     

    Abstract: The drilling robot for rock-burst prevention is the key equipment for pressure relief in rock-burst mines, and its accurate map construction and stable navigation under complex working conditions are the basis and premise for realizing intelligent drilling operations. Based on the analysis of the causes of point cloud distortion of LiDAR and the defects of classical SLAM algorithm, a point cloud distortion correction method based on the IMU continuous time trajectory is proposed, a data fusion model of LiDAR and IMU is established, and the positioning and mapping process of drilling robot based on the IMU-LiDAR tight coupling is designed. A closed ramp model is built based on the characteristics of coal mine pressure relief roadways, and the simulation analysis of the mapping effect is conducted. The results show that the proposed mapping algorithm outperforms existing commonly used methods in terms of positioning accuracy and trajectory error. On this basis, a dynamic path planning method based on the improved artificial potential field and rapidly-exploring random tree is proposed, and a path planning and navigation fusion scheme suitable for drilling robot is designed. Two simulation motion scenarios are then designed, and the results indicate that the proposed path planning method has a better comprehensive performance in terms of average path length, average running time, and average number of generated nodes in both global and dynamic path planning. In order to further verify the practicality of the positioning and navigation method, multiple comparative experiments are conducted in a simulated roadway, ground experimental base and underground pressure relief roadway, and the results indicate that after tightly coupling IMU data with LiDAR data, the positioning accuracy of the proposed method is significantly improved and has a superior positioning performance in feature degradation scenarios. In addition, the planning path has better performance in terms of computational efficiency and cost. The results prove the feasibility and superiority of the proposed positioning and navigation method in various scenarios.

     

/

返回文章
返回
Baidu
map