arXiv:2409.01856cs.CV2024-09

提出新型激光雷达位姿优化方法,提升大场景下的定位精度与鲁棒性。

Robust Second-order LiDAR Bundle Adjustment Algorithm Using Mean Squared Group Metric

  • 用均方分组度量统一处理平面点云,避免逐点计算
  • 基于显式二阶估计器,实现高精度位姿优化
  • 在复杂环境仍保持优异性能,适合大规模建图

Bundle adjustment (BA) 是SLAM系统后端广泛使用的非线性优化技术。通过利用多视角下特征点的共视关系,BA构建位姿与特征点联合估计模型,从而生成更精确的地图并降低前端定位误差。然而,针对激光雷达数据的大规模3D点云,传统BA面临计算量大、鲁棒性差等挑战。本文提出一种新的均方分组度量(MSGM),用于构建激光雷达BA的优化目标。该度量对单次采样周期内平面特征的测量值进行均方变换,实现尺度可解释性,且无需耗时的点对点计算。进一步引入鲁棒核函数对度量进行重加权,增强优化过程的抗噪能力。基于此,本文推导出显式二阶估计器(RSO-BA),采用解析公式计算海森矩阵与梯度,确保解的精度。在公开数据集上的实验表明,相比现有隐式二阶与近似显式二阶方法,所提RSO-BA在注册精度和鲁棒性上均表现更优,尤其在大规模或结构复杂的环境中优势明显。

原文摘要 · Abstract (English)

The bundle adjustment (BA) algorithm is a widely used nonlinear optimization technique in the backend of Simultaneous Localization and Mapping (SLAM) systems. By leveraging the co-view relationships of landmarks from multiple perspectives, the BA method constructs a joint estimation model for both poses and landmarks, enabling the system to generate refined maps and reduce front-end localization errors. However, there are unique challenges when applying the BA for LiDAR data, due to the large volume of 3D points. Exploring a robust LiDAR BA estimator and achieving accurate solutions is a very important issue. In this work, firstly we propose a novel mean square group metric (MSGM) to build the optimization objective in the LiDAR BA algorithm. This metric applies mean square transformation to uniformly process the measurement of plane landmarks from one sampling period. The transformed metric ensures scale interpretability, and does not requie a time-consuming point-by-point calculation. Secondly, by integrating a robust kernel function, the metrics involved in the BA algorithm are reweighted, and thus enhancing the robustness of the solution process. Thirdly, based on the proposed robust LiDAR BA model, we derived an explicit second-order estimator (RSO-BA). This estimator employs analytical formulas for Hessian and gradient calculations, ensuring the precision of the BA solution. Finally, we verify the merits of the proposed RSO-BA estimator against existing implicit second-order and explicit approximate second-order estimators using the publicly available datasets. The experimental results demonstrate that the RSO-BA estimator outperforms its counterparts regarding registration accuracy and robustness, particularly in large-scale or complex unstructured environments.

激光雷达位姿优化鲁棒性SLAM

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