Abstract The strapdown inertial navigation system (SINS)/doppler velocity log (DVL) integrated navigation is one of the primary methods for underwater navigation, providing autonomous underwater vehicles with precise information on position, velocity, and attitude. The core idea of the SINS/DVL integrated navigation using the Kalman filter is to establish the state and observation equations to estimate the SINS navigation error using DVL velocity. The optimal state estimation and correction strategies are critical to the accuracy of integrated navigation. To address this, this paper proposes a hybrid correction method for SINS/DVL Kalman filter integrated navigation based on a convergence factor judgment (HCKF-CFJ). First, the convergence factor for the Kalman filter is constructed using the diagonal elements of the estimated error covariance matrix corresponding to the velocity error state. Then, the filter's stability is assessed based on this convergence factor. When stability is confirmed, direct feedback correction is applied to the SINS velocity, and indirect feedback correction is applied to the SINS position. SINS velocity and position undergo feedforward correction if the stability condition is not met. Finally, ship experiments validate the effectiveness of the proposed method.
Read full abstract