A Fault Detection Algorithm for LiDAR/IMU Integrated Localization Systems with Non-Gaussian Noises

Penggao Yan, Weisong Wen, Feng Huang, and Li-Ta Hsu

Peer Reviewed

Abstract: Fault detection for localization systems with non-Gaussian measurement noises is a challenging task. This paper investigates the impacts of noise modeling on fault detection performance in the inertial measurement units (IMU) and light detection and ranging (LiDAR) integrated localization system based on the extended Kalman filter (EKF). Specifically, we model the noise distribution of LiDAR range measurements as a Gaussian mixture model (GMM) and establish a clear relationship between the measurement noise and the measurement residual in EKF through error propagation. After proving that the measurement residual is also GMM distributed, a test statistic is constructed by transforming the measurement residual to a variable that approximates a standard multivariate normal (MVN) distribution based on the law of total covariance. Then, a Chi-squared test is performed based on the constructed test statistic to detect potential faults. The performance of the proposed method is evaluated in the simulated environment regarding two types of measurement failures, including the step failure and the slope failure. Compared to the method that adopts Gaussian noise modeling, the proposed method demonstrates its superiority in detecting small faults and the improved sensitivity to slowly increasing faults.
Published in: Proceedings of the 2024 International Technical Meeting of The Institute of Navigation
January 23 - 25, 2024
Hyatt Regency Long Beach
Long Beach, California
Pages: 561 - 574
Cite this article: Yan, Penggao, Wen, Weisong, Huang, Feng, Hsu, Li-Ta, "A Fault Detection Algorithm for LiDAR/IMU Integrated Localization Systems with Non-Gaussian Noises," Proceedings of the 2024 International Technical Meeting of The Institute of Navigation, Long Beach, California, January 2024, pp. 561-574. https://doi.org/10.33012/2024.19564
Full Paper: ION Members/Non-Members: 1 Download Credit
Sign In