To address the challenges of significant accumulated errors during large-scale loop closure detection in LiDAR odometry, and the increasing computational cost of inverse operations in conventional iterative SLAM solutions as problem size grows. We propose an incremental smoothing and optimization algorithm based on Bayesian tree reconstruction. The method begins by converting the factor graph into a Bayesian network through an elimination process. Subsequently, a bottom-up approach is used to establish an optimal solution path from parent nodes to leaf nodes. The computation incorporates localized updates to the Bayesian tree, significantly reducing the scale compared to the global reordering required by traditional root mean square incremental smoothing algorithms, thereby improving computational efficiency. This makes the Bayesian tree based incremental smoothing algorithm more suitable for efficient backend optimization in autonomous vehicle localization systems. Validation on the widely used KITTI dataset, as well as data collected from real vehicles, demonstrates the proposed framework’s real-time performance and robust overall effectiveness.

错误:搜索内容不能为空,请输入英文关键词
错误:关键词超出字数限制,请精简
高级检索

A Real-Time Pose Backend Optimization Method for Slam Based on Bayesian Tree Reconstruction

  • Xu Yang,
  • Chao Wei,
  • Luhao Li,
  • Miaomiao Du

摘要

To address the challenges of significant accumulated errors during large-scale loop closure detection in LiDAR odometry, and the increasing computational cost of inverse operations in conventional iterative SLAM solutions as problem size grows. We propose an incremental smoothing and optimization algorithm based on Bayesian tree reconstruction. The method begins by converting the factor graph into a Bayesian network through an elimination process. Subsequently, a bottom-up approach is used to establish an optimal solution path from parent nodes to leaf nodes. The computation incorporates localized updates to the Bayesian tree, significantly reducing the scale compared to the global reordering required by traditional root mean square incremental smoothing algorithms, thereby improving computational efficiency. This makes the Bayesian tree based incremental smoothing algorithm more suitable for efficient backend optimization in autonomous vehicle localization systems. Validation on the widely used KITTI dataset, as well as data collected from real vehicles, demonstrates the proposed framework’s real-time performance and robust overall effectiveness.