Improved Cubature Kalman Filter Based Attitude Estimation Avoiding Singularity

  • WEI Xiqing ,
  • SONG Shenmin
Expand
  • Center of Control Theory and Guidance Technology, Harbin Institute of Technology, Harbin 150001, China

Received date: 2012-05-03

  Revised date: 2012-08-27

  Online published: 2013-03-29

Supported by

National Natural Science Foundation of China (61174037)

Abstract

Spacecraft attitude estimation of from vector observations is a nonlinear problem in essence. The cubature Kalman filter (CKF) is combined with an iterative Levenberg-Marquardt (LM) algorithm in order to improve the accuracy of spacecraft attitude estimation. By fusing the improved CKF and quaternion, cubature quaternion estimator (CQE) never encounter singularity. Furthermore, cubature modified Rodrigues parameters estimator (CME) is derived by switching the modified Rodrigues parameters to the shadow modified Rodrigues parameters. Simulations demonstrate that the performance of the improved CME is more robust with faster convergence in conditions of large initial errors than the original CKF.

Cite this article

WEI Xiqing , SONG Shenmin . Improved Cubature Kalman Filter Based Attitude Estimation Avoiding Singularity[J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2013 , 34(3) : 610 -619 . DOI: 10.7527/S1000-6893.2013.0098

References

[1] Fehse W. Automated rendezvous and docking of spacecraft. New York: Cambridge University Press, 2003: 218-279.

[2] Stoll E, Letschnik J, Walter U, et al. On-orbit servicing. IEEE Robotics and Automation Magazine, 2009, 16(4): 29-33.

[3] Alfriend K T, Vadali S R, Gurfil P, et al. Spacecraft formation flying: dynamics, control, and navigation. Kidlington: Butterworth-Heinemann, 2009: 83-122.

[4] Lefferts E J, Markley F L, Shuster M D. Kalman filtering for spacecraft attitude estimation. Journal of Guidance, Control, and Dynamics, 1982, 5(5): 417-429.

[5] Bar-Itzhack I Y, Oshman Y. Attitude determination from vector observations: quaternion estimation. IEEE Transactions on Aerospace and Electronic Systems, 1985, 21(1): 128-136.

[6] Kim S G, Crassidis J L, Cheng Y, et al. Kalman filtering for relative spacecraft attitude and position estimation. Journal of Guidance, Control, and Dynamics, 2007, 30(1): 133-143.

[7] Xiong K, Liu L D, Liu Y W. Regularized robust filter for spacecraft attitude determination. Chinese Journal of Aeronautics, 2011, 24(4): 467-475.

[8] Yang J, Ji H X, Wei M K. Error analysis and application of a nonlinear filter. Acta Aeronautica et Astronautica Sinica, 2011, 32(8): 1469-1477.(in Chinese) 杨静, 冀红霞, 魏明坤. 一种非线性滤波器的误差分析及应用. 航空学报, 2011, 32(8): 1469-1477.

[9] Wan E A, van der Merwe R. The unscented Kalman filter for nonlinear estimation. The IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium, 2000: 153-158.

[10] Crassidis J L, Markley F L. Unscented filtering for spacecraft attitude estimation. Journal of Guidance, Control, and Dynamics, 2003, 26(4): 536-542.

[11] Carmi A, Oshman Y. Fast particle filtering for attitude and angular-rate estimation from vector observations. Journal of Guidance, Control, and Dynamics, 2009, 32(1): 70-78.

[12] Cheng Y, Crassidis J L. Particle filtering for attitude estimation using a minimal local-error representation. Journal of Guidance, Control, and Dynamics, 2010, 33(4): 1305-1310.

[13] Arasaratnam I, Haykin S. Cubature Kalman filters. IEEE Transactions on Automatic Control, 2009, 54(6): 1254-1269.

[14] Arasaratnam I, Haykin S, Hurd T R. Cubature Kalman filtering for continuous-discrete systems: theory and simulations. IEEE Transactions on Signal Processing, 2010, 58(10): 4977-4993.

[15] Chen J Z, Yuan J P, Fang Q. Flight vehicle attitude determination using the modified Rodrigues parameters. Chinese Journal of Aeronautics, 2008, 21(5): 433-440.

[16] Schaub H, Junkins J L. Stereographic orientation parameters for attitude dynamics: a generalization of the Rodrigues parameters. Journal of the Astronautical Sciences, 1996, 44(1): 1-19.

[17] Crassidis J L, Junkins J L. Optimal estimation of dynamic systems. Boca Raton: Chapman & Hall, 2004: 419-433.

[18] Shuster M D. A survey of attitude representations. Journal of the Astronautical Sciences, 1993, 41(4): 439-517.

[19] Hurtado J E. Interior parameters, exterior parameters, and a Cayley-like transform. Journal of Guidance, Control, and Dynamics, 2009, 32(2): 653-657.

[20] Crassidis J L, Markley F L. Attitude estimation using modified Rodrigues parameters. Proceedings of the American Astronautical Society F. Landis Markley Astronautics Symposium, 1996: 71-86.

[21] Arulampalam M S, Ristic B, Gordon N, et al. Bearings-only tracking of manoeuvring targets using particle filters. EURASIP Journal on Applied Signal Processing, 2004, 2004(15): 2351-2365.

Outlines

/