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.

An Efficient Bundle Adjustment Approach for Stereo Visual Odometry with Pose Consensus

Bundle Adjustment for Monocular Visual Odometry Based on Detected Traffic Sign Features.

Binocular Bundle Adjustment Based Localization and Terrain Stitching for Robot

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

Stereo Vision Based SLAM Using Rao-Blackwellised Particle Filter

CoLi-BA: Compact Linearization Based Solver for Bundle Adjustment

Design of an Enhanced Visual Odometry by Building and Matching Compressive Panoramic Landmarks Online

A Real-Time Monocular Visual SLAM Based on the Bundle Adjustment with Adaptive Robust Kernel

Robust Bundle Adjustment for Large-Scale Structure from Motion

Research on Bundle Adjustment for Visual SLAM under Large-Scale Scene

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

LMBAO: A Landmark Map for Bundle Adjustment Odometry in LiDAR SLAM

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

Bundle Adjustment of High Resolution Stereo Camera on Mars Express

BundledSLAM: An Accurate Visual SLAM System Using Multiple Cameras

Precise Landmark-Map for Bundle Adjustment LiDAR Odometry

SBAS: Salient Bundle Adjustment for Visual SLAM

ParallaxBA: Bundle Adjustment Using Parallax Angle Feature Parametrization

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

A New Algorithm for Bundle Adjustment Based on Stereo Vision

Efficient and Consistent Bundle Adjustment on Lidar Point Clouds