MSC-LIO: An MSCKF-Based LiDAR-Inertial Odometry with Same-Plane-Point Tracking

Tisheng Zhang,Man Yuan,Linfu Wei,Hailiang Tang,Xiaoji Niu

2024-08-11

Abstract:The multi-state constraint Kalman filter (MSCKF) has been proven to be more efficient than graph optimization for visual-based odometry while with similar accuracy. However, it has not yet been properly considered and studied for LiDAR-based odometry. In this paper, we propose a novel tightly coupled LiDAR-inertial odometry based on the MSCKF framework, named MSC-LIO. An efficient LiDAR same-plane-point (LSPP) tracking method, without explicit feature extraction, is present for frame-to-frame data associations. The tracked LSPPs are employed to build an LSPP measurement model, which constructs a multi-state constraint. Besides, we propose an effective point-velocity-based LiDAR-IMU time-delay (LITD) estimation method, which is derived from the proposed LSPP tracking method. Extensive experiments were conducted on both public and private datasets. The results demonstrate that the proposed MSC-LIO yields higher accuracy and efficiency than the state-of-the-art methods. The ablation experiment results indicate that the data-association efficiency is improved by nearly 3 times using the LSPP tracking method. Besides, the proposed LITD estimation method can effectively and accurately estimate the LITD.

Robotics

What problem does this paper attempt to address?

### Problems the Paper Aims to Solve

This paper aims to address several key issues in LiDAR-inertial odometry (LIO) based on the fusion of LiDAR and Inertial Measurement Unit (IMU):

1. **Improving Data Association Efficiency**:
- Proposes an efficient LiDAR Surface Point (LSPP) tracking method that enables inter-frame data association without explicit feature extraction. This method significantly enhances data association efficiency.

2. **Constructing a Multi-State Constraint Measurement Model**:
- Utilizes the results of LSPP tracking to construct a multi-state constraint measurement model for more accurate state estimation.

3. **Improving Time Delay Estimation**:
- Proposes a LiDAR-IMU Time Delay (LITD) estimation method based on LSPP velocity, which effectively estimates time delay.

4. **Enhancing System Performance**:
- Validates the effectiveness and robustness of the proposed methods through experiments on public datasets and real-world environments. The results show that the proposed method outperforms existing state-of-the-art methods in terms of accuracy and efficiency.

Through these contributions, the paper aims to achieve a more efficient and accurate LIO system using the Multi-State Constraint Kalman Filter (MSCKF) framework and demonstrates its real-time performance on edge devices.