Fast Lidar Inertial Odometry and Mapping for Mobile Robot SE(2) Navigation
Source abstract
Abstract
This paper presents a fast Lidar inertial odometry and mapping (F-LIOM) method for mobile robot navigation on flat terrain with high real-time pose estimation, map building, and place recognition. Existing works on Lidar inertial odometry have mostly parameterized the keyframe pose as SE(3) even when the robots moved on flat ground, which complicated the motion model and was not conducive to real-time non-linear optimization. In this paper, F-LIOM is shown to be cost-effective in terms of model complexity and computation efficiency for robot SE(2) navigation, as the motions in other degrees of freedom in 3D, including roll, pitch, and z, are considered to be noise terms that corrupt the pose estimation. For front-end place recognition, the smoothness information of the feature point cloud is introduced to construct a novel global descriptor that integrates geometry and environmental texture characteristics. Experiments under challenging scenarios, including self-collected datasets and public datasets, were conducted to validate the proposed method. The experimental results demonstrated that F-LIOM could achieve competitive real-time performance in terms of accuracy compared with state-of-the-art counterparts. Our solution has significant superiority and the potential to be deployed in limited-resource mobile robot systems.
Source: crossref · Quality: baseline
Research context
OpenAlex topics: Robotics and Sensor-Based Localization · Robotic Path Planning Algorithms · Indoor and Outdoor Localization Technologies
SciVX discovery tags are terminology-based. OpenAlex topics are source-provided classifications.
Affiliations
State Key Laboratory for Strength & Vibration of Mechanical Structures, School of Aerospace, Xi’an Jiaotong University, Xi’an 710049, China
Shaanxi Engineering Laboratory for Vibration Control of Aerospace Structures, Xi’an Jiaotong University, Xi’an 710049, China
References (38)
Show source-provided references
1. A Survey of the State-of-the-Art Localization Techniques and Their Potentials for Autonomous Vehicle Applications10.1109/JIOT.2018.2812300 ↗
2. Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age10.1109/TRO.2016.2624754 ↗
3. MonoSLAM: Real-Time Single Camera SLAM10.1109/TPAMI.2007.1049 ↗
4. Keyframe-based visual–inertial odometry using nonlinear optimization10.1177/0278364914554813 ↗
5. Guo, C.X., and Roumeliotis, S. (2013, January 6–10). IMU-RGBD camera 3D pose estimation and extrinsic calibration: Observability analysis and consistency improvement. Proceedings of the 2013 IEEE International Conference on Robotics and Automation, Karlsruhe, Germany.10.1109/ICRA.2013.6630984 ↗
6. Laidlow, T., Bloesch, M., Li, W., and Leutenegger, S. (2017, January 24–28). Dense RGB-D-inertial SLAM with map deformations. Proceedings of the 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Vancouver, BC, Canada.10.1109/IROS.2017.8206591 ↗
7. VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator10.1109/TRO.2018.2853729 ↗
8. Bu, Z., Sun, C., and Wang, P. (2022). Semantic Lidar-Inertial SLAM for Dynamic Scenes. Appl. Sci., 12.10.3390/app122010497 ↗
9. Cai, Y., Qian, W., Dong, J., Zhao, J., Wang, K., and Shen, T. (2023). A LiDAR–Inertial SLAM Method Based on Virtual Inertial Navigation System. Electronics, 12.10.3390/electronics12122639 ↗
10. Cao, M., Zhang, J., and Chen, W. (2023). Unmanned Systems, World Scientific.
11. Xu, X., Zhang, L., Yang, J., Cao, C., Wang, W., Ran, Y., Tan, Z., and Luo, M. (2022). A review of multi-sensor fusion slam systems based on 3D LIDAR. Remote Sens., 14.10.3390/rs14122835 ↗
12. Shan, T., and Englot, B. (2018, January 1–5). LeGO-LOAM: Lightweight and Ground-Optimized Lidar Odometry and Mapping on Variable Terrain. Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain.10.1109/IROS.2018.8594299 ↗
13. Wang, H., Wang, C., Chen, C., and Xie, L. (2020, January 25–29). F-LOAM: Fast LiDAR Odometry and Mapping. Proceedings of the 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA.10.1109/IROS51168.2021.9636655 ↗
14. Shan, T., Englot, B., Meyers, D., Wang, W., Ratti, C., and Rus, D. (2020–24, January 24). LIO-SAM: Tightly-coupled Lidar Inertial Odometry via Smoothing and Mapping. Proceedings of the 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA.10.1109/IROS45743.2020.9341176 ↗
15. Pan, Y., Xiao, P., He, Y., Shao, Z., and Li, Z. (June, January 30). MULLS: Versatile LiDAR SLAM via Multi-metric Linear Least Square. Proceedings of the 2021 IEEE International Conference on Robotics and Automation, Xi’an, China.10.1109/ICRA48506.2021.9561364 ↗
16. Barfoot, T.D. (2017). State Estimation for Robotics, Cambridge University Press.10.1017/9781316671528 ↗
17. iSAM2: Incremental smoothing and mapping using the Bayes tree10.1177/0278364911430419 ↗
18. Zhang, J., and Singh, S. (2014, January 12–16). LOAM: Lidar Odometry and Mapping in Real-time. Proceedings of the Robotics: Science and Systems, Berkeley, CA, USA.10.15607/RSS.2014.X.007 ↗
19. Segal, A.V., Hähnel, D., and Thrun, S. (July, January 28). Generalized-ICP. Proceedings of the Robotics: Science and Systems, Seattle, WA, USA.
20. Censi, A. (2008, January 19–23). An ICP variant using a point-to-line metric. Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA.10.1109/ROBOT.2008.4543181 ↗
21. Qin, C., Ye, H., Pranata, C.E., Han, J., Zhang, S., and Liu, M. (August, January 31). LINS: A Lidar-Inertial State Estimator for Robust and Efficient Navigation. Proceedings of the 2020 IEEE International Conference on Robotics and Automation (ICRA), Paris, France.10.1109/ICRA40945.2020.9197567 ↗
22. IN2LAAMA: Inertial Lidar Localization Autocalibration and Mapping10.1109/TRO.2020.3018641 ↗
23. Forster, C., Carlone, L., Dellaert, F., and Scaramuzza, D. (2015, January 13–17). IMU Preintegration on Manifold for Efficient Visual-Inertial Maximum-a-Posteriori Estimation. Proceedings of the Robotics: Science and Systems, Rome, Italy.10.15607/RSS.2015.XI.006 ↗
24. Forster, C., Dellaert, F., Scaramuzza, D., and Carlone, L. (2017, January 1). On-Manifold Preintegration for Real-Time Visual-Inertial Odometry. Proceedings of the IEEE Transactions on Robotics A Publication of the IEEE Robotics & Automation Society, Singapore.10.1109/TRO.2016.2597321 ↗
25. Li, D., Sun, B., Liu, R., and Xue, R. (2023). Tightly Coupled 3D Lidar Inertial SLAM for Ground Robot. Electronics, 12.10.3390/electronics12071649 ↗
26. Tong, C., Furgale, P., and Barfoot, T. (2012, January 28–30). Gaussian Process Gauss-Newton: Non-Parametric State Estimation. Proceedings of the 2012 Ninth Conference on Computer and Robot Vision, Washington, DC, USA.10.1109/CRV.2012.35 ↗
27. Gaussian Process Gauss–Newton for non-parametric simultaneous localization and mapping10.1177/0278364913478672 ↗
28. Rasmussen, C., and Williams, C.K.I. (2009). Adaptive Computation and Machine Learning, MIT Press.
29. Variational Hilbert regression for terrain modeling and trajectory optimization10.1177/0278364919844586 ↗
30. Urtasun, R., Fleet, D.J., and Fua, P. (2006, January 17–22). 3D People Tracking with Gaussian Process Dynamical Models. Proceedings of the 2006 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (CVPR’06), New York, NY, USA.
31. Continuous-Time Fixed-Lag Smoothing for LiDAR-Inertial-Camera SLAM10.1109/TMECH.2023.3241398 ↗
32. Vasudevan, S., Ramos, F., Nettleton, E., Durrant-Whyte, H., and Blair, A. (2009, January 12–17). Gaussian Process modeling of large scale terrain. Proceedings of the ICRA, Kobe, Japan.10.1109/ROBOT.2009.5152677 ↗
33. Wohlkinger, W., and Vincze, M. (2011, January 7–11). Ensemble of shape functions for 3D object classification. Proceedings of the 2011 IEEE International Conference on Robotics and Biomimetics, Karon Beach, Thailand.10.1109/ROBIO.2011.6181760 ↗
34. Muhammad, N., and Lacroix, S. (2011, January 1–5). Loop closure detection using small-sized signatures from 3D LIDAR data. Proceedings of the 2011 IEEE International Symposium on Safety, Security, and Rescue Robotics, Kyoto, Japan.10.1109/SSRR.2011.6106765 ↗
35. Kim, G., and Kim, A. (2018, January 1–5). Scan Context: Egocentric Spatial Descriptor for Place Recognition Within 3D Point Cloud Map. Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain.10.1109/IROS.2018.8593953 ↗
36. Wang, H., Wang, C., and Xie, L. (August, January 31). Intensity Scan Context: Coding Intensity and Geometry Relations for Loop Closure Detection. Proceedings of the 2020 IEEE International Conference on Robotics and Automation (ICRA), Paris, France.10.1109/ICRA40945.2020.9196764 ↗
37. Kim, G., Yun, S., Kim, J., and Kim, A. (2022, January 6–9). Sc-lidar-slam: A front-end agnostic versatile lidar slam system. Proceedings of the 2022 International Conference on Electronics, Information, and Communication (ICEIC), Jeju, Republic of Korea.10.1109/ICEIC54506.2022.9748644 ↗
38. Grupp, M. (2023, February 18). Evo: Python Package for the Evaluation of Odometry and SLAM. Available online: https://github.com/MichaelGrupp/evo.