UWB/LiDAR Tightly Coupled Positioning Algorithm Based on ISSA Optimized Particle Filter

Xuyin Wang,Fangzheng Gao,Jiacai Huang,Yuan Xue
DOI: https://doi.org/10.1109/jsen.2024.3366941
IF: 4.3
2024-01-01
IEEE Sensors Journal
Abstract:To deal with the disadvantages of non-line-of-sight (NLOS) errors in ultra-wideband (UWB) and cumulative errors in LiDAR which impact positioning accuracy, a UWB/LiDAR tightly coupled positioning method is presented in this paper by the improved sparrow search algorithm (ISSA) optimized particle filter. By incorporating LiDAR measurements, this mehtod offers the distance estimation between the combined positioning system and the UWB base station, and eliminates the NLOS errors in the UWB measurement value. In addition, the ISSA is employed to eliminate the particle degradation phenomenon of particle filter and reduce the required number of particles, which significantly enhances the speed and real-time performance of the data fusion algorithm. Finally, the combined function of UWB/LiDAR is constructed to optimize the global position based on the graph optimization method. The experimental results demonstrate that the particle filter algorithm optimized by ISSA achieves comparable results while utilizing only 25% of the particles required by the original particle filter algorithm. Moreover, the proposed method improves the positioning accuracy by 69.16% and 59.63% compared with UWB and LiDAR alone, and improves the positioning accuracy by 55.71% compared with the fusion positioning using Extended Kalman Filter (EKF). These results highlight the effectiveness of the proposed method in achieving accurate positioning.
engineering, electrical & electronic,instruments & instrumentation,physics, applied
What problem does this paper attempt to address?