APMC-LOM: Accurate 3D LiDAR Odometry and Mapping Based on Pyramid Warm-Up Registration and Multi-Constraint Optimization
- 5 September 2024
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Vehicular Technology
- Vol. 73 (12) , 18266-18282
Abstract
Simultaneous localization and mapping (SLAM) based on LiDAR plays a pivotal role in many unmanned systems, but currently suffers from drift in trajectory estimation and lacks of robustness, resulting in inconsistent global maps. This paper proposes an accurate and robust LiDAR SLAM system to achieve low-drift ego-motion estimation and globally consistent mapping for unmanned ground vehicles (UGVs) in diverse environments. Firstly, a pyramid warm-up registration method is proposed to directly match the current scan with the map without feature extraction. More importantly, it utilizes the original geometric information to improve the registration accuracy and adopts a fast covariance matrix calculation method to greatly enhance the registration speed. Secondly, a submap generation method is proposed by formulating an anti-slip strategy and a point cloud similarity metric. It effectively prevents the loss of critical information while establishing strong constraints between keyframes and the map. Finally, a local-to-global optimization factor graph is constructed by establishing multi-level constraint relationships to optimize the overall system accuracy. The proposed method is compared with the current state-of-the-art LiDAR SLAM methods on several challenging datasets, including the KITTI, NeBula, and Newer College datasets. Experimental results show that our method has higher trajectory estimation accuracy and map consistency, and performs robustly in disparate environmentsKeywords
Funding Information
- National Natural Science Foundation of China (52232015)
- National Natural Science Foundation of China (62303428)
- China Postdoctoral Science Foundation (2023M743259)
- Zhejiang Provincial Natural Science Foundation of China (LQ23F030010)
- Natural Science Foundation of Heilongjiang Province (LH2023F024)
This publication has 42 references indexed in Scilit:
- CT-ICP: Real-time Elastic LiDAR Odometry with Loop Closure2022
- MULLS: Versatile LiDAR SLAM via Multi-metric Linear Least Square2021
- SuMa++: Efficient LiDAR-based Semantic SLAM2019
- LO-Net: Deep Real-Time Lidar Odometry2019
- LeGO-LOAM: Lightweight and Ground-Optimized Lidar Odometry and Mapping on Variable Terrain2018
- IMLS-SLAM: Scan-to-Model Matching Based on 3D Data2018
- NICP: Dense normal based point cloud registration2015
- Are we ready for autonomous driving? The KITTI vision benchmark suite2012
- The normal distributions transform: a new approach to laser scan matching2004
- A method for registration of 3-D shapesIEEE Transactions on Pattern Analysis and Machine Intelligence, 1992