Research on Simultaneous localization and mapping Algorithm based on Lidar and IMU

Math Biosci Eng. 2023 Mar 9;20(5):8954-8974. doi: 10.3934/mbe.2023393.

Abstract

In recent years, the research of autonomous driving and mobile robot technology is a hot research direction. The ability of simultaneous positioning and mapping is an important prerequisite for unmanned systems. Lidar is widely used as the main sensor in SLAM (Simultaneous Localization and Mapping) technology because of its high precision and all-weather operation. The combination of Lidar and IMU (Inertial Measurement Unit) is an effective method to improve overall accuracy. In this paper, multi-line Lidar is used as the main data acquisition sensor, and the data provided by IMU is integrated to study robot positioning and environment modeling. On the one hand, this paper proposes an optimization method of tight coupling of lidar and IMU using factor mapping to optimize the mapping effect. Use the sliding window to limit the number of frames optimized in the factor graph. The edge method is used to ensure that the optimization accuracy is not reduced. The results show that the point plane matching mapping method based on factor graph optimization has a better mapping effect and smaller error. After using sliding window optimization, the speed is improved, which is an important basis for the realization of unmanned systems. On the other hand, on the basis of improving the method of optimizing the mapping using factor mapping, the scanning context loopback detection method is integrated to improve the mapping accuracy. Experiments show that the mapping accuracy is improved and the matching speed between two frames is reduced under loopback mapping. However, it does not affect real-time positioning and mapping, and can meet the requirements of real-time positioning and mapping in practical applications.

Keywords: factor graph; loopback detection; multi-line lidar; simultaneous positioning and mapping.