Abstract
Simultaneous localization and mapping (SLAM) is an important research topic in unmanned platforms. The SLAM method, coupled with the Inertial Measurement Unit (IMU), has recently received much attention due to its excellent performance. However, the tightly coupled LiDAR and IMU odometry (LIO) will be interfered with by the unknown initial state during system startup, which will lead to system startup failure in severe cases, especially in the case of low-cost sensors. Therefore, this paper presents a Zero Velocity Update (ZUPT) aided initialization procedure to estimate unknown initial states assuming that the vehicle always starts from stationary. The proposed initialization procedure includes two phases: static phase and dynamic phase, and this paper also proposes a Zero Velocity Detector to distinguish the two phases precisely. The proposed system is evaluated on the datasets gathered from the campus zone with low-cost sensors to evaluate the whole system. The results show that our approach can effectively improve robustness and partly improve precision when the system is bootstrapped.
Similar content being viewed by others
Code Availability
Not available publicly.
References
Singandhupe, A., La, H.M.: A review of slam techniques and security in autonomous driving. In 2019 Third IEEE International Conference on Robotic Computing (IRC). IEEE, pp. 602–607 (2019)
Cadena, C., Carlone, L., Carrillo, H., Latif, Y., Scaramuzza, D., Neira, J., Reid, I., Leonard, J.J.: Past, present, and future of simultaneous localization and mapping: Toward the robust-perception age. IEEE Trans. Robot. 32(6), 1309–1332 (2016)
Shan, T., Englot, B., Meyers, D., Wang, W., Ratti, C., Daniela, R.: Lio-sam: Tightly-coupled lidar inertial odometry via smoothing and mapping. In IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp. 5135–5142 (2020)
Zhang, J., Singh, S.: Low-drift and real-time lidar odometry and mapping. Auton. Robot. 41(2), 401–416 (2017)
Shan, T., Englot, B.: Lego-loam: Lightweight and ground-optimized lidar odometry and mapping on variable terrain. In IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp. 4758–4765 (2018)
Dube, R., Dugas, D., Stumm, E., Nieto, J., Siegwart, R., Cadena, C.: Segmatch: Segment based place recognition in 3d point clouds. In 2017 IEEE International Conference on Robotics and Automation (ICRA), pp. 5266–5272 (2017)
Pan, Y., Xiao, P., He, Y., Shao, Z., Li, Z.: Mulls: Versatile lidar slam via multi-metric linear least square. arXiv preprint arXiv:2102.03771 (2021)
Ye, H., Chen, Y., Liu, M.: Tightly coupled 3d lidar inertial odometry and mapping. In 2019 International Conference on Robotics and Automation (ICRA), pp. 3144–3150 (2019)
Besl, P., McKay, H.: A method for registration of 3-d shapes. IEEE Trans. Pattern Anal. Mach. Intell. 14(2), 239–256 (1992)
Segal, A., Haehnel, D., Thrun, S.: Generalized-icp. In Robotics: Science and systems, vol. 2, no. 4. Seattle, WA, p. 435 (2009)
Yang, S., Zhu, X., Nian, X., Feng, L., Qu, X., Mal, T.: A robust pose graph approach for city scale lidar mapping. In 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1175–1182 (2018)
Hening, S., Ippolito, C.A., Krishnakumar, K.S., Stepanyan, V., Teodorescu, M.: 3d lidar slam integration with gps/ins for uavs in urban gps-degraded environments. In AIAA Information Systems-AIAA Infotech @ Aerospace (2017)
Forster, C., Carlone, L., Dellaert, F., Scaramuzza, D.: On-manifold preintegration for real-time visual-inertial odometry. IEEE Trans. Robot. 33(1), 1–21 (2016)
Qin, C., Ye, H., Pranata, C.E., Han, J., Zhang, S., Liu, M.: R-lins: A robocentric lidar-inertial state estimator for robust and efficient navigation. arXiv preprint arXiv:1907.02233 (2019)
Mur-Artal, R., Tardos, J.D.: Visual-inertial monocular slam with map reuse. In IEEE Robotics and Automation Letters 2(2), 796–803 (2017)
Faessler, M., Fontana, F., Forster, C., Scaramuzza, D.: Automatic re-initialization and failure recovery for aggressive flight with a monocular vision-based quadrotor. In 2015 IEEE International Conference on Robotics and Automation (ICRA), pp. 1722–1729 (2015)
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)
Wang, Z., Zhao, H., Qiu, S., Gao, Q.: Stance-phase detection for zupt-aided foot-mounted pedestrian navigation system. IEEE/ASME Trans. Mechatron. 20(6), 3170–3181 (2015)
Norrdine, A., Kasmi, Z., Blankenbach, J.: Step detection for zupt-aided inertial pedestrian navigation system using foot-mounted permanent magnet. IEEE Sensors J. 16(17), 6766–6773 (2016)
Kilic, C., Ohi, N., Gu, Y., Gross, J.N.: Slip-based autonomous zupt through gaussian process to improve planetary rover localization. IEEE Robot. Autom. Lett. 6(3), 4782–4789 (2021)
Brossard, M., Barrau, A., Bonnabel, S.: Rins-w: Robust inertial navigation system on wheels. In 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp. 2068–2075 (2019)
Park, S.K., Suh, Y.S.: A zero velocity detection algorithm using inertial sensors for pedestrian navigation systems. Sensors 10(10), 9163–9178 (2010)
Skog, I., Nilsson, J.O., Händel, P.: Evaluation of zero-velocity detectors for foot-mounted inertial navigation systems. In 2010 International Conference on Indoor Positioning and Indoor Navigation. IEEE, pp. 1–6 (2010)
Xiaofang, L., Yuliang, M., Ling, X., Jiabin, C., Chunlei, S.: Applications of zero-velocity detector and kalman filter in zero velocity update for inertial navigation system. On Proceedings of 2014 IEEE Chinese Guidance, Navigation and Control Conference. IEEE, pp. 1760–1763 (2014)
Ramanandan, A., Chen, A., Farrell, J.A.: Inertial navigation aiding by stationary updates. IEEE Trans. Intell. Transp. Syst. 13(1), 235–248 (2011)
Dellaert, F., Kaess, M., et al.: Factor graphs for robot perception. Foundations and Trends® in Robotics 6(1-2)1–139 (2017)
Skog, I., Handel, P., Nilsson, J.O., Rantakokko, J.: Zero-velocity detection-an algorithm evaluation. IEEE Trans. Biomed. Eng. 57(11), 2657–2666 (2010)
Agarwal, S., Mierle, K., et al.: Ceres solver. http://ceres-solver.org
Kaess, M., Ranganathan, A., Dellaert, F.: isam: Incremental smoothing and mapping. IEEE Trans. Robot. 24(6), 1365–1378 (2008)
Kim, G., Kim, A.: Scan context: Egocentric spatial descriptor for place recognition within 3d point cloud map. In 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp. 4802–4809 (2018)
Gao, W.: imu_utils. https://github.com/gaowenliang/imu_utils (2018)
Quigley, M., Conley, K., Gerkey, B., Faust, J., Foote, T., Leibs, J., Wheeler, R., Ng, A.Y.: Ros: an open-source robot operating system. In ICRA Workshop on Open Source Software, vol. 3, no. 3.2. Kobe, Japan, p. 5 (2009)
Funding
The authors acknowledge the Chongqing Research Institute of Wuhan University of Technology project YF2021-16 for funding this work.
Author information
Authors and Affiliations
Contributions
All authors contributed to the study’s conception and design. Material preparation, data collection, and analysis were performed by Linqiu Gui, Chunnian Zeng, and Jie Luo. The first draft of the manuscript was written by Linqiu Gui. The paper was reviewed by Samuel Dauchert and Xiaofeng Wang. All authors commented on previous versions of the manuscript. All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Competing Interests
The authors have no relevant financial or non-financial interests to disclose.
Ethics Approval and Consent to Participate
This study doesn’t involve human or animal subjects.
Consent for Publication
This study doesn’t contain any individual person’s data in any form. All the authors have agreed to publish this work.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Gui, L., Zeng, C., Dauchert, S. et al. A ZUPT Aided Initialization Procedure for Tightly-coupled Lidar Inertial Odometry based SLAM System. J Intell Robot Syst 108, 40 (2023). https://doi.org/10.1007/s10846-023-01886-3
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10846-023-01886-3