[1] [1] BRESSON G, ALSAYED Z, YU L, et al. Simultaneous localization and mapping: A survey of current trends in autonomousdriving［J］. IEEE Transactions on Intelligent Vehicles, 2017, 2(3): 194-220.

[4] [4] SHAN T X, ENGLOT B. LeGO-LOAM: Lightweight and ground-optimized lidar odometry and mapping on variable terrain［C］//2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Madrid, Spain. New York: IEEE, 2019: 4758-4765.

[5] [5] ROSINOL A, ABATE M, CHANG Y, et al. Kimera: an open-source library for real-time metric-semantic localization and mapping［C］//2020 IEEE International Conference on Robotics and Automation (ICRA). Paris, France. New York: IEEE, 2020: 1689-169.

[9] [9] ZHANG J, SINGH S. LOAM:lidar odometry and mapping in real-time［C］//Robotics: Science and Systems X. Robotics: Science and Systems Foundation, 2014,2(9):1-9.

[12] [12] LUO H J, BAO H, XU C. Fast Closed-Loop SLAM based on the fusion of IMU and Lidar［J］. Journal of Physics: Conference Series, 2021, 1914(1): 012019.

[13] [13] SOL J. Quaternion kinematics for the error-state Kalman filter［EB/OL］. (2017-11)［2022-05-22］. https://arxiv.org/abs/1711.02508.pdf

[14] [14] ZHONG Y. Intrinsic shape signatures: A shape descriptor for 3D object recognition［C］//2009 IEEE 12th International Conference on Computer Vision Workshops, ICCV Workshops. Kyoto, Japan. IEEE, 2010: 689-696.

[15] [15] SUN J, LI H, LIU Y, et al. A robust point feature histogram-based 3D object recognition method［J］. Multimedia Tools and Applications, 79(5):3319-3336.

[17] [17] ZHANG J Y, YAO Y X, DENG B L. Fast and robust iterative closest point［J］. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2022, 44(7): 3450-3466.

[18] [18] RUSU R B, BLODOW N, BEETZ M. Fast point feature histograms (FPFH) for 3D registration［C］//2009 IEEE International Conference on Robotics and Automation. Kobe, Japan: IEEE, 2009: 3212-3217.

[20] [20] BIBER P, STRASSER W. The normal distributions transform: A new approach to laser scan matching［C］//Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453). Las Vegas, NV, USA: IEEE, 2004: 2743-2748.