Mobile Robot Localization and Mapping Algorithm Based on the Fusion of Image and Laser Point Cloud

Given the lack of scale information of the image features detected by the visual SLAM (simultaneous localization and mapping) algorithm, the accumulation of many features lacking depth information will cause scale blur, which will lead to degradation and tracking failure. In this paper, we introduce...

Full description

Saved in:
Bibliographic Details
Published in:Sensors (Basel, Switzerland) Switzerland), 2022-05, Vol.22 (11), p.4114
Main Authors: Dai, Jun, Li, Dongfang, Li, Yanqin, Zhao, Junwei, Li, Wenbo, Liu, Gang
Format: Article
Language:English
Subjects:
Accuracy
Algorithms
Cameras
Image enhancement
Lasers
Localization
Motion stability
multi-sensor fusion
nonlinear optimization
Optimization
Pose estimation
Robots
Semantics
Sensors
Simultaneous localization and mapping
SLAM
state estimation
Citations: Items that this one cites
Items that cite this one
Online Access:Get full text
Tags: Add Tag
No Tags, Be the first to tag this record!
Description
Summary:Given the lack of scale information of the image features detected by the visual SLAM (simultaneous localization and mapping) algorithm, the accumulation of many features lacking depth information will cause scale blur, which will lead to degradation and tracking failure. In this paper, we introduce the lidar point cloud to provide additional depth information for the image features in estimating ego-motion to assist visual SLAM. To enhance the stability of the pose estimation, the front-end of visual SLAM based on nonlinear optimization is improved. The pole error is introduced in the pose estimation between frames, and the residuals are calculated according to whether the feature points have depth information. The residuals of features reconstruct the objective function and iteratively solve the robot's pose. A keyframe-based method is used to optimize the pose locally in reducing the complexity of the optimization problem. The experimental results show that the improved algorithm achieves better results in the KITTI dataset and outdoor scenes. Compared with the pure visual SLAM algorithm, the trajectory error of the mobile robot is reduced by 52.7%. The LV-SLAM algorithm proposed in this paper has good adaptability and robust stability in different environments.
ISSN:1424-8220
1424-8220
DOI:10.3390/s22114114