Skip to main content
SpringerLink
Log in

Attitude Estimation Based on Robust Information Cubature Quaternion Filter

  • Published:
Circuits, Systems, and Signal Processing Aims and scope Submit manuscript

Abstract

We propose a robust attitude estimation method for multisensor systems with heavy-tailed noise. The attitude model is represented by a quaternion, and the propagation process in the filter is based on a gyro-based model. To avoid the constraint of quaternion, the quaternion is converted to modified Rodrigues parameters during the prediction and update process. Instead of the minimum mean square error principle, the maximum correntropy criterion is applied in the update process, which is robust to heavy-tailed noises. Considering the linear form in the update process, the information filtering algorithm is applied in the proposed method to simplify the calculation of multisensor information fusion. Moreover, the application of information filtering algorithm can also avoid the numerical problem that zero weight functions cannot be incorporated into the Gaussian filtering framework. Simulations for several cases are performed, and the simulation results indicate the robustness and efficiency of the proposed filter.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Log in via an institution

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6

Similar content being viewed by others

References

  1. K.P.B. Chandra, D.W. Gu, I. Postlethwaite, Square root cubature information filter. IEEE Sens. J. 13(2), 750–758 (2013)

    Article  Google Scholar 

  2. T.K. Chang, A. Mehta, Control-theoretical and topological analysis of covariance intersection based distributed Kalman filter. IEEE. Contr. Syst. Let. 2(4), 665–670 (2018)

    Article  Google Scholar 

  3. L. Chang, B. Hu, G. Chang, Modified unscented quaternion estimator based on quaternion averaging. J. Guid. Control. Dynam. 37(1), 305–309 (2014)

    Article  Google Scholar 

  4. L. Chang, B. Hu, G. Chang, A. Li, Huber-based novel robust unscented Kalman filter. IET Sci. Meas. Technol. 6(6), 502–509 (2012)

    Article  Google Scholar 

  5. H. Chen, Z. Cao, S. Su, J. Liu, Z. Wang, Measurement system for attitude of anterior pelvic plane and implantation of prothesis in THR surgery. IEEE. Trans. Instrum. Meas. 13(1), 48–62 (2018)

    Google Scholar 

  6. J.L. Crassidis, Sigma-Point Kalman Filtering for Integrated GPS and Inertial Navigation. IEEE Trans. Aerosp. Electron. Syst. 42(2), 750–756 (2006)

    Article  Google Scholar 

  7. J.L. Crassidis, F.L. Markley, Unscented filtering for spacecraft attitude estimation. J. Guid. Control Dynam. 26(4), 536–542 (2003)

    Article  Google Scholar 

  8. R.V. Garcia, H.K. Kuga, M.C. Zanardi, Unscented Kalman filter for spacecraft attitude estimation using modified Rodrigues parameters and real data. Comput. Appl. Math. 35(3), 835–846 (2016)

    Article  MathSciNet  Google Scholar 

  9. Q. Ge, T. Shao, Q. Yang, X. Shen, C. Wen, Multisensor nonlinear fusion methods based on adaptive ensemble fifth-degree iterated cubature information filter for biomechatronics. IEEE. Trans. Syst. Man Cybern.-Syst. 47(7), 912–925 (2017)

    Article  Google Scholar 

  10. D.E. George, A. Unnikrishnan, Tracking of maneuvering targets using fuzzy information fusion filter. International Journal of Image & Data Fusion 9(2), 1–16 (2017)

    Google Scholar 

  11. Y. Huang, Y. Zhang, N. Li, J. Chambers, A robust Gaussian approximate fixed-interval smoother for nonlinear systems with heavy-tailed process and measurement noises. IEEE. Signal. Proc. Let. 23(4), 468–472 (2016)

    Article  Google Scholar 

  12. P.J. Huber, Robust Estimation of a Location Parameter (Springer, New York, 1992)

    Book  Google Scholar 

  13. A. Khalili, A. Rastegarnia, M.K. Islam, T.Y. Rezaii, Steady-state tracking analysis of adaptive filter with maximum correntropy criterion. Circ. Syst. Signal Process. 36(4), 1725–1734 (2017)

    Article  Google Scholar 

  14. P. Konghuayrob, S. Kaitwanidvilai, H. Aoyama, Hybrid adaptive notch filter and fixed-structure PID h-infinity robust loop shaping control based PSO for hard disk drive servo actuator. Int. J. Innov. Comput. Inf. Control 15(1), 1–20 (2018)

    Google Scholar 

  15. F. Li, L. Chang, B. Hu, K. Li, Marginalized unscented quaternion estimator for integrated INS/GPS. J. Navigation. 69(5), 1125–1142 (2016)

    Article  Google Scholar 

  16. J. Li, X. Li, Q. Su, Fault detection filter design for discrete-time switched time-delay systems with static quantizer and quantized feedback. Int. J. Innov. Comput. Inf. Control 14(4), 1465–1479 (2018)

    Google Scholar 

  17. W. Li, D. Gong, M. Liu, J. Chen, D. Duan, Adaptive robust Kalman filter for relative navigation using global position system. IET Radar Sonar Nav. 7(5), 471–479 (2013)

    Article  Google Scholar 

  18. H. Lin, S. Sun, A solution to estimation fusion for multi-rate measurements with delays. IEEE Trans. Aerosp. Electron. Syst. 53(6), 3020–3031 (2017)

    Article  Google Scholar 

  19. X. Liu, B. Chen, B. Xu, Z. Wu, P. Honeine, Maximum correntropy unscented filter. Int. J. Syst. Sci. 48(8), 1607–1615 (2017)

    Article  MathSciNet  Google Scholar 

  20. S.T.G. Maguire, P.A. Robertson, UAV Attitude estimation using low frequency radio polarization measurements. IEEE Trans. Aerosp. Electron. Syst. 53(1), 2–11 (2017)

    Article  Google Scholar 

  21. F.L. Markley, J.E. Sedlak, Kalman filter for spinning spacecraft attitude estimation. J. Guid. Control Dyn. 31(6), 1750–1760 (2015)

    Article  Google Scholar 

  22. F.L. Markley, Y. Cheng, J.L. Crassidis, Y. Oshman, Averaging Quaternions. J. Guid. Control. Dyn. 30(4), 1193–1196 (2007)

    Article  Google Scholar 

  23. A. Odry, R. Fullér, I.J. Rudas, P. Odry, Kalman filter for mobile-robot attitude estimation: novel optimized and adaptive solutions. Mech. Syst. Signal. Process. 110(C), 569–589 (2018)

    Article  Google Scholar 

  24. Z. Qiu, H. Qian, G. Wang, Adaptive robust cubature Kalman filtering for satellite attitude estimation. Chin. J. Aeronaut. 31(4), 1–14 (2018)

    Google Scholar 

  25. C. Shen, Y. Zhang, X. Guan, R.A. Maxion, Performance analysis of multi-motion sensor behavior for active smartphone authentication. IEEE Trans. Inf. Forensics Sec. 13(1), 48–62 (2018)

    Article  Google Scholar 

  26. H.E. Söken, An attitude filtering and magnetometer calibration approach for nanosatellites. Int. J. Aeronaut. Space 19(1), 164–171 (2018)

    Article  Google Scholar 

  27. B.N. Stovner, T.A. Johansen, T.I. Fossen, I. Schjolberg, Attitude estimation by multiplicative exogenous Kalman filter. Automatica 95, 347–355 (2018)

    Article  MathSciNet  Google Scholar 

  28. X. Tang, Z. Liu, J. Zhang, Square-root quaternion cubature Kalman filtering for spacecraft attitude estimation. Acta Astronaut. 76(4), 84–94 (2012)

    Article  Google Scholar 

  29. Y. Wang, W. Zheng, S. Sun, L. Li, Robust information filter based on maximum correntropy criterion. J. Guid. Control Dynam. 39(5), 1–6 (2016)

    Article  Google Scholar 

  30. W. Wang, H. Zhao, B. Chen, Robust adaptive Volterra filter under maximum correntropy criteria in impulsive environments. Circ. Syst. Signal. Pr. 36(10), 4097–4117 (2017)

    Article  Google Scholar 

  31. Y. Wang, S. Sun, L. Li, Adaptively robust unscented Kalman filter for tracking a maneuvering vehicle. J. Guid. Control Dyn. 37(5), 1696–1701 (2014)

    Article  Google Scholar 

  32. J. Wu, Z. Zhou, H. Fourati, R. Li, M. Liu, Generalized linear quaternion complementary filter for attitude estimation from multi-sensor observations: an optimization approach. IEEE. Trans. Autom. Sci. Eng. 16(3), 1330–1343 (2019)

    Article  Google Scholar 

  33. B. Zhu, L. Chang, J. Xu, Huber-based adaptive unscented Kalman filter with non-Gaussian measurement noise. Circ. Syst. Signal Process. 37(9), 3842–3861 (2018)

    Article  MathSciNet  Google Scholar 

Download references

Author information

Authors and Affiliations

  1. Beijing Institute of Space Long March Vehicle, Beijing, China

    Xiaohang Wu

  2. Control and Simulation Center, Harbin Institute of Technology, Harbin, China

    Kemao Ma

Authors
  1. Xiaohang Wu
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. Kemao Ma
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Xiaohang Wu.

Additional information

Publisher's Note

Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Wu, X., Ma, K. Attitude Estimation Based on Robust Information Cubature Quaternion Filter. Circuits Syst Signal Process 39, 2948–2967 (2020). https://doi.org/10.1007/s00034-019-01288-7

Download citation

  • Received:

  • Revised:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s00034-019-01288-7

Keywords

Search

Navigation