基于Cartographer的煤矿巡检机器人SLAM算法优化

    Optimization of SLAM algorithm for coal mine inspection robots based on Cartographer

    • 摘要: 为提升巡检机器人在设备密集、动态遮挡频发的露天煤矿筛分楼复杂环境中的定位与建图精度,解决传统 Cartographer 算法在此类场景下因传感器数据处理精度不足、前端位姿融合效果欠佳、计算效率偏低而引发的定位漂移与地图畸变问题,提出了一种基于多层次、多传感器融合的改进即时定位与地图构建(Simultaneous Localization and Mapping, SLAM)算法。首先,采用扩展卡尔曼滤波(Extended Kalman Filter, EKF)技术对惯性测量单元(Inertial Measurement Unit, IMU)的原始角速度和加速度数据进行预处理,优化其航姿解算过程,有效抑制传感器噪声与零偏,从而获取更精确可靠的机器人俯仰、滚转和偏航姿态信息;其次,在SLAM前端设计了一个基于EKF的位姿融合器,将上述优化后的IMU姿态数据与轮式里程计提供的位移信息进行紧耦合融合,为激光雷达的扫描匹配环节提供更高精度的初始位姿估计,提升匹配成功率与效率;最后,针对环境的多变性与复杂性,构建了一个系统级的融合框架,将激光雷达扫描数据、优化后的IMU位姿、里程计信息及闭环检测信息进行融合,利用Ceres求解器进行全局图优化,形成冗余且互补的感知体系。为全面验证算法性能,在模拟露天煤矿筛分楼结构的长走廊环境中开展了建图试验,选取10个特征点进行测量,改进算法构建地图的测量平均相对误差为0.432%,远低于传统算法的2.042%。最终,在真实露天煤矿筛分楼场景中进行了部署验证,使用高精度全站仪测量40组人工标记点间的真实距离,与算法所建地图中对应点距离进行对比,其平均绝对误差不超过2 cm,且有效消除了地图的重影与扭曲现象。结果表明,所提出的改进算法通过EKF优化IMU姿态、融合IMU和里程计数据以及多层次传感器信息,提升了在强遮挡、动态干扰及特征重复环境下的定位精度、地图一致性、建图准确性和系统整体鲁棒性,满足露天煤矿筛分楼巡检机器人对高精度自主导航的工程需求。

       

      Abstract: To improve the positioning and mapping accuracy of inspection robots in the complex environment of screening buildings in open-pit coal mines, which is characterized by dense equipment and frequent dynamic occlusions, and to solve the problems of positioning drift and map distortion caused by insufficient sensor data processing accuracy, poor front-end pose fusion performance, and low computational efficiency of the traditional Cartographer algorithm in such scenarios, an improved Simultaneous Localization and Mapping (SLAM) algorithm based on multi-level and multi-sensor fusion is proposed. Firstly, the Extended Kalman Filter (EKF) technique is used to preprocess the raw angular velocity and acceleration data of the Inertial Measurement Unit (IMU), optimize its attitude solution process, effectively suppress sensor noise and bias, and thus obtain more accurate and reliable robot pitch, roll and yaw attitude information. Secondly, an EKF-based pose fusion module is designed at the SLAM front end to perform tightly coupled fusion of the optimized IMU attitude data with the displacement information provided by wheel odometry, which provides higher-precision initial pose estimation for LiDAR scan matching and improves the success rate and efficiency of matching. Finally, aiming at the variability and complexity of the environment, a system-level fusion framework is constructed to fuse LiDAR scan data, optimized IMU pose, odometry information and loop closure detection information. Global graph optimization is carried out using the Ceres solver, forming a redundant and complementary perception system. To comprehensively verify the algorithm performance, mapping experiments were carried out in a long corridor environment simulating the structure of an open-pit coal mine screening building. Ten feature points were selected for measurement, and the average relative error of the map constructed by the improved algorithm was 0.432%, much lower than 2.042% of the traditional algorithm. Finally, deployment verification was conducted in a real open-pit coal mine screening building scenario. The real distances between 40 groups of manually marked points were measured by a high-precision total station and compared with the corresponding distances in the map constructed by the algorithm. The average absolute error was no more than 2 cm, and ghosting and distortion of the map were effectively eliminated. The results show that the proposed improved algorithm enhances positioning accuracy, map consistency, mapping accuracy and overall system robustness in environments with strong occlusion, dynamic interference and repeated features through EKF-optimized IMU attitude, fusion of IMU and odometry data, and multi-level sensor information fusion, which meets the engineering requirements of high-precision autonomous navigation for inspection robots in open-pit coal mine screening buildings.

       

    /

    返回文章
    返回