Multi-scale Depth-aware Simultaneous Localization and Mapping Algorithm Based on Factor Graph Optimization

Cheng-jun DING , Zhi-hui MA , Tan ZHANG , Teng-fei MA , Zi-jian LI , Yi-tong WANG , Zhi-kai JING

Science Technology and Engineering ›› 2026, Vol. 26 ›› Issue (13) : 5556 -5565.

PDF
Science Technology and Engineering ›› 2026, Vol. 26 ›› Issue (13) : 5556-5565 DOI: 10.12404/j.issn.1671-1815.2503143
research-article
Multi-scale Depth-aware Simultaneous Localization and Mapping Algorithm Based on Factor Graph Optimization
Author information +
History +
PDF

Abstract

In order to address the current limitations of pure laser SLAM under large-scale complex environments, particularly their lack of precision and poor robustness, a tightly-coupled SLAM method based on factor graph optimization has been proposed. The method enhances performance through three core designs. Firstly, designing an integrated inertial odometry factor based on the error-state Kalman filter (ESKF) that fuses multi-sensor information. Secondly, adopting a multi-scale depth-aware feature selection algorithm to extract line, plane, and point features, and optimizing inter-frame matching via coarse-to-fine registration to improve pose transformation accuracy. Thirdly, incorporating integrated inertial factors and laser-inertial odometry factors into the factor graph model, and introducing a rotation-invariant Scan Context-based loop closure detection factor to suppress cumulative errors. Comparative experiments on the public KITTI dataset and a self-collected campus dataset show that, compared with the classical LIO-SAM algorithm, the proposed algorithm reduces the mean absolute trajectory error (ATE) by 25.96% and 23.01% respectively, and the root mean square error (RMSE) by 25.52% and 28.38% respectively in complex scenarios. Experiments verify that the proposed algorithm achieves high mapping accuracy and robustness, and provides an effective technical solution for the engineering application of SLAM in outdoor complex scenarios.

Graphical abstract

Keywords

LiDAR SLAM / LIO-SAM algorithm / ESKF / feature extraction / factor graph optimization

Cite this article

Download citation ▾
Cheng-jun DING, Zhi-hui MA, Tan ZHANG, Teng-fei MA, Zi-jian LI, Yi-tong WANG, Zhi-kai JING. Multi-scale Depth-aware Simultaneous Localization and Mapping Algorithm Based on Factor Graph Optimization. Science Technology and Engineering, 2026, 26(13): 5556-5565 DOI:10.12404/j.issn.1671-1815.2503143

登录浏览全文

4963

注册一个新账户 忘记密码

References

Funding

PDF (16319KB)

25

Accesses

0

Citation

Detail

Sections
Recommended

/

〈 〉