Journal of Shandong University(Engineering Science) ›› 2025, Vol. 55 ›› Issue (4): 72-83.doi: 10.6040/j.issn.1672-3961.0.2025.004

• Machine Learning & Data Mining • Previous Articles    

The multi-sensor fusion mapping and relocalization based on LVI-SAM-Stereo in indoor and outdoor scenes

JIANG Fengyang1,2, CHENG Yao1,2*, HAN Zhe2, WANG Huaizhen1,2, ZHOU Fengyu3, DONG Lei2   

  1. JIANG Fengyang1, 2, CHENG Yao1, 2*, HAN Zhe2, WANG Huaizhen1, 2, ZHOU Fengyu3, DONG Lei2(1. Shandong New Generation Information Industrial Technology Research Institute, Jinan 250102, Shandong, China;
    2. Inspur Intelligent Terminal Co., Ltd., Jinan 250101, Shandong, China;
    3. School of Control Science and Engineering, Shandong University, Jinan 250061, Shandong, China
  • Published:2025-08-31

Abstract: Aiming at the problems of low mapping and relocalization accuracy, as well as poor scene adaptability, for robots in indoor and outdoor scenes, a tightly-coupled light detection and ranging(LiDAR)-visual-inertial odometry via smoothing, mapping, and relocalization by stereo(LVI-SAM-Stereo)method was proposed. The LiDAR-inertial pose estimation model was constructed by utilizing point-line and point-plane distances. Multi-sensor information interaction enabled rapid initialization of stereo-inertial odometry, with the odometry pose being optimized through reprojection error minimization. A cross-modal loop closure detection mechanism combining Scan-Context with visual features effectively reduced incorrect loop closures. A bidirectional relocalization architecture was developed, where factor graph-optimized odometry provided initial pose estimation for visual tracking, while perspective-n-point(PnP)-derived visual poses assisted LiDAR point cloud registration. A thorough evaluation with both datasets and real-world experiments verified that LVI-SAM-Stereo achieved 3.10% and 5.97% higher outdoor mapping accuracy compared to tightly-coupled LiDAR inertial odometry via smoothing and mapping(LIO-SAM)and tightly-coupled LiDAR-visual-inertial odometry via smoothing and mapping(LVI-SAM), respectively. Indoor average drift decreased by 72.7% and 43.05% versus these benchmarks. The system significantly improved mapping precision and scene adaptability. The relocalization satisfied the engineering requirements for autonomous navigation of robot products.

Key words: robot, multi-sensor fusion, visual-inertial odometry, loop closure detection, relocalization

CLC Number: 

  • TP391
[1] YIN H S, LI S M, TAO Y, et al. Dynam-SLAM: an accurate, robust stereo visual-inertial SLAM method in dynamic environments[J]. IEEE Transactions on Robotics, 2023, 39(1): 289-308.
[2] YU Z L, ZHU L D, LU G Y. Tightly-coupled fusion of VINS and motion constraint for autonomous vehicle[J]. IEEE Transactions on Vehicular Technology, 2022, 71(6): 5799-5810.
[3] ZHONG X L, LI Y H, ZHU S Q, et al. LVIO-SAM: a multi-sensor fusion odometry via smoothing and mapping[C] //2021 IEEE International Conference on Robotics and Biomimetics(ROBIO). Sanya, China: IEEE, 2021: 440-445.
[4] CAMPOS C, ELVIRA R, RODRÍGUEZ J J G, et al. ORB-SLAM3: an accurate open-source library for visual, visual-inertial, and multimap SLAM[J]. IEEE Transac-tions on Robotics, 2021, 37(6): 1874-1890.
[5] SHAN T X, ENGLOT B, MEYERS D, et al. LIO-SAM: tightly-coupled LiDAR inertial odometry via smoothing and mapping[C] //2020 IEEE/RSJ International Conference on Intelligent Robots and Systems(IROS). Las Vegas, USA: IEEE, 2020: 5135-5142.
[6] SHAN T X, ENGLOT B, RATTI C, et al. LVI-SAM: tightly-coupled LiDAR-visual-inertial odometry via smoo-thing and mapping[C] //2021 IEEE International Conference on Robotics and Automation(ICRA). Xi'an, China: IEEE, 2021: 5692-5698.
[7] LIN Y, GAO F, QIN T, et al. Autonomous aerial navigation using monocular visual-inertial fusion[J]. Journal of Field Robotics, 2018, 35(1): 23-51.
[8] HUANG J, ZHANG Y D, LI X. LiDAR-visual-inertial odometry using point and line features[C] //2022 4th International Conference on Robotics and Computer Vision(ICRCV). Wuhan, China: IEEE, 2022: 215-222.
[9] JIA Y X, NI Z K, NI X, et al. A multi-sensor fusion localization algorithm via dynamic target removal[C] //2023 15th International Conference on Intelligent Human-Machine Systems and Cybernetics(IHMSC). Hangzhou, China: IEEE, 2023: 138-142.
[10] LIU Z B, LI Z K, LIU A, et al. LVI-Fusion: a robust LiDAR-visual-inertial SLAM scheme[J]. Remote Sen-sing, 2024, 16(9): 1524.
[11] SEGAL A, HAEHNEL D, THRUN S. Generalized-ICP[C] //Robotics: Science and Systems. Seattle, USA: MIT, 2009: 435.
[12] LEPETIT V, MORENO-NOGUER F, FUA P. EPnP: an accurate O(n)solution to the PnP problem[J]. International Journal of Computer Vision, 2009, 81(2): 155-166.
[13] LV J J, XU J H, HU K W, et al. Targetless calibration of LiDAR-IMU system based on continuous-time batch estimation[C] //2020 IEEE/RSJ International Con-ference on Intelligent Robots and Systems(IROS). Las Vegas, USA: IEEE, 2020: 9968-9975.
[14] QUIGLEY M, CONLEY K, GERKEY B, et al. ROS: an open-source robot operating system[C] //ICRA Workshop on Open Source Software. Kobe, Japan: IEEE, 2009: 3-5.
[15] CHUM O, MATAS J, KITTLER J. Locally optimized RANSAC[C] //Joint Pattern Recognition Symposium. Heidelberg, Germany: Springer, 2003: 236-243.
[16] HELMBERGER M, MORIN K, BERNER B, et al. The Hilti SLAM challenge dataset[J]. IEEE Robotics and Automation Letters, 2022, 7(3): 7518-7525.
[1] LÜ Bin, LIU Miao, WU Jianqing, ZHANG Ziyi, CHEN Qixiang. Review on digital map stitching technology [J]. Journal of Shandong University(Engineering Science), 2025, 55(3): 1-15.
[2] Jianqing WU,Xiuguang SONG. Review on development of simultaneous localization and mapping technology [J]. Journal of Shandong University(Engineering Science), 2021, 51(5): 16-31.
[3] LIANG Qixing, LI Bin, LI Zhi, ZHANG Hui, RONG Xuewen, FAN Yong. Algorithm of adaptive slope adjustment of quadruped robot based on model predictive control and its application [J]. Journal of Shandong University(Engineering Science), 2021, 51(3): 37-44.
[4] Wei WANG,Feng WU,Fengyu ZHOU. Research status and development trend of autonomous cognition and learning of robot manipulation skills [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 11-24.
[5] Honghua ZHAO,Jian ZHAO,Xingguang DUAN,Zhitong HU,Qianqian TIAN,Yaohua ZHAO. Configuration design and interference analysis of multi-arm robot for mandible reconstruction [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 73-80.
[6] Caihong LI,Chun FANG,Zhiqiang WANG,Bin XIA,Fengying WANG. Complete coverage path planning for mobile robots based on hyperchaotic synchronization control [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 63-72.
[7] Linglong KONG,Guohui TIAN. A robot service recognition mechanism based on ontology in smart home [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 45-54.
[8] Meizhen LIU,Fengyu ZHOU,Ming LI,Yugang WANG,Ke CHEN. The composite control of backstepping control based on uncertain model compensation of wheeled mobile robot [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 36-44.
[9] Lei YIN, Fengyu ZHOU, Ming LI, Yugang WANG, Yinbo GUO, Ke CHEN. Design of robot cloud service platform based on microservice [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 55-62.
[10] Yujun WU,Wei WU,Yu GUO,Jian GUO. A force-based method for robot hole-searching and assembly [J]. Journal of Shandong University(Engineering Science), 2019, 49(5): 119-126.
[11] Qijie ZOU,Haoyu LI,Rubo ZHANG,Tengda PEI,Yan LIU. Survey of human-robot interaction control for autonomous driving [J]. Journal of Shandong University(Engineering Science), 2019, 49(2): 23-33.
[12] Mian ZHANG,Ying HUANG,Haiyi MEI,Yu GUO. Intelligent interaction method for power distribution robot based on Kinect [J]. Journal of Shandong University(Engineering Science), 2018, 48(5): 103-108.
[13] XIN Yaxian, LI Yibin, LI Bin, RONG Xuewen. Smooth walk-to-trot gait transition algorithm for quadruped robot [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2018, 48(4): 42-49.
[14] ZHAO Zijian, WANG Fang, CHANG Faliang. Survey on medical robot in computer-aided surgery [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2017, 47(3): 69-78.
[15] LIU Bin, SONG Rui, CHAI Hui. Buffering strategy for articulated legged robot based on virtual model control and acceleration planning [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2016, 46(6): 69-75.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!