An Improved ACKF/KF Initial Alignment Method for Odometer-Aided Strapdown Inertial Navigation System

摘要

For a land-vehicle strapdown inertial navigation system (SINS), the problem of initial alignment with large misalignment angle in-motion needs to be solved urgently. This paper proposes an improved ACKF/KF initial alignment method for SINS aided by odometer. The SINS error equation with large misalignment angle is established first in the form of an Euler angle. The odometer/gyroscope dead reckoning (DR) error equation is deduced, which makes the observation equation linear when the position is taken as the observation of the Kalman filter. Then, based on the cubature Kalman filter, the Sage-Husa adaptive filter and the characteristics of the observation equation, an improved ACKF/KF method is proposed, which can accomplish initial alignment well in the case of unknown measurement noise. Computer simulation results show that the performance of the proposed ACKF/KF algorithm is superior to EKF, CKF and AEKF method in accuracy and stability, and the vehicle test validates its advantages.