School of Mechanical Engineering, Xi'an University of Science and Technology, Xi'an 710054, China.
Shaanxi Key Laboratory of Mine Electromechanical Equipment Intelligent Monitoring, Xi'an 710054, China.
Sensors (Basel). 2022 Apr 15;22(8):3063. doi: 10.3390/s22083063.
Realizing robust six degrees of freedom (6DOF) state estimation and high-performance simultaneous localization and mapping (SLAM) for perceptually degraded scenes (such as underground tunnels, corridors, and roadways) is a challenge in robotics. To solve these problems, we propose a SLAM algorithm based on tightly coupled LiDAR-IMU fusion, which consists of two parts: front end iterative Kalman filtering and back end pose graph optimization. Firstly, on the front end, an iterative Kalman filter is established to construct a tightly coupled LiDAR-Inertial Odometry (LIO). The state propagation process for the a priori position and attitude of a robot, which uses predictions and observations, increases the accuracy of the attitude and enhances the system robustness. Second, on the back end, we deploy a keyframe selection strategy to meet the real-time requirements of large-scale scenes. Moreover, loop detection and ground constraints are added to the tightly coupled framework, thereby further improving the overall accuracy of the 6DOF state estimation. Finally, the performance of the algorithm is verified using a public dataset and the dataset we collected. The experimental results show that for perceptually degraded scenes, compared with existing LiDAR-SLAM algorithms, our proposed algorithm grants the robot higher accuracy, real-time performance and robustness, effectively reducing the cumulative error of the system and ensuring the global consistency of the constructed maps.
实现稳健的六自由度(6DOF)状态估计和高性能的同时定位与建图(SLAM)对于感知退化的场景(如地下隧道、走廊和道路)是机器人领域的一个挑战。为了解决这些问题,我们提出了一种基于紧耦合激光雷达-惯性测量单元(LiDAR-IMU)融合的 SLAM 算法,该算法由两部分组成:前端迭代卡尔曼滤波和后端姿态图优化。首先,在前端,建立一个迭代卡尔曼滤波器来构建紧耦合的激光雷达惯性里程计(LIO)。机器人的先验位置和姿态的状态传播过程使用预测和观测值,提高了姿态的准确性,并增强了系统的鲁棒性。其次,在后端,我们采用关键帧选择策略来满足大规模场景的实时要求。此外,在紧耦合框架中添加了回环检测和地面约束,从而进一步提高了 6DOF 状态估计的整体精度。最后,使用公共数据集和我们收集的数据集验证了算法的性能。实验结果表明,与现有的激光雷达 SLAM 算法相比,我们提出的算法在感知退化的场景中赋予机器人更高的准确性、实时性和鲁棒性,有效地减少了系统的累积误差,并确保了构建地图的全局一致性。