A Novel Scheme for DVL-Aided SINS In-Motion Alignment Using UKF Techniques

摘要

In-motion alignment of Strapdown Inertial Navigation Systems (SINS) without any geodetic-frame observations is one of the toughest challenges for Autonomous Underwater Vehicles (AUV). This paper presents a novel scheme for Doppler Velocity Log (DVL) aided SINS alignment using Unscented Kalman Filter (UKF) which allows large initial misalignments. With the proposed mechanism, a nonlinear SINS error model is presented and the measurement model is derived under the assumption that large misalignments may exist. Since a priori knowledge of the measurement noise covariance is of great importance to robustness of the UKF, the covariance-matching methods widely used in the Adaptive KF (AKF) are extended for use in Adaptive UKF (AUKF). Experimental results show that the proposed DVL-aided alignment model is effective with any initial heading errors. The performances of the adaptive filtering methods are evaluated with regards to their parameter estimation stability. Furthermore, it is clearly shown that the measurement noise covariance can be estimated reliably by the adaptive UKF methods and hence improve the performance of the alignment.