Research on 3D laser SLAM algorithm based on graph optimization

Abstract Aiming at the problems that the positioning accuracy of laser Simultaneous Localization and Mapping (SLAM) is affected by the misclassification of close feature points and incorrect feature matching in the environment with redundant features, a 3D laser SLAM algorithm based on graph optimization was proposed. Firstly, to reduce the feature extraction error problem, the distance threshold is used to filter the close point cloud and improve the accuracy of feature classification, enhanced reliability of optoelectronic measurement data. Secondly, to improve the consistency of feature matching, based on the rough matching based on k-dimensional tree (KD-Tree), a two-stage fine matching based on geometric consistency is introduced to improved laser point alignment accuracy. The proposed method is compared with the mainstream localization algorithms based on KITTI dataset. Compared with Lidar-IMU Odometry with Sparse Adaptive Mapping and Fast LiDAR-Inertial Odometry, the positioning error of the proposed method is reduced by 21.88%and 24.43%on average, which showsthe superiority of the present algorithm in the application of optoelectronics and optical technology, and provides new ideas and methods for the development of high-precision laser navigation technology.