Abstract
The lidar-inertial-based simultaneous localization and mapping (SLAM) have been widely investigated in recent years. In this paper, a loosely-coupled lidar-inertial odometry and mapping method is developed for robot state estimation in real-time. The proposed lidar-inertial odometry is a loosely-coupled and nonlinear optimization-based method, fusing IMU measurements and pose of lidar odometry. Lidar odometry processing de-skewed point cloud with keyframes strategy, which significantly saves computation and allows scan matching run in real-time. Further, high-frequency robot state is obtained by imu prediction in a short time. And a sliding-window-based optimization is preformed to correct imu prediction in time. Real-world experiments and public dataset tests are performed in different scenarios to validate accuracy and effectiveness of our method.
Similar content being viewed by others
References
Agarwal, S. et al, Ceres solver. http://ceres-solver.org (2020)
Cadena, C., Carlone, L., Carrillo, H., et al.: Past, present, and future of simultaneous localization and mapping: toward the robust-perception age. IEEE Trans. Robot. 32(6), 1309–1332 (2016)
Forster, C., Carlone, L., Dellaert, F., Scaramuzza, D.: Imu preintegration on manifold for efficient visual-inertial maximum—a-posteriori estimation. Georgia Institute of Technology (2015)
Geiger, A., et al.: Vision meets robotics: the kitti dataset. Intern J Robot Res 32(11), 1231–1237 (2013)
Geneva, P., Eckenhoff, K., Yang, Y., Huang, G.: LIPS: lidar-inertial 3d plane slam. In: Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems(IROS) pp. 123–130 (2018)
Haoyang Y., Yuying C., Ming L.: Tightly coupled 3d lidar inertial odometry and mapping. In: 2019 International Conference on Robotics and Automation (ICRA) (2019)
Hemann, G., Singh, S., Kaess, M.: Long-range gps-denied aerial inertial navigation with lidar localization. In: Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) pp. 1659–1666 (2016)
Hesch, J. A., Mirzaei, F. M., Mariottini, G. L., Roumeliotis, S. I.: A laser-aided inertial navigation system(l-ins) for human localization in unknown indoor environments. In: Proceedings of IEEE International Conference on Robotics and Automation(ICRA). pp. 5376–5382 (2010)
Huang, Guoquan P., Mourikis, Anastasios I., Roumeliotis, Stergios I.: A quadratic-complexity observability-constrained unscented Kalman filter for SLAM. IEEE Trans. Robot. 29(5), 1226–1243 (2013)
Lin, Yi., et al.: Autonomous aerial navigation using monocular visualinertial fusion. J. Field Robot. 35(1), 23–51 (2018)
Qin, T., Li, P., Shen, S.: Vins-mono: a robust and versatile monocular visual-inertial state estimator. IEEE Trans. Robot. 34(4), 1004–1020 (2018)
Qin, C.: et al, LINS: a lidar-inertial state estimator for robust and efficient navigation. In: 2020 IEEE International Conference on Robotics and Automation (ICRA) (2020)
Quigley, M., Conley, K., Gerkey, B., Faust, J., Foote, T., Leibs, J., Wheeler, R., Ng, A.Y.: ROS: an open-source robot operating system. IEEE ICRA Workshop on Open Source Software (2009)
Shan, T., Englot, B.: Lego-loam: lightweight and ground-optimized Lidar odometry and mapping on variable terrain. In: Proceedings of 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) pp. 4758–4765 (2018)
Shoudong, H., Gamini, D.: Convergence and consistency analysis for extended Kalman filter based SLAM. In: IEEE Transactions on robotics. 23.5, pp. 1036–1049 (2007)
Simon, L.: et al.: A robust and modular multi-sensor fusion approach applied to mav navigation. In: 2013 IEEE/RSJ international conference on intelligent robots and systems (2013)
Soloviev, A., Bates, D., Van Graas, F.: Tight coupling of laser scanner and inertial measurements for a fully autonomous relative navigation solution. Navigation 54(3), 189–205 (2007)
Tang, J., et al.: LiDAR scan matching aided inertial navigation system in GNSS-denied environments. Sensors 15(7), 16710–16728 (2015)
Tixiao, S. et al.: Lio-sam: tightly-coupled lidar inertial odometry via smoothing and mapping. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) pp. 5135–5142 (2020)
Yang, Y., Geneva, P., Zuo, X., Eckenhoff, K., Liu, Y., Huang, G.: Tightly-coupled aided inertial navigation with point and plane features. In: Proceedings of IEEE International Conference on Robotics and Automation (ICRA) pp. 6094–6100 (2019)
Zhang, J., Singh, S..: LOAM: lidar odometry and mapping in realtime. Robot Sci Syst (2014)
Zhen, W., Zeng, S., Soberer, S.: Robust localization and localizability estimation with a rotating laser scanner. In: 2017 IEEE International Conference on Robotics and Automation (ICRA) (2017)
Funding
This work was supported in part by the National Key Research and Development Program of China under Grant 2018AAA0102401, the National Natural Science Foundation of China under Grant 62022060, 61773278, 61873340,61903349, 62073234 and 62003236 and the Basic Planning To strengthen key basic research projects (011DY2005211285002Z001).
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
Cite this article
Xie, G., Zong, Q., Zhang, X. et al. Loosely-coupled lidar-inertial odometry and mapping in real time. Int J Intell Robot Appl 5, 119–129 (2021). https://doi.org/10.1007/s41315-021-00164-5
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s41315-021-00164-5