arXiv:2501.02580cs.RO2025-01被引 3

提出LP-ICP框架,提升极端无结构环境下的点云配准鲁棒性。

LP-ICP: General Localizability-Aware Point Cloud Registration for Robust Localization in Extreme Unstructured Environments

  • 融合点到线与点到面距离,增强几何约束检测能力
  • 在仿真与真实数据上达到或优于当前最优方法精度
  • 适合高动态、弱纹理场景的定位系统应用

迭代最近点(ICP)算法是基于激光雷达的SLAM的关键组件。然而,在缺乏特征和几何结构的无结构环境中,其性能会下降,导致定位与建图精度低、鲁棒性差。已知几何约束缺失引发的退化问题会导致6自由度姿态估计在病态方向出错。因此亟需更广义、更细粒度的退化检测与处理方法。本文提出一种新的点云配准框架LP-ICP,将点到线与点到面距离度量结合于ICP算法中,并引入可定位性检测与处理机制。不同于仅依赖点到面可定位性信息,LP-ICP通过边点(局部平滑度低)与线、平面点(局部平滑度高)与面之间的对应关系,增强可定位性分析,使单个对应约束的应用范围更广。优化模块根据可定位性类别,向优化方程中添加软/硬约束,从而在病态方向上对位姿进行约束。该方法在仿真与真实数据集上进行了评估,测试场景下表现与当前最优方法相当或更优。部分可定位方向上的变化提示需进一步研究鲁棒性与泛化性。

原文摘要 · Abstract (English)

The Iterative Closest Point (ICP) algorithm is a crucial component of LiDAR-based SLAM algorithms. However, its performance can be negatively affected in unstructured environments that lack features and geometric structures, leading to low accuracy and poor robustness in localization and mapping. It is known that degeneracy caused by the lack of geometric constraints can lead to errors in 6-DOF pose estimation along ill-conditioned directions. Therefore, there is a need for a broader and more fine-grained degeneracy detection and handling method. This paper proposes a new point cloud registration framework, LP-ICP, that combines point-to-line and point-to-plane distance metrics in the ICP algorithm, with localizability detection and handling. Rather than relying solely on point-to-plane localizability information, LP-ICP enhances the localizability analysis by incorporating a point-to-line metric, thereby exploiting richer geometric constraints. It consists of a localizability detection module and an optimization module. The localizability detection module performs localizability analysis by utilizing the correspondences between edge points (with low local smoothness) to lines and planar points (with high local smoothness) to planes between the scan and the map. The localizability contribution of individual correspondence constraints can be applied to a broader range. The optimization module adds additional soft and hard constraints to the optimization equations based on the localizability category. This allows the pose to be constrained along ill-conditioned directions. The proposed method is evaluated on simulation and real-world datasets, showing comparable or better accuracy than the state-of-the art methods in tested scenarios. Observed variations in partially localizable directions suggest the need for further investigation on robustness and generalizability.

点云配准定位鲁棒性SLAM

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。