High-Precision and Fast LiDAR Odometry and Mapping Algorithm
Open Access
- 20 March 2022
- journal article
- Published by Fuji Technology Press Ltd. in Journal of Advanced Computational Intelligence and Intelligent Informatics
- Vol. 26 (2), 206-216
- https://doi.org/10.20965/jaciii.2022.p0206
Abstract
LiDAR SLAM technology is an important method for the accurate navigation of automatic vehicles and is a prerequisite for the safe driving of automatic vehicles in the unstructured road environment of complex parks. This paper proposes a LiDAR fast point cloud registration algorithm that can realize fast and accurate localization and mapping of automatic vehicle point clouds through a combination of a normal distribution transform (NDT) and point-to-line iterative closest point (PLICP). First, the NDT point cloud registration algorithm is applied for the rough registration of point clouds between adjacent frames to achieve a rough estimate of the pose of automatic vehicles. Then, the PLICP point cloud registration algorithm is adopted to correct the rough registration result of the point cloud. This step completes the precise registration of the point cloud and achieves an accurate estimate of the pose of the automatic vehicle. Finally, cloud registration is accumulated over time, and the point cloud information is continuously updated to construct the point cloud map. Through numerous experiments, we compared the proposed algorithm with PLICP. The average number of iterations of the point cloud registration between adjacent frames was reduced by 6.046. The average running time of the point cloud registration between adjacent frames decreased by 43.05156 ms. The efficiency of the point cloud registration calculation increased by approximately 51.7%. By applying the KITTI dataset, the computational efficiency of NDT-ICP was approximately 60% higher than that of LeGO-LOAM. The proposed method realizes the accurate localization and mapping of automatic vehicles relying on vehicle LiDAR in a complex park environment and was applied to a Small Cyclone automatic vehicle. The results indicate that the proposed algorithm is reliable and effective.Keywords
Funding Information
- Demonstration and verification of high-precision map and fusion positioning (2021YFB2501105)
- Autonomous driving real-time urban road scene understanding based on visual computing (61871039)
- Key technology for multi-view video information acquisition and localization of autonomous vehicle (61871038)
- Beijing Municipal High-level Innovative Team Construction Plan for High-level Teacher Team Construction Support Program (IDHT20170511)
This publication has 26 references indexed in Scilit:
- Efficient Large-Scale 3D Mobile Mapping and Surface Reconstruction of an Underground MineSpringer Tracts in Advanced Robotics, 2013
- iSAM2: Incremental smoothing and mapping using the Bayes treeThe International Journal of Robotics Research, 2011
- Bridging the gap between feature- and grid-based SLAMRobotics and Autonomous Systems, 2010
- Large-Scale Visual Odometry for Rough TerrainPublished by Springer Science and Business Media LLC ,2010
- Keypoint design and evaluation for place recognition in 2D lidar mapsRobotics and Autonomous Systems, 2009
- GPU-Accelerated Nearest Neighbor Search for 3D RegistrationLecture Notes in Computer Science, 2009
- Scan registration for autonomous mining vehicles using 3D‐NDTJournal of Field Robotics, 2007
- Visual odometry for ground vehicle applicationsJournal of Field Robotics, 2006
- Object modelling by registration of multiple range imagesImage and Vision Computing, 1992
- A method for registration of 3-D shapesIEEE Transactions on Pattern Analysis and Machine Intelligence, 1992