An outlier-robust Rao–Blackwellized particle filter for underwater terrain-aided navigation

Abstract

Terrain-aided navigation (TAN) is one of the key techniques for autonomous navigation and positioning of AUVs. This paper develops a novel integrated navigation system that combines the inertial navigation system (INS) and TAN into one filter, in contrast to the conventional INS/TAN model. This method not only provides a position estimate for the carrier but also the INS error, which increases the filtering dimension significantly. Thus, the Rao-Blackwellized particle filter (RBPF) technique is introduced to address the “dimensional disaster” problem. A three-dimensional (3-D) model is established to estimate the horizontal position while compensating for the tidal inaccuracy by extending the tidal depth bias to the state space. Furthermore, the variable and complex underwater environment can potentially result in outlier interference in depth measurements, which significantly degrades the performance of the RBPF-based estimation algorithm. This paper thus presents a 3-D adaptive RBPF method based on the maximum correntropy criterion (MCC) to suppress the influence of measurement outliers on positioning precision. Simulations and experimental tests verify the effectiveness of the proposed algorithm. The results demonstrated that the 3-D model-based AMCCRBPF method can effectively improve robustness to outliers and provide an accurate estimate of the tidal depth bias.