Performance Enhancement of Robust Cubature Kalman Filter for GNSS/INS Based on Gaussian Process Quadrature

Abstract

The sigma-point Kalman filters are generally considered to outperform extended Kalman filter in the application of GNSS/INS, where cubature Kalman filter (CKF) is widely approved because of its rigorous mathematic derivation. In order to improve the robustness of GNSS/INS under GNSS-challenged environment, a robust CKF (RCKF) is developed based on novel sigma-point update framework (NSUF) in our previous work, whereas the efficiency of NSUF is still plagued by the unknown process model uncertainty. In this paper, an enhanced RCKF is proposed based on Gaussian process quadrature (GPQ), where the uncertainty consisted in sigma points transform is processed by GPQ conditioning on the approximated posterior PDF. Experiment result on loosely coupled GNSS/INS demonstrates the superiority of proposed method, where the heading error and roll error are reduced by 60.5% and 37.5% respectively compared with RCKF, and it achieves better position result than GP-CKF under GNSS outage.