A Consistency-Improved LiDAR-Inertial Bundle Adjustment
Xinran Li, Shuaikang Zheng, Pengcheng Zheng, Xinyang Wang, Jiacheng Li, Zhitian Li, Xudong Zou
Abstract
Simultaneous Localization and Mapping (SLAM) using 3D LiDAR has emerged as a cornerstone for autonomous navigation in robotics. While feature-based SLAM systems have achieved impressive results by leveraging edge and planar structures, they often suffer from the inconsistent estimator associated with feature parameterization and estimated covariance. In this work, we present a consistency-improved LiDAR-inertial bundle adjustment (BA) with tailored parameterization and estimator. First, we propose a stereographic-projection representation parameterizing the planar and edge features, and conduct a comprehensive observability analysis to support its integrability with consistent estimator. Second, we implement a LiDAR-inertial BA with Maximum a Posteriori (MAP) formulation and First-Estimate Jacobians (FEJ) to preserve the accurate estimated covariance and observability properties of the system. Last, we apply our proposed BA method to a LiDAR-inertial odometry. Experimental results demonstrate that our approach significantly reduces long-term drift, outperforming state-of-the-art systems in both accuracy and consistency.
BibTeX
@inproceedings{ral2026_aconsistencyimpr,
title = {A Consistency-Improved LiDAR-Inertial Bundle Adjustment},
author = {Xinran Li and Shuaikang Zheng and Pengcheng Zheng and Xinyang Wang and Jiacheng Li and Zhitian Li and Xudong Zou},
booktitle = {RA-L 2026},
year = {2026}
}