A Polar Robust Kalman Filter Algorithm for DVL-Aided SINSs Based on the Ellipsoidal Earth Model

Autonomous underwater vehicles (AUVs) play an increasingly essential role in the field of polar ocean exploration, and the Doppler velocity log (DVL)-aided strapdown inertial navigation system (SINS) is widely used for it. Due to the rapid convergence of the meridians, traditional inertial navigation mechanisms fail in the polar region. To tackle this problem, a transverse inertial navigation mechanism based on the earth ellipsoidal model is designed in this paper. Influenced by the harsh environment of the polar regions, unknown and time-varying outlier noise appears in the output of DVL, which makes the performance of the standard Kalman filter degrade. To address this issue, a robust Kalman filter algorithm based on Mahalanobis distance is used to adaptively estimate measurement noise covariance; thus, the Kalman filter gain can be modified to weight the measurement. A trial ship experiment and semi-physical simulation experiment were carried out to verify the effectiveness of the proposed algorithm. The results demonstrate that the proposed algorithm can effectively resist the influence of DVL outliers and improve positioning accuracy.