Orientation Estimation by Means of Extended Kalman Filter, Quaternions, and Charts

Pablo Bernal-Polo, Humberto Martínez-Barberá

Abstract

In this paper, an orientation estimation algorithm is presented. This algorithm is based on the Extended Kalman Filter, and uses quaternions as the orientation descriptor. For the filter update, measures from an inertial measurement unit (IMU) are used. The IMU consists in a triaxial angular rate sensor, and an also triaxial accelerometer.

Quaternions describing orientations live in the unit sphere of R^4. Knowing that this space is a manifold, and applying some basic concepts regarding these mathematical objects, an algorithm that reminds the also called ''Multiplicative Extended Kalman Filter'' arises in a natural way.

The algorithm is tested in a simulated experiment, and in a real one.


Keywords

Extended Kalman filter; Quaternions; Attitude; Pose; Orientation; Estimation; IMU; Manifold; Charts

References

M. D. Shuster, “A survey of attitude representations,” Navigation, vol. 8, no. 9, pp. 439–517, 1993.

E. J. Lefferts, F. L. Markley, and M. D. Shuster, “Kalman filtering for spacecraft attitude estimation,” Journal of Guidance, Control, and Dynamics, vol. 5, no. 5, pp. 417–429, 1982. https://doi.org/10.2514/3.56190

J. L. Crassidis, F. L. Markley, and Y. Cheng, “Survey of nonlinear attitude estimation methods,” Journal of guidance, control, and dynamics, vol. 30, no. 1, pp. 12–28, 2007. https://doi.org/10.2514/1.22452

S. O. Madgwick, A. J. Harrison, and R. Vaidyanathan, “Estimation of imu and marg orientation using a gradient descent algorithm,” in Rehabilitation Robotics (ICORR), 2011 IEEE International Conference on. IEEE, 2011, pp. 1–7. https://doi.org/10.1109/icorr.2011.5975346

F. L. Markley, “Attitude error representations for kalman filtering,” Journal of guidance, control, and dynamics, vol. 26, no. 2, pp. 311–317, 2003. https://doi.org/10.2514/2.5048

S. Madgwick. (2016) Madgwickahrs. [Online]. Available: https://github.com/arduino-libraries/MadgwickAHRS




DOI: https://doi.org/10.14198/JoPha.2017.8.1.03





Creative Commons License
This work is licensed under a Creative Commons Attribution-ShareAlike 4.0 International License.