Performance Enhancement of INS and UWB Fusion Positioning Method Based on Two-Level Error Model

In GNSS-denied environments, especially when losing measurement sensor data, inertial navigation system (INS) accuracy is critical to the precise positioning of vehicles, and an accurate INS error compensation model is the most effective way to improve INS accuracy. To this end, a two-level error model is proposed, which comprehensively utilizes the mechanism error model and propagation error model. Based on this model, the INS and ultra-wideband (UWB) fusion positioning method is derived relying on the extended Kalman filter (EKF) method. To further improve accuracy, the data prefiltering algorithm of the wavelet shrinkage method based on Stein's unbiased risk estimate-Shrink (SURE-Shrink) threshold is summarized for raw inertial measurement unit (IMU) data. The experimental results show that by employing the SURE-Shrink wavelet denoising method, positioning accuracy is improved by 76.6%; by applying the two-level error model, the accuracy is further improved by 84.3%. More importantly, at the point when the vehicle motion state changes, adopting the two-level error model can provide higher computational stability and less fluctuation in trajectory curves.