Huber’s M-Estimation-Based Cubature Kalman Filter for an INS/DVL Integrated System

Abstract

To deal with the problems of outliers and nonlinearity in the complex underwater environment, a Huber’s M-estimation-based cubature Kalman filter (CKF) is proposed for an inertial navigation system (INS)/Doppler velocity log (DVL) integrated system. First, a loosely coupled INS/DVL integrated system is designed, and the nonlinear system model is established in the case of big misalignment angle. Then, Huber’s M-estimation is introduced for robust estimation to resist outliers. Meanwhile, the CKF is focused to handle the nonlinearity of the state equation. Finally, simulation and the vehicle test are conducted to evaluate the effectiveness of the proposed method. Results show that the proposed method outperforms the conventional Kalman filter (KF) and outlier detection-based robust cubature Kalman filter (RCKF) in terms of navigation accuracy in the complex underwater environment.