Abstract
In this paper, for the needs of high-precision and high-continuity localization in complex environments, a modeling method based on time-varying noise and outlier noise is proposed, and variational Bayesian strong tracking filtering is used for 5G/INS fusion localization. A hierarchical progressive fault detection mechanism is proposed to detect IMU rationality faults and consistency faults in 5G observation information. The main contributions are reflected in the following two aspects: first, by innovatively introducing Pearson VII-type distribution for noise modeling, dynamically adjusting the tail thickness characteristics of the probability density function through its shape parameter, and effectively capturing the distribution law of extreme values in the observation data. Afterward, this article combined the variational Bayesian strong tracking filtering algorithm to construct a robust state estimation framework, significantly improving the localization accuracy and continuity in non-Gaussian noise environments. Second, a hierarchical progressive fault detection mechanism is designed. A wavelet fault detection method based on a hierarchical voting mechanism is adopted for IMU data to extract the abrupt features of the observed data and quickly identify faults. In addition, a dual-channel consistency detection model with dynamic fault-tolerant management was constructed. Sudden and gradual faults were quickly detected through a dual-channel pre-check, and then, the fault source was identified through AIME. Based on the fault source detection results, corresponding compensation mechanisms were adopted to achieve robust continuous localization.