A Novel DVL Calibration Method Based on Robust Invariant Extended Kalman Filter

Abstract

The calibration accuracy of the Doppler Velocity Log (DVL) error directly affects the performance of the SINS/DVL integrated navigation system. Previous studies of DVL calibration have not dealt with DVL measurement outliers. Therefore, in this paper, a novel DVL calibration method is proposed to reduce the influence of outliers on calibration accuracy. Introducing the Lie group theory to the DVL calibration study for the first time, and taking advantage of the Special Orthogonal Group of order 3 [SO(3)] representation, a new DVL calibration model based SO(3) group with the ability to represent large misalignment angles is established. And an invariant extended Kalman filter (IEKF) design for the DVL calibration model is introduced. Then, a robust IEKF is proposed by combining the linear error propagation equation of the SO(3)-based DVL calibration model with the statistical similarity measure (SSM) theory. The proposed robust IEKF algorithm enriches the IEKF theory and has the ability to accurately estimate the state of the Lie group model in outlier environments. The simulation and lake trial are used to illustrate the effectiveness and superiority of the proposed DVL calibration method.