A derivative UKF for tightly coupled INS/GPS integrated navigation

Abstract

The tightly coupled INS/GPS integration introduces nonlinearity to the measurement equation of the Kalman filter due to the use of raw GPS pseudorange measurements. The extended Kalman filter (EKF) is a typical method to address the nonlinearity by linearizing the pseudorange measurements. However, the linearization may cause large modeling error or even degraded navigation solution. To solve this problem, this paper constructs a nonlinear measurement equation by including the second-order term in the Taylor series of the pseudorange measurements. Nevertheless, when using the unscented Kalman filter (UKF) to the INS/GPS integration for navigation estimation, it causes a great amount of redundant computation in the prediction process due to the linear feature of system state equation, especially for the case with system state vector in much higher dimension than measurement vector. To overcome this drawback in computational burden, this paper further develops a derivative UKF based on the constructed nonlinear measurement equation. The derivative UKF adopts the concise form of the original Kalman filter (KF) to the prediction process and employs the unscented transformation technique to the update process. Theoretical analysis and simulation results demonstrate that the derivative UKF can achieve higher accuracy with a much smaller computational cost in comparison with the traditional UKF.

Keywords: Computational cost; INS/GPS integration; Nonlinear measurement equations; Unscented Kalman filter.