Abstract
Simultaneous localization and mapping (SLAM) via LiDAR-inertial Odometry (LIO) is a crucial technology in many automated applications. However, constructing a consistent state estimator with an efficient mapping method still remains a challenge for LIO systems. In this paper, we propose a tightly-coupled LIO system via invariant extended Kalman filter (InEKF) and efficient surfel mapping. Firstly, based on the InEKF theory, we build a consistent state estimator for a tightly-coupled LIO system. Secondly, we propose a novel LIO system by combining the invariant EKF state estimator with a surfel-based map, named SuIn-LIO, which not only enables the accuracy of state estimation and mapping, but also enables real-time registration of a new LiDAR scan. Extensive experiments on different public benchmark datasets demonstrate that SuIn-LIO can achieve comparable performance with other state-of-the-art methods in accuracy and efficiency. To benefit of the community, our implementation will be open-sourced on Github.
Funding Information
  • National Natural Science Foundation of China (62206188)
  • Sichuan Province Innovative Talent Funding Project for Postdoctoral Fellows
  • China Postdoctoral Science Foundation (2022M712237)
  • 111 Project (B21044)