基于改进LOAM算法的煤矿机器人建图与导航研究

    Mapping and navigation of coal mine robots based on improved LOAM algorithm

    • 摘要: 为满足煤矿井下复杂环境下机器人巡检高精度建图与安全导航需求,解决传统算法在井下适应性、抗干扰及路径规划协同性不足的问题,开展了基于改进激光雷达测距和测绘(Lidar Odometry and Mapping,LOAM)算法的煤矿机器人建图与导航研究。在环境地图模型构建方面,基于SLAM(Simultaneous Localization and Mapping)框架,将激光雷达采集的点云数据转换为栅格地图;针对煤矿井下粉尘干扰,引入了基于高斯概率模型的动态滤波方法,通过计算测量点有效概率剔除低概率无效点,阈值依据粉尘浓度统计特征自动调整;在特征点提取环节,融合了几何特征与纹理特征,通过计算点云邻域灰度变化梯度补充特征描述子维度,提高特征点匹配精度与地图构建质量。路径规划方面,基于改进A*算法,采用动态权重机制,根据环境障碍物密度动态调整评估函数权重,优化全局路径规划;采用动态窗口法(Dynamic Window Approach,DWA)进行局部路径规划,新增轨迹曲率惩罚项,抑制机器人急转运动;两者融合后的路径规划融合算法实现了分层式导航。仿真试验表明,改进LOAM算法地图构建绝对误差控制在−0.053~0.035 m,相对误差≤2.65%,在不同粉尘浓度环境下,运行时间和最大相对误差均优于对比算法。路径规划方面与改进蝙蝠算法、改进快速扩展随机树算法进行对比,所提算法运行时间约2 s,规划路径长度较短,避障成功率最高达98.8%。真实煤矿环境测试中,在山西某煤矿井下2 000 m巷道,连续运行8 h构建500 m巷道地图,绝对误差范围收窄至−0.042~0.028 m,相对误差最大值3.2%,平均运行时间1.8 s,避障成功率为96.7%。改进LOAM算法及路径规划融合算法能够提升煤矿机器人在复杂井下环境的建图精度与导航效率。

       

      Abstract: In order to meet the requirements of high-precision mapping and safe navigation for robot inspection in complex underground coal mine environment, and solve the problems of insufficient adaptability, anti-interference and path planning coordination of traditional algorithms in underground coal mine, the research on coal mine robot mapping and navigation based on improved lidar odometry and mapping (LOAM) algorithm was carried out. In the construction of environmental map model, based on simultaneous localization and mapping (SLAM) framework, the point cloud data collected by lidar is converted into grid map. Aiming at the dust interference in coal mine, the dynamic filtering method based on Gaussian probability model is introduced. The low probability invalid points are eliminated by calculating the effective probability of measurement points, and the threshold is automatically adjusted according to the statistical characteristics of dust concentration. In the process of feature point extraction, geometric features and texture features are fused, and the sub dimension of feature description is supplemented by calculating the gray change gradient in the neighborhood of point cloud, so as to improve the accuracy of feature point matching and the quality of map construction. In terms of path planning, based on the improved A* algorithm, a dynamic weight mechanism is adopted to dynamically adjust the weights of the evaluation function according to the density of environmental obstacles, thereby optimizing the global path planning. The dynamic window approach (DWA) is used for local path planning, and the trajectory curvature penalty item is added to suppress the rapid turning motion of the robot, and the two are integrated to realize hierarchical navigation. Simulation results show that the absolute error of map construction based on improved LOAM algorithm is controlled within the range of −0.053 m to 0.035 m, and the relative error is less than or equal to 2.65%. In different dust concentration environment conditions, both the running time and the maximum relative error are better than those of the comparison algorithm. Compared with the improved bat algorithm and the improved fast expansion random tree algorithm, the path planning fusion algorithm has a running time of about 2 s, a shorter path length, and a maximum obstacle avoidance success rate of 98.8%. In the real coal mine environment test, a 500 m roadway map was constructed in a 2 000 m undergrand roadway in a coal mine in Shanxi after continuous operation for 8 h. The absolute error range is narrowed down to −0.042 m to 0.028 m, the maximum relative error was 3.2%, the average running time of navigation algorithm was 1.8 s, and the success rate of obstacle avoidance was 96.7%. The improved LOAM algorithm and path planning fusion algorithm can improve the mapping accuracy and navigation efficiency of coal mine robot in complex underground environment.

       

    /

    返回文章
    返回