[4] [4] Pierzchaa M, Gigure P, Astrup R. Mapping forests using an unmanned ground vehicle with 3D LiDAR and graph-SLAM[J]. Computers and Electronics in Agriculture, 2018, 145: 217-225.

[5] [5] Lauterbach H A, Borrmann D, He R, et al. Evaluation of a backpack-mounted 3D mobile scanning system[J]. Remote Sensing, 2015, 7(10): 13753-13781.

[6] [6] Lehtola V V, Kaartinen H, Nchter A, et al. Comparison of the selected state-of-the-art 3D indoor scanning and point cloud generation methods[J]. Remote sensing, 2017, 9(8): 796.

[8] [8] Hong Y, Kim S, Kim Y, et al. Quadrotor path planning using A* search algorithm and minimum snap trajectory generation[J]. ETRI Journal, 2021, 43(6): 1013-1023.

[9] [9] Koide K, Miura J, Menegatti E. A portable three-dimensional LIDAR-based system for long-term and wide-area people behavior measurement[J]. International Journal of Advanced Robotic Systems, 2019, 16(2): 1729881419841532.

[11] [11] Wahyono E P, Ningrum E S, Dewanto R S, et al. Stereo vision-based obstacle avoidance module on 3D point cloud data[J]. TELKOMNIKA (Telecommunication Computing Electronics and Control), 2020, 18(3): 1514-1521.

[13] [13] Wang P, Liu Y, Yao W, et al. Improved a-star algorithm based on multivariate fusion heuristic function for autonomous driving path planning[J]. Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, 2023, 237(7): 1527-1542.

[14] [14] Vitali R V, McGinnis R S, Perkins N C. Robust error-state Kalman filter for estimating IMU orientation[J]. IEEE Sensors Journal, 2020, 21(3): 3561-3569.

[17] [17] Marumo N, Okuno T, Takeda A. Majorization-minimization-based Levenberg-Marquardt method for constrained nonlinear least squares[J]. Computational Optimization and Applications, 2023, 84(3): 833-874.