Abstract:The ICP registration algorithm has been a preferred method for LiDAR-based robot localization for nearly a decade. However, even in modern SLAM solutions, ICP can degrade and become unreliable in geometrically ill-conditioned environments. Current solutions primarily focus on utilizing additional sources of information, such as external odometry, to either replace the degenerate directions of the optimization solution or add additional constraints in a sensor-fusion setup afterward. In response, this work investigates and compares new and existing degeneracy mitigation methods for robust LiDAR-based localization and analyzes the efficacy of these approaches in degenerate environments for the first time in the literature at this scale. Specifically, this work proposes and investigates i) the incorporation of different types of constraints into the ICP algorithm, ii) the effect of using active or passive degeneracy mitigation techniques, and iii) the choice of utilizing global point cloud registration methods on the ill-conditioned ICP problem in LiDAR degenerate environments. The study results are validated through multiple real-world field and simulated experiments. The analysis shows that active optimization degeneracy mitigation is necessary and advantageous in the absence of reliable external estimate assistance for LiDAR-SLAM. Furthermore, introducing degeneracy-aware hard constraints in the optimization before or during the optimization is shown to perform better in the wild than by including the constraints after. Moreover, with heuristic fine-tuned parameters, soft constraints can provide equal or better results in complex ill-conditioned scenarios. The implementations used in the analysis of this work are made publicly available to the community.

What problem does this paper attempt to address?

The paper attempts to address the issue of performance degradation in LiDAR-based point cloud registration algorithms (such as ICP) in environments with insufficient geometric features (i.e., degenerate environments). Specifically, the paper focuses on the following points: 1. **Detection and Analysis of Degenerate Directions**: In degenerate environments, point cloud registration algorithms are prone to getting stuck in local minima or failing to converge to the correct solution. The paper explores how to detect these degenerate directions and analyzes their impact on the optimization process. 2. **Comparison of Degeneracy Mitigation Methods**: The paper compares existing and new degeneracy mitigation methods, including: - **Different Types of Constraints**: How to introduce different constraint conditions into the ICP algorithm. - **Active and Passive Degeneracy Mitigation Techniques**: Active techniques mitigate degeneracy by modifying the optimization problem itself, while passive techniques rely on external sensor data to assist optimization. - **Application of Global Point Cloud Registration Methods**: Exploring the effectiveness of using global point cloud registration methods in degenerate environments. 3. **Experimental Validation**: Through multiple real-world and simulated experiments, the effectiveness and robustness of these methods in complex degenerate environments are validated. The main contributions of the paper include: - A comprehensive study on the effectiveness of different types of constraints in the optimization problem of degenerate point cloud registration. - The first implementation in the literature of subspace Tikhonov regularization, truncated singular value decomposition, and inequality-constrained ICP methods. - A fair comparison of these methods through simulated and actual robot experiments. - Open-source implementation of all studied methods to facilitate future research. Overall, the paper aims to improve the robustness and accuracy of LiDAR-based SLAM systems in degenerate environments.

Informed, Constrained, Aligned: A Field Analysis on Degeneracy-aware Point Cloud Registration in the Wild

A Real-time Degeneracy Sensing and Compensation Method for Enhanced LiDAR SLAM

Probabilistic Degeneracy Detection for Point-to-Plane Error Minimization

Point cloud registration for LiDAR and photogrammetric data: A critical synthesis and performance analysis on classic and deep learning algorithms

GenZ-ICP: Generalizable and Degeneracy-Robust LiDAR Odometry Using an Adaptive Weighting

DeepICP: An End-to-End Deep Neural Network for 3D Point Cloud Registration

Adaptive Denoising-Enhanced LiDAR Odometry for Degeneration Resilience in Diverse Terrains

Learning-based Localizability Estimation for Robust LiDAR Localization

TCM-ICP: Transformation Compatibility Measure for Registering Multiple LIDAR Scans

Stress-Testing Point Cloud Registration on Automotive LiDAR

Real-time measurement of model attitude based on NDT and ICP

Global Registration of 3D LiDAR Point Clouds Based on Scene Features: Application to Structured Environments

IMU-Aided Registration of MLS Point Clouds Using Inertial Trajectory Error Model and Least Squares Optimization

LiDAR-Generated Images Derived Keypoints Assisted Point Cloud Registration Scheme in Odometry Estimation

A Single Correspondence Is Enough: Robust Global Registration to Avoid Degeneracy in Urban Environments

IGE-LIO: Intensity Gradient Enhanced Tightly Coupled LiDAR-Inertial Odometry

Kinematic-ICP: Enhancing LiDAR Odometry with Kinematic Constraints for Wheeled Mobile Robots Moving on Planar Surfaces

An Intensity-Augmented LiDAR-Inertial SLAM for Solid-State LiDARs in Degenerated Environments

Registration‐based point cloud deskewing and dynamic lidar simulation

A novel robust point cloud registration method based on directional feature weighted constraint

Registration of Laser Scanning Point Clouds: A Review