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.
Citation: Minghe Liu, Ye Tao, Zhongbo Wang, Wenhua Cui, Tianwei Shi. Research on Simultaneous localization and mapping Algorithm based on Lidar and IMU[J]. Mathematical Biosciences and Engineering, 2023, 20(5): 8954-8974. doi: 10.3934/mbe.2023393
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.
| [1] |
L. C. van der Gaag, J. Ch. Meyer, Informational independence: Models and normal forms, Int. J. Intell. Syst., 13 (1998), 83–109. https://doi.org/10.1002/(SICI)1098-111X(199801)13:1<83::AID-INT7>3.3.CO;2-F doi: 10.1002/(SICI)1098-111X(199801)13:1<83::AID-INT7>3.3.CO;2-F
|
| [2] | R. Yagfarov, M. Ivanou, I. Afanasyev, Map comparison of lidar-based 2D slam algorithms using precise ground truth, in 2018 15th International Conference on Control, Automation, Robotics and Vision (ICARCV), (2018), 1979–1983. https://doi.org/10.1109/ICARCV.2018.8581131 |
| [3] | R. Smith, M. Self, P. Cheeseman, Estimating uncertain spatial relationships in robotics, in 1987 IEEE International Conference on Robotics and Automation, (1987), 850. https://doi.org/10.1109/ROBOT.1987.1087846 |
| [4] | A. Doucet, N. D. Freitas, K. Murphy, S. Russell, Rao-Blackwellised particle filtering for dynamic Bayesian networks, preprint, arXiv: 1301.3853. |
| [5] | M. Montemarlo, S. Thrun, D. Koller, B. Wegbreit, FastSLAM: A factored solution to the simultaneous localization and mapping problem, in Proceedings of the AAAI National Conference on Artificial Intelligence, (2002). |
| [6] | M. Montemerlo, S. Thrun, Simultaneous localization and mapping with unknown data association using FastSLAM, in 2003 IEEE International Conference on Robotics and Automation, 2 (2003), 1985–1991. https://doi.org/10.1109/ROBOT.2003.1241885 |
| [7] |
G. Grisetti, C. Stachniss, W. Burgard, Improved techniques for grid mapping with Rao-Blackwellized particle filters, IEEE Trans. Rob., 23 (2007), 34–46. https://doi.org/10.1109/TRO.2006.889486 doi: 10.1109/TRO.2006.889486
|
| [8] |
J. Zhang, S. Singh, Low-drift and real-time lidar odometry and mapping, Auton. Robot., 41 (2017), 401–416. https://doi.org/10.1007/s10514-016-9548-2 doi: 10.1007/s10514-016-9548-2
|
| [9] | W. Hess, D. Kohler, H. Rapp, D. Andor, Real-Time Loop Closure in 2D LIDAR SLAM, in 2016 IEEE International Conference on Robotics and Automation (ICRA), 9 (2016), 1271–1278. https://doi.org/10.1109/ICRA.2016.7487258 |
| [10] | T. Shan, B. Englot, LeGO-LOAM: Lightweight and ground-optimized lidar odometry and mapping on variable terrain, in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), (2018), 4758–4765. https://doi.org/10.1109/IROS.2018.8594299 |
| [11] | D. Droeschel, S. Behnke, Efficient continuous-time SLAM for 3D lidar-based online mapping, in 2018 IEEE International Conference on Robotics and Automation (ICRA), (2018), 16710–16728. https://doi.org/10.1109/ICRA.2018.8461000 |
| [12] | J. Behley, C. Stachniss, Efficient surfel-based SLAM using 3D laser range data in urban environments, Rob.: Sci. Syst., (2018). https://doi.org/10.15607/RSS.2018.XIV.016 |
| [13] | M. Li, H. Zhu, S. You, C. Tang, Y. Li, Efficient laser-based 3D SLAM for coal mine rescue robots, in 2018 IEEE 8th Annual International Conference on CYBER Technology in Automation, Control, and Intelligent Systems (CYBER), (2018), 971–976. https://doi.org/10.1109/CYBER.2018.8688349 |
| [14] | J. E. Deschaud, IMLS-SLAM: Scan-to-model matching based on 3D data, in 2018 IEEE International Conference on Robotics and Automation (ICRA), (2018), 2480–2485. https://doi.org/10.1109/ICRA.2018.8460653 |
| [15] | W. Shao, S. Vijayarangan, C. Li, G. Kantor, Stereo visual inertial LiDAR simultaneous localization and mapping, in 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), (2019), 370–377. https://doi.org/10.1109/IROS40897.2019.8968012 |
| [16] |
F. Pang, S. Wei, X. Shi, K. Chen, Milometer and mapping method for inertial navigation coupling of lidar, Appl. Res. Comput., 38 (2021), 1–7. https://doi.org/10.19734/j.issn.1001-3695.2020.06.0259 doi: 10.19734/j.issn.1001-3695.2020.06.0259
|
| [17] |
G. Niu, Y. Wang, Unmanned vehicle positioning and mapping method based on multi- constraint factor graph optimization, J. Beijing Univ. Aeronaut. Astronaut., 47 (2021), 306–314. https://doi.org/10.13700/j.bh.1001-5965.2020.0212 doi: 10.13700/j.bh.1001-5965.2020.0212
|
| [18] | T. Shan, B. Englot, D. Meyers, W. Wang, C. Ratti, D. Rus, Lio-sam: Tightly-coupled lidar inertial odometry via smoothing and mapping, in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), (2020), 5135–5142. https://doi.org/10.1109/IROS45743.2020.9341176 |
| [19] | X. Ma, X. Yao, L. Ding, T. Zhu, Variable motion model for lidar motion distortion correction, in AOPC 2021: Optical Sensing and Imaging Technology, 1206524 (2021), 489–495. https://doi.org/10.1117/12.2606143 |
| [20] |
J. Wang, H. Zhu, H. Liu, Z. Ma, Lossy point cloud geometry compression via end-to-end learning, IEEE Trans. Circuits Syst. Video Technol., 31 (2021), 4909–4923. https://doi.org/10.1109/TCSVT.2021.3051377 doi: 10.1109/TCSVT.2021.3051377
|
| [21] |
W. Sun, J. Wang, F. Jin, Y. Yang, A quality improvement method for 3D laser slam point clouds based on geometric primitives of the scan scene, Int. J. Remote Sens., 42 (2021), 378–388. https://doi.org/10.1080/2150704X.2020.1811911 doi: 10.1080/2150704X.2020.1811911
|
| [22] | M. Li, H. Zhu, S. You, C. Tang; Y. Li, Efficient laser-based 3D SLAM for coal mine rescue robots, in 2018 IEEE 8th Annual International Conference on CYBER Technology in Automation, Control, and Intelligent Systems (CYBER), (2018), 971–976. https://doi.org/10.1109/CYBER.2018.8688349 |
| [23] | X. Zhang, G. Lu, G. Fu, D. Xu, S. Liang, SLAM algorithm analysis of mobile robot based on lidar, in 2019 Chinese Control Conference (CCC), (2019), 4739–4745. https://doi.org/10.23919/ChiCC.2019.8866200 |
| [24] | D. V. Nam, K. Gon-Woo, Solid-state LiDAR based-SLAM: A concise review and application, in 2021 IEEE International Conference on Big Data and Smart Computing (BigComp), (2021), 302–305. https://doi.org/10.1109/BigComp51126.2021.00064 |
| [25] | N. Akiyama, S. Nishiyama, K. Sakita, J. Song, F. Yamazaki, River levees monitoring using three dimensional laser point clouds with SLAM technology, in Civil Infrastructures Confronting Severe Weathers and Climate Changes Conference, (2021), 14–22. https://doi.org/10.1007/978-3-030-79798-0_2 |
| [26] | J. Liu, Q. Sun, Z. Fan, Y. Jia, TOF lidar development in autonomous vehicle, in 2018 IEEE 3rd Optoelectronics Global Conference (OGC), (2018), 185–190. https://doi.org/10.1109/OGC.2018.8529992 |
| [27] | J. Lv, J. Xu, K. Hu, Y. Liu; X. Zuo, Targetless calibration of lidar-imu system based on continuous-time batch estimation, in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), (2020), 9968–9975. https://doi.org/10.1109/IROS45743.2020.9341405 |
Figures(9) / Tables(14)
Minghe Liu, Ye Tao, Zhongbo Wang, Wenhua Cui, Tianwei Shi. Research on Simultaneous localization and mapping Algorithm based on Lidar and IMU[J]. Mathematical Biosciences and Engineering, 2023, 20(5): 8954-8974. doi: 10.3934/mbe.2023393
DownLoad: