Robust and High-Precision Point Cloud Registration Method Based on 3D-NDT Algorithm for Vehicle Localization
- 30 April 2025
- journal article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Vehicular Technology
- Vol. 74 (9) , 13865-13877
Abstract
Point cloud registration plays a pivotal role in LiDAR-based vehicle localization, as its robustness and accuracy directly influence the map generation quality and localization precision. The 3D Normal Distributions Transform (3D-NDT) is a competitive registration algorithm that excels in handling noise and dynamic changes in complex environments. However, its performance is hindered by the blurring of local point cloud features caused by voxelization. To address this limitation, this paper proposes an improved 3D-NDT registration method that leverages point cloud normal vector segmentation and voxelization techniques to optimize the registration process, improving both accuracy and matching scope. Initially, a plane point cloud clustering technique is employed for preliminary voxel partitioning. This is followed by plane point cloud subdivision, which further refines the voxels to ensure a uniform voxel cell size, thereby appropriately weighting each voxel cell's contribution to the objective function. The proposed method employs a dual-stage voxel division strategy, utilizing two distinct voxel sizes tailored to different optimization phases. In the first stage, a larger grid size broadens the matching scope and enhances the efficiency of preliminary registration. The resulting output serves as the starting point for the refined registration phase, where a smaller grid size is used to improve matching precision. Experimental results demonstrate that the proposed method achieves a 50% reduction in median translation error (from $1.0 \times 10^{-3}$ m to $0.5 \times 10^{-3}$ m) and a 50% reduction in median rotation error (from 0.01° to 0.005°) compared to the original 3D-NDT algorithm. Furthermore, it significantly improves matching robustness and accuracy by extending the effective matching range by 100% for translation (from 1.2 m to 2.4 m) and 25.6% for rotation (from 39° to 49°).Keywords
Funding Information
- National Natural Science Foundation of China (52402487)
- Research and Development Program of Beijing Municipal Education Commission (KM202310005033)
- National Key Research and Development Program of China (2021YFB1716200)
- Research Funds for Leading Talents Program (048000514122549)
This publication has 24 references indexed in Scilit:
- A Survey on Global LiDAR Localization: Challenges, Advances and Open ProblemsInternational Journal of Computer Vision, 2024
- Reliable Monte Carlo localization for mobile robotsJournal of Field Robotics, 2023
- Localization strategies for autonomous mobile robots: A reviewJournal of King Saud University Computer and Information Sciences, 2022
- NDT-Transformer: Large-Scale 3D Point Cloud Localisation using the Normal Distribution Transform Representation2021
- Particle swarm optimization for solving a scan-matching problem based on the normal distributions transformEvolutionary Intelligence, 2021
- The Iterative Closest Point Registration Algorithm Based on the Normal Distribution TransformationProcedia Computer Science, 2019
- Point cloud registration algorithm based on NDT with variable size voxel2015
- Scan registration with multi-scale k-means normal distributions transform2012
- Scan registration for autonomous mining vehicles using 3D‐NDTJournal of Field Robotics, 2007
- The normal distributions transform: a new approach to laser scan matching2004