Adaptive “Cubature and Sigma Points” Kalman Filtering Applied to MEMS IMU/GNSS Data Fusion during Measurement Outlier

Abstract

In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific problem generally occurs in intentional and non-intentional interferences caused by other radio navigation sources, or by the GNSS receiver’s deterioration. Non linear approximation techniques such as Extended Kalman filter EKF, Sigma Point Kalman Filters such as UKF and CDKF are computed to estimate the navigation states for UAV flight control. Several comparisons are conduced and analyzed in order to compare the accuracy and the convergence of different approaches usually applied in navigation data fusion purposes. The last non linear filter algorithm developed is the Cubature Kalman Filter CKF which provides more accurate estimation with more stability in Tracking data fusion application. In this work, CKF is compared with SPKF and EKF in ideal conditions and during GNSS outliers supposed to occur during specific interval of time, innovation based adaptive approach is selected and used to modify the covariance calculation of the non linear filters performed in this paper. Interesting results are observed, discussed with real perspectives in navigation data fusion for real time applications. Three parallel modified algorithms are simulated and compared to non-adaptive forms according to Root Mean Square Error (RMSE) criteria.