In this paper we present a quaternion-based Extended Kalman Filter (EKF) for estimating the three-dimensional orientation of a rigid body. The EKF exploits the measurements from an Inertial Measurement Unit (IMU) that is integrated with a tri-axial magnetic sensor. Magnetic disturbances and gyro bias errors are modeled and compensated by including them in the filter state vector. We employ the observability rank criterion based on Lie derivatives to verify the conditions under which the nonlinear system that describes the process of motion tracking by the IMU is observable, namely it may provide sufficient information for performing the estimation task with bounded estimation errors. The observability conditions are that the magnetic field, perturbed by first-order Gauss-Markov magnetic variations, and the gravity vector are not collinear and that the IMU is subject to some angular motions. Computer simulations and experimental testing are presented to evaluate the algorithm performance, including when the observability conditions are critical.
References
[1]
Welch, GF; Foxlin, E. Motion tracking: No silver bullet, but a respectable arsenal. IEEE Comput. Graph. Appl 2002, 22, 24–38.
[2]
Sabatini, AM. Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing. IEEE Trans. Biomed. Eng 2006, 53, 1346–1356.
[3]
Yun, X; Bachmann, ER; McGhee, RB. A simplified quaternion-based algorithm for orientation estimation from earth gravity and magnetic field measurements. IEEE Trans. Instrum. Meas 2008, 57, 638–650.
[4]
Lee, JK; Park, EJ. A fast quaternion-based orientation optimizer via virtual rotation for human motion tracking. IEEE Trans. Biomed. Eng 2009, 56, 1574–1582.
[5]
Veltink, PH; Bussmann, HBJ; de Vries, WHK; Martens, WLJ; Van Lummel, RC. Detection of static and dynamic activities using uniaxial accelerometers. IEEE Trans. Rehabil. Eng 1996, 4, 375–385.
[6]
Bachmann, ER; Yun, X; Peterson, CW. An investigation of the effects of magnetic variations on inertial/magnetic orientation sensors. Proceedings of IEEE International Conference on Robotics and Automation (ICRA '04), New Orleans, LA, USA, 26 April–1 May 2004; pp. 1115–1122.
[7]
de Vries, WHK; Veeger, HEJ; Baten, CTM; van der Helm, FCT. Magnetic distortion in motion labs, implications for validating inertial magnetic sensors. Gait Posture 2009, 29, 535–541.
[8]
Sabatini, AM. Estimating three-dimensional orientation of human body parts by inertial/magnetic sensing. Sensors 2011, 11, 1489–1525.
[9]
Gallagher, A; Matsuoka, Y; Wei-Tech, A. An efficient real-time human posture tracking algorithm using low-cost inertial and magnetic sensors. Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2004), Sendai, Japan, 28 September–2 October 2004; pp. 2967–2972.
[10]
Wahba, G. A least-square estimate of spacecraft attitude. SIAM Rev 1965, 7, 409.
[11]
Gebre-Egziabher, D; Elkaim, GH; Powell, JD; Parkinson, BW. A gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors. Proceedings of IEEE Position Location and Navigation Symposium (PLANS '00), San Diego, CA, USA, 13–16 March 2000; pp. 185–192.
[12]
Markley, FL. Attitude determination and parameter estimation using vector observations: Theory. J. Astronaut. Sci 1989, 37, 41–58.
[13]
Welch, GF. The use of the Kalman filter for human motion tracking in virtual reality. Presence 2009, 18, 72–91.
[14]
Brown, RG; Hwang, PYC. Introduction to Random Signals and Applied Kalman Filtering; John Wiley & Sons: New York, NY, USA, 1997.
[15]
Foxlin, E. Inertial head-tracker sensor fusion by a complementary separate-bias Kalman filter. Proceedings of IEEE Virtual Reality Annual International Symposium, Santa Clara, CA, USA, 30 March–3 April 1996; pp. 185–194.
[16]
Luinge, HJ; Veltink, PH. Inclination measurement of human movement using a 3-D accelerometer with autocalibration. IEEE Trans. Neur. Syst. Rehabil. Eng 2004, 12, 112–121.
[17]
Roetenberg, D; Luinge, HJ; Baten, CTM; Veltink, PH. Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation. IEEE Trans. Neur. Syst. Rehabil. Eng 2005, 13, 395–405.
[18]
Yun, X; Bachmann, ER. Design, implementation, and experimental results of a quaternion-based Kalman filter for human body motion tracking. IEEE Trans. Robot 2006, 22, 1216–1227.
[19]
Lefferts, EJ; Markley, FL; Shuster, MD. Kalman filtering for spacecraft attitude estimation. J. Guid 1982, 5, 417–429.
[20]
Harada, T; Mori, T; Sato, T. Development of a tiny orientation estimation device to operate under motion and magnetic disturbance. Int. J. Rob. Res 2007, 26, 547–559.
[21]
Tomé, P; Yalak, O. Improvement of orientation estimation in pedestrian navigation by compensation of magnetic disturbances. J. Navig 2008, 55, 179–190.
[22]
Foxlin, E; Harrington, M; Altshuler, Y. Miniature 6-DOF inertial system for tracking HMDs. SPIE Proc 1998, 3362, 214–228.
[23]
Mirzaei, FM; Roumeliotis, SI. A Kalman-filter-based algorithm for IMU-camera calibration: Observability analysis and performance evaluation. IEEE Trans. Robot 2008, 24, 1143–1156.
[24]
Shuster, MD. A survey of attitude representations. J. Astronaut. Sci 1993, 41, 439–517.
[25]
Isidori, A. Nonlinear Control Systems; Springer Verlag: London, UK, 1995.
[26]
Ferraris, F; Grimaldi, U; Parvis, M. Procedure for effortless in-field calibration of three-axis rate gyros and accelerometers. Sens. Mater 1995, 7, 311–330.
[27]
Gebre-Egziabher, D; Elkaim, GH; Powell, JD; Parkinson, BW. A non-linear, two-step estimation algorithm for calibrating solid-state strapdown magnetometers. Proceedings of 8th International Conference on Navigation Systems, St Petersburg, Russia, 28–30 May 2001.
[28]
Crassidis, JL; Markley, FL. Unscented filtering for spacecraft attitude estimation. J. Guid. Contr. Dynam 2003, 26, 536–542.
[29]
Sabatini, AM. Quaternion-based strap-down integration method for applications of inertial sensing to gait analysis. Med. Biol. Eng. Comput 2005, 43, 94–101.
[30]
Maybeck, PS. Stochastic Models, Estimation and Control; Academic Press: New York, NY, USA, 1982.
[31]
Markley, FL. Attitude error representations for Kalman filtering. J. Guid. Contr. Dynam 2003, 26, 311–317.
