A LiDAR-Inertial SLAM Tightly-Coupled with Dropout-Tolerant GNSS Fusion for Autonomous Mine Service Vehicles

Yusheng Wang,Yidong Lou,Weiwei Song,Bing Zhan,Feihuang Xia,Qigeng Duan
2023-08-22
Abstract:Multi-modal sensor integration has become a crucial prerequisite for the real-world navigation systems. Recent studies have reported successful deployment of such system in many fields. However, it is still challenging for navigation tasks in mine scenes due to satellite signal dropouts, degraded perception, and observation degeneracy. To solve this problem, we propose a LiDAR-inertial odometry method in this paper, utilizing both Kalman filter and graph optimization. The front-end consists of multiple parallel running LiDAR-inertial odometries, where the laser points, IMU, and wheel odometer information are tightly fused in an error-state Kalman filter. Instead of the commonly used feature points, we employ surface elements for registration. The back-end construct a pose graph and jointly optimize the pose estimation results from inertial, LiDAR odometry, and global navigation satellite system (GNSS). Since the vehicle has a long operation time inside the tunnel, the largely accumulated drift may be not fully by the GNSS measurements. We hereby leverage a loop closure based re-initialization process to achieve full alignment. In addition, the system robustness is improved through handling data loss, stream consistency, and estimation error. The experimental results show that our system has a good tolerance to the long-period degeneracy with the cooperation different LiDARs and surfel registration, achieving meter-level accuracy even for tens of minutes running during GNSS dropouts.
Robotics
What problem does this paper attempt to address?
### Problems the Paper Aims to Solve This paper aims to address the problem of positioning and mapping for autonomous service vehicles in mining environments where satellite signals are absent. Specifically: 1. **Multi-modal Sensor Fusion**: The paper proposes a tightly coupled fusion scheme utilizing LiDAR, Inertial Measurement Unit (IMU), and wheel odometry information. By employing an Error State Kalman Filter (ESKF) and graph optimization methods, robust and high-precision positioning is achieved. 2. **Long-term Operation in Tunnels**: Due to issues such as signal loss and observation degradation inside mining tunnels, traditional SLAM methods perform poorly. To address this, the paper proposes a registration method based on surface elements (surfel) and combines it with loop closure reinitialization techniques to mitigate drift accumulation during long-term operations. 3. **System Robustness Enhancement**: By addressing issues such as data loss, flow consistency, and estimation errors, the system's robustness and accuracy are improved. Experimental results show that the system can still achieve meter-level positioning accuracy in the absence of GNSS signals and maintain good stability even after running for tens of minutes inside tunnels.