Abstract:Traditional LiDAR systems encounter significant challenges with pose estimation accumulation errors during SLAM and require improvements in algorithm efficiency and real-time performance. This paper introduces a tightly coupled LiDAR-IMU integration method with enhancements in three key areas: Point cloud undistortion, feature extraction and registration, and tightly coupled pose estimation. To mitigate point cloud distortion caused by high-speed motion, a continuous time-domain motion correction method is proposed, along with a pre-fitting plane mechanism for feature extraction to balance accuracy and computational efficiency. To address the high computational cost of KNN search during feature matching, a tracking mechanism is introduced to reduce complexity. For improving state estimation accuracy, the method employs a framework optimized using a nonlinear geometric observer. Evaluation on public datasets demonstrates that the proposed method reduces trajectory APE by 30. 52% and 21. 36% compared to LIO-SAM and Fast-LIO, respectively. Additionally, computational efficiency improves by 59. 9% and 43. 7% , making the method highly effective for real-time applications.