Bulletin of Surveying and Mapping ›› 2026, Vol. 0 ›› Issue (2): 92-96.doi: 10.13474/j.cnki.11-2246.2026.0215

Previous Articles     Next Articles

A fusion positioning algorithm of LiDAR and MEMS_IMU

SHEN Wei1,2, LENG Jiaxin1,2, WANG Xiaodan3, FENG Qibin1,2, WANG Zicheng1,2, QIAN Enze1,2   

  1. 1. College of Oceanography and Ecological Science, Shanghai Ocean University, Shanghai 201306, China;
    2. Shanghai Estuary Ocean Surveying and Mapping Engineering Technology Research Center, Shanghai 201306, China;
    3. Fujian Shanshui Surveying and Mapping Geographic Information Co., Ltd., Fuzhou 350011, China
  • Received:2025-06-30 Published:2026-03-12

Abstract: This study addresses the challenge of achieving accurate positioning for survey vessels in GNSS-denied environments such as urban waterways,under bridges,and beneath high-pile wharfs.A novel positioning algorithm is proposed that fuses LiDAR with a low-cost MEMS-IMU,aiming to provide relatively high precision under constraints of low computational cost and inexpensive hardware.The algorithm corrects motion distortion in LiDAR point clouds using MEMS-IMU data.It then employs the NDT for point cloud matching to establish a laser odometry function,with KD-tree enhancement for accelerated point cloud search.Finally,the laser odometry is integrated with the MEMS-IMU-derived odometry within a particle filter for fused positioning in these obscured aquatic scenarios.In indoor simulated experiments,the proposed algorithm achieves an average final-position error of 0.20 m,representing a twofold improvement in accuracy over the standalone NDT algorithm and a tenfold improvement over the ICP algorithm.Outdoor experiments conduct under a bridge further demonstrated that the mapping accuracy of the proposed method is significantly superior to both ICP and NDT algorithms.The proposed method achieves relatively high positioning accuracy (better than 0.2 m in both indoor and outdoor tests)at a low cost,demonstrating good potential for real-time positioning of survey vessels or vehicles in GNSS-deprived environments.

Key words: fusion positioning, LiDAR, MEMS_IMU, LiDAR odometry, particle filter

CLC Number: