Abstract: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.

Large-Scale LiDAR Consistent Mapping Using Hierarchical LiDAR Bundle Adjustment

BA-CLM: A Globally Consistent 3D LiDAR Mapping Based on Bundle Adjustment Cost Factors

Efficient and Consistent Bundle Adjustment on Lidar Point Clouds

Long-Term Map-Based Visual Localization: Analysis of Individual Components of a Hierarchical Pipeline

Graph Optimality-Aware Stochastic LiDAR Bundle Adjustment with Progressive Spatial Smoothing

CoLi-BA: Compact Linearization Based Solver for Bundle Adjustment

BA-LIOM: tightly coupled laser-inertial odometry and mapping with bundle adjustment

Efficient LiDAR Odometry for Autonomous Driving.

LVBA: LiDAR-Visual Bundle Adjustment for RGB Point Cloud Mapping

PSS-BA: LiDAR Bundle Adjustment with Progressive Spatial Smoothing

Precise Landmark-Map for Bundle Adjustment LiDAR Odometry

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

Monocular SLAM for Large Scale Scenes

An Efficient Plane Extraction Approach for Bundle Adjustment on LiDAR Point clouds

SGBA: Semantic Gaussian Mixture Model-Based LiDAR Bundle Adjustment

BALM: Bundle Adjustment for Lidar Mapping

Large-Scale Monocular Slam By Local Bundle Adjustment And Map Joining

ICE-BA: Incremental, Consistent and Efficient Bundle Adjustment for Visual-Inertial SLAM

Hierarchical and Validated Branch-and-Bound Method for Global Point Cloud Registration