Quaternion central difference Kalman filtering algorithm for SINS/CCD system attitude estimation

Guoqiang Ding,Jie Xu,Weidong Zhou,Zhiyan Zhang
DOI: https://doi.org/10.13245/j.hust.140905
2014-01-01
Abstract:A unit quaternion second-order central divided Kalman filtering algorithm was proposed to solve the slow convergence rate and low computational accuracy problems of carriers attitude determi-nation multiplicative quaternion extended Kalman filter algorithm in the strapdown inertial navigation system (SINS) with large initial attitude angle error .The unit quaternion nonlinear attitude estima-tion model was derived for strapdown inertial navigation system combined with observation equation and observational data of high accuracy charge coupled device (CCD) star sensor ,addressing to the u-nit quaternion weighting sum normalization problem .The Lagrange cost function was derived to com-pute the predicted average unit quaternion by minimized the cost function ,and at the same time the quaternion central divided difference Kalman filter algorithm separating the quaternion state vector and non-quaternion vector to calculate their predicted average values and error covariance matrix to achieve the goals that the algorithm could improve computational efficiency and numerical stability .The simu-lation results indicate that the proposed quaternion central divided Kalman filter algorithm ,compared with traditional multiplicative quaternion extended Kalman filter and quaternion unscented Kalman fil-ter ,provides higher estimation precision with faster convergence rate and better numerical stability , and the numerical computation time is improved compared to multiplicative quaternion extended Kal-man filter algorithm .
What problem does this paper attempt to address?