journal article·2026-01-20Open access

Vertically Constrained LiDAR-Inertial SLAM in Dynamic Environments

Shuangfeng Wei, Junfeng Qiu, Anpeng Shen, Keming Qu, Tong Yang

Applied Sciences· Volume 16· Issue 2

Abstract

With the advancement of Light Detection and Ranging (LiDAR) technology and computer science, LiDAR–Inertial Simultaneous Localization and Mapping (SLAM) has become essential in autonomous driving, robotic navigation, and 3D reconstruction. However, dynamic objects such as pedestrians and vehicles, with complex terrain conditions, pose serious challenges to existing SLAM systems. These factors introduce artifacts into the acquired point clouds and result in significant vertical drift in SLAM trajectories. To address these challenges, this study focuses on controlling vertical drift errors in LiDAR–Inertial SLAM systems operating in dynamic environments. The research focuses on three key aspects: ground point segmentation, dynamic artifact removal, and vertical drift optimization. In order to improve the robustness of ground point segmentation operations, this study proposes a method based on a concentric sector model. This method divides point clouds into concentric regions and fits flat surfaces within each region to accurately extract ground points. To mitigate the impact of dynamic objects on map quality, this study proposes a removal algorithm that combines multi-frame residual analysis with curvature-based filtering. Specifically, the algorithm tracks residual changes in non-ground points across consecutive frames to detect inconsistencies caused by motion, while curvature features are used to further distinguish moving objects from static structures. This combined approach enables effective identification and removal of dynamic artifacts, resulting in a reduction in vertical drift.
Source: crossref · Quality: baseline

Research context

OpenAlex topics: Robotics and Sensor-Based Localization · Remote Sensing and LiDAR Applications · 3D Surveying and Cultural Heritage

SciVX discovery tags are terminology-based. OpenAlex topics are source-provided classifications.

Affiliations

School of Geomatics and Urban Spatial Information, Beijing University of Civil Engineering and Architecture, Beijing 102616, China

Research Center of Representative Building and Architectural Heritage Database, Ministry of Education, Beijing 102616, China

Beijing Key Laboratory for Architectural Heritage Fine Reconstruction & Health Monitoring, Beijing 102616, China

References (50)

Show source-provided references
1. Chen, Y., Zhang, H., Li, X., and Wang, L. (2022, January 23–27). Large-Scale Deployment of LiDAR-Based SLAM for Autonomous Security Robots in Logistics Parks. Proceedings of the 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems, Kyoto, Japan.
2. Real-Time Dynamic Object Removal for Warehouse Mapping
3. Fritsch, J., Kuhn, T., and Geiger, A. (2012, January 16–21). Are we ready for autonomous driving? The KITTI Vision Benchmark Suite. Proceedings of the 2012 IEEE Conference on Computer Vision and Pattern Recognition (CVPR), Providence, RI, USA.
4. Zhang, J., and Singh, S. (2014, January 12). LOAM: Lidar Odometry and Mapping in Real-Time. Proceedings of the Robotics: Science and Systems X.; Robotics: Science and Systems Foundation, Berkeley, CA, USA.10.15607/RSS.2014.X.007 ↗
5. Feng, Z., Chen, J., Liang, Y., Liu, W., and Peng, Y. (2025). Enhancing LiDAR–IMU SLAM for Infrastructure Monitoring via Dynamic Coplanarity Constraints and Joint Observation. Sensors, 25.10.3390/s25175330 ↗
6. Enhanced Low Drift LiDAR SLAM with Dynamic Noise Using Ground Principal Plane Constraint10.1016/j.measurement.2024.116549 ↗
7. Chen, X., Wang, L., and Zhang, H. (2024). Efficient Dynamic LiDAR Odometry for Mobile Robots with Adaptive Clustering. arXiv.
8. Jiang, X. (2019). Visual and Lidar-Based SLAM by Variational Bayesian Methods. [Ph.D. Thesis, Nanyang Technological University].
9. On the Representation and Estimation of Spatial Uncertainty10.1177/027836498600500404 ↗
10. Hybrid SLAM-based exploration of a mobile robot for 3D scenario reconstruction and autonomous navigation10.12700/APH.18.6.2021.6.11 ↗
11. State-of-the-art and tendency of SLAM algorithms based on 3D LiDAR
12. Debeunne, C., and Vivet, D. (2020). A review of visual–LiDAR fusion based simultaneous localization and mapping. Sensors, 20.10.3390/s20072068 ↗
13. 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 ↗
14. Chen, X., Milioto, A., Palazzolo, E., Giguère, P., Behley, J., and Stachniss, C. (2019, January 3–8). SuMa++: Efficient lidar-based semantic SLAM. Proceedings of the 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Macau, China.10.1109/IROS40897.2019.8967704 ↗
15. A comprehensive review on sensor fusion techniques for localization of a dynamic target in GPS-denied environments10.1109/ACCESS.2024.3519874 ↗
16. 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 ↗
17. Wei, Y., Yang, R., and Tan, B. (2022, January 15–17). A fast 3D laser SLAM method for indoor scenarios. Proceedings of the 2022 34th Chinese Control and Decision Conference (CCDC), Hefei, China.10.1109/CCDC55256.2022.10034242 ↗
18. On-manifold preintegration for real-time visual-inertial odometry10.1109/TRO.2016.2597321 ↗
19. Multimodal features and accurate place recognition with robust optimization for li-dar-visual-inertial SLAM
20. LiDAR-based semantic place recognition in dynamic urban environments10.1109/JSEN.2024.3430259 ↗
21. Challenges and Solutions of LiDAR SLAM in Dynamic Environments
22. Multi-sensor Fusion SLAM Technology Development Trend
23. LiDAR-based SLAM for robotic mapping: State of the art and new frontiers10.1108/IR-09-2023-0225 ↗
24. Enhancing SLAM algorithm with Top-K optimization and semantic descriptors10.1038/s41598-025-90968-3 ↗
25. Loosely-coupled lidar-inertial odometry and mapping in real time10.1007/s41315-021-00164-5 ↗
26. Research on tightly coupled SLAM method based on LiDAR/IMU10.1088/1742-6596/2787/1/012060 ↗
27. Le Gentil, C., Falque, R., and Vidal-Calleja, T. (2024, January 14–18). Real-time truly-coupled lidar-inertial motion correction and spatiotemporal dynamic object detection. Proceedings of the 2024 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Abu Dhabi, United Arab Emirates.10.1109/IROS58592.2024.10802233 ↗
28. Equivariant IMU preintegration with biases: A Galilean group approach
29. Continuous-time fixed-lag smoothing for lidar-inertial-camera SLAM10.1109/TMECH.2023.3241398 ↗
30. The accuracy analysis of iterative weighted IEKF-BP combination algorithm for Li-DAR/Radar loose combination
31. Ji, P., Xu, Q., and Zhao, Y. (2024). Lidar simultaneous localization and mapping algorithm for dynamic scenes. World Electr. Veh. J., 15.10.3390/wevj15120567 ↗
32. Li, Q., Chen, S., Wang, C., Li, X., Wen, C., Cheng, M., and Li, J. (2019, January 15–20). LO-Net: Deep real-time lidar odometry. Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR), Long Beach, CA, USA.10.1109/CVPR.2019.00867 ↗
33. Behley, J., and Stachniss, C. (2018). Efficient surfel-based SLAM using 3D laser range data in urban environments. Robotics: Science and Systems XIV, Carnegie Mellon University.10.15607/RSS.2018.XIV.016 ↗
34. Li, L., Kong, X., Zhao, X., Li, W., Wen, F., Zhang, H., and Liu, Y. (June, January 30). SA-LOAM: Semantic-aided LiDAR SLAM with loop closure. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi’an, China.10.1109/ICRA48506.2021.9560884 ↗
35. Deep learning-enhanced SLAM: A comprehensive bibliometric analysis and research trends (2019–2024)
36. Accelerating deep learning with fixed time budget10.1007/s00521-024-10637-w ↗
37. Laser inertial SLAM algorithm for highly dynamic environments
38. A framework of dynamic obstacle rejection algorithm for laser 3D point cloud
39. Point cloud segmentation based on Euclidean clustering and multi-plane extraction in rugged field10.1088/1361-6501/abead3 ↗
40. ERASOR: Egocentric ratio of pseudo occupancy-based dynamic object removal for static 3D point cloud map building10.1109/LRA.2021.3061363 ↗
41. A curved-feature-driven LiDAR/IMU fusion method for simultaneous localization and mapping
42. Shi, S. (2025). Research and Experiment on Key Technologies for Autonomous Navigation of Mobile Robots in Swine-House Environments. [Ph.D. Thesis, Henan Agricultural University].
43. Liu, Y. (2025). LiDAR SLAM Relocalization Leveraging LIO-SAM Prior Maps. [Master’s Thesis, Dalian Jiaotong University].
44. Liu, X. (2025). LiDAR-Based Motion-Parameter Estimation for Dynamic Targets Within SLAM Frameworks. [Master’s Thesis, University of Chinese Academy of Sciences (Xi’an Institute of Optics and Precision Mechanics)].
45. Zhang, C. (2025). Structured-Environment Perception and SLAM for Underwater Desilting Robots. [Master’s Thesis, Dalian Jiaotong University].
46. Li, Z. (2025). Design and Implementation of a Fully Autonomous Mobile Robot System via Multi-Sensor Fusion SLAM. [Master’s Thesis, Qilu University of Technology].
47. Roriz, R., Silva, H., Dias, F., and Gomes, T. (2024). A Survey on Data Compression Techniques for Automotive LiDAR Point Clouds. Sensors, 24.10.3390/s24103185 ↗
48. Noh, C., Yang, W., Jung, M., Jung, S., and Kim, A. (2025). GaRLIO: Gravity enhanced Radar-LiDAR-Inertial Odometry. arXiv.10.1109/ICRA55743.2025.11128334 ↗
49. Application of multi-sensor fusion localization algorithm based on recurrent neural networks10.1038/s41598-025-90492-4 ↗
50. M2DGR: A Multi-Sensor and Multi-Scenario SLAM Dataset for Ground Robots10.1109/LRA.2021.3138527 ↗