Discrete EKF with pairwise Time Correlated Measurement Noise for Image-Aided Inertial Integrated Navigation

An image-aided inertial navigation implies that the errors of an inertial navigator are estimated via the Kalman filter using the aiding measurements derived from images. The standard Kalman filter runs under the assumption that the process noise vector and measurement noise vector are white, i.e. independent and normally distributed with zero means. However, this does not hold in the image-aided inertial navigation. In the image-aided inertial integrated navigation, the relative positions from optic-flow egomotion estimation or visual odometry are pairwise correlated in terms of time. It is well-known that the solution of the standard Kalman filter becomes suboptimal if the measurements are colored or time-correlated. Usually, a shaping filter is used to model timecorrelated errors. However, the commonly used shaping filter assume that the measurement noise vector at epoch k is not only correlated with the one from epoch k – 1 but also with the ones before epoch k – 1 . The shaping filter presented in this paper uses Cholesky factors under the assumption that the measurement noise vector is pairwise time-correlated i.e. the measurement noise are only correlated with the ones from previous epoch. Simulation results show that the new algorithm performs better than the existing algorithms and is optimal.