Adaptive Integrated Navigation Algorithm Based on Interactive Filter

To address the diverse requirements of accuracy and robustness in integrated navigation for unmanned aerial vehicles, an interactive robust filter algorithm that integrates the interactive multiple model concept and leverages the complementary applicability of the strong tracking filter and the smooth variable structure filter is proposed. The algorithm operates as follows: the strong tracking filter, along with the smooth variable structure filter, operates side by side with distinct models. During the filter process, the likelihood function is utilized to update the filter probabilities and determine the weights for each one of the filters. Input interaction, coupled with output fusion, is then carried out. The results of the experiments validate that the presented interactive filter algorithm significantly reduces estimation errors. When confronted with complex, dynamic noise environments and system uncertainties, it retains high-precision state estimation while demonstrating markedly improved robustness. The proposed interactive robust filter algorithm is compared against the strong tracking filter, smooth variable structure filter, and strong tracking smooth filter. Taking the strong tracking smooth filter, which has the highest accuracy among the three, as the reference baseline, the presented interactive robust filter algorithm achieves over 16% improvement in velocity accuracy and over 40% improvement in position accuracy.