Exact Point Cloud Downsampling for Fast and Accurate Global Trajectory Optimization

Kenji Koide,Shuji Oishi,Masashi Yokozuka,Atsuhiko Banno
2023-12-25
Abstract:This paper presents a point cloud downsampling algorithm for fast and accurate trajectory optimization based on global registration error minimization. The proposed algorithm selects a weighted subset of residuals of the input point cloud such that the subset yields exactly the same quadratic point cloud registration error function as that of the original point cloud at the evaluation point. This method accurately approximates the original registration error function with only a small subset of input points (29 residuals at a minimum). Experimental results using the KITTI dataset demonstrate that the proposed algorithm significantly reduces processing time (by 87\%) and memory consumption (by 99\%) for global registration error minimization while retaining accuracy.
Robotics
What problem does this paper attempt to address?
### Problems the Paper Attempts to Solve This paper aims to address the high computational cost and memory consumption in global trajectory optimization for point clouds. Specifically: 1. **Problem Background**: - Global trajectory optimization is a key step in localization and mapping systems. - During real-time odometry estimation, trajectory errors inevitably accumulate, necessitating the correction of estimation drift by considering the overall consistency of the map. - Global registration error minimization is an accurate method that directly minimizes the registration error of multi-frame point clouds across the entire map, avoiding the Gaussian approximation of relative pose constraints, thereby achieving precise trajectory optimization. 2. **Limitations of Existing Methods**: - Traditional pose graph optimization minimizes errors in the pose space, whereas global registration error minimization directly minimizes the registration error of multi-frame point clouds. - Although global registration error minimization is more accurate, it is computationally expensive because it requires re-evaluating the registration error function for many points and needs a large amount of memory to store the correspondences between point clouds. 3. **Proposed Method**: - To reduce the processing cost and memory consumption of global registration error minimization, the authors propose a point cloud downsampling method based on an efficient and accurate weighted core-set extraction algorithm. - The proposed algorithm selects a weighted subset from the input point cloud, such that this subset generates the same quadratic registration error function at the evaluation points as the original point cloud. - Experimental results show that the algorithm significantly reduces processing time and memory consumption (by 87% and 99%, respectively) while maintaining accuracy. ### Main Contributions - Extended the exact core-set extraction algorithm from the literature [5] to extract any number of residuals and improved the algorithm to enhance processing speed. - Proposed a point cloud downsampling algorithm based on the extended core-set extraction algorithm, which accurately recovers the original quadratic registration error function at the evaluation points and has good nonlinear approximation accuracy. - Open-sourced the code for the proposed weighted core-set extraction algorithm.