Performance analysis of improved iterated cubature Kalman filter and its application to GNSS/INS.
In order to improve the accuracy and robustness of GNSS/INS navigation system, an improved iterated cubature Kalman filter (IICKF) is proposed by considering the state-dependent noise and system uncertainty. First, a simplified framework of iterated Gaussian filter is derived by using damped Newton-Raphson algorithm and online noise estimator. Then the effect of state-dependent noise coming from iterated update is analyzed theoretically, and an augmented form of CKF algorithm is applied to improve the estimation accuracy. The performance of IICKF is verified by field test and numerical simulation, and results reveal that, compared with non-iterated filter, iterated filter is less sensitive to the system uncertainty, and IICKF improves the accuracy of yaw, roll and pitch by 48.9%, 73.1% and 83.3%, respectively, compared with traditional iterated KF.
School of Instrument Science and Engineering, Southeast University, Nanjing, Jiangsu 210096, China; Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology Ministry of Education, Nanjing, Jiangsu 210096, China.
Bingbo
B
Cui
School of Instrument Science and Engineering, Southeast University, Nanjing, Jiangsu 210096, China; Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology Ministry of Education, Nanjing, Jiangsu 210096, China. Electronic address: chxiyuan@seu.edu.cn.
Xiyuan
X
Chen
School of Electrical Engineering, University of Jinan, Jinan, Shandong 250022, China.
Yuan
Y
Xu
School of Instrument Science and Engineering, Southeast University, Nanjing, Jiangsu 210096, China; Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology Ministry of Education, Nanjing, Jiangsu 210096, China.
Haoqian
H
Huang
School of Instrument Science and Engineering, Southeast University, Nanjing, Jiangsu 210096, China; Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology Ministry of Education, Nanjing, Jiangsu 210096, China.
Xiao
X
Liu
Adaptive filter; Cubature Kalman filter; Integrate navigation; Iterated Gaussian filter