In this paper a quaternion-based Variable-State-Dimension Extended Kalman Filter (VSD-EKF) is developed for estimating the three-dimensional orientation of a rigid body using the measurements from an Inertial Measurement Unit (IMU) integrated with a triaxial magnetic sensor. Gyro bias and magnetic disturbances are modeled and compensated by including them in the filter state vector. The VSD-EKF switches between a quiescent EKF, where the magnetic disturbance is modeled as a first-order Gauss-Markov stochastic process (GM-1), and a higher-order EKF where extra state components are introduced to model the time-rate of change of the magnetic field as a GM-1 stochastic process, namely the magnetic disturbance is modeled as a second-order Gauss-Markov stochastic process (GM-2). Experimental validation tests show the effectiveness of the VSD-EKF, as compared to either the quiescent EKF or the higher-order EKF when they run separately.
References
[1]
Foxlin, E. Motion Tracking Requirements and Technologies. In Handbook of Virtual Environments: Design, Implementation, and Applications; Stanney, K.M., Ed.; Lawrence Erlbaum Associates: Mahwah, NJ, USA, 2002; pp. 163–210.
[2]
Roetenberg, D.; Luinge, H.J.; Baten, C.T.M.; Veltink, P.H. Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation. IEEE Trans. Neural Syst. Rehabil. Eng. 2005, 13, 395–405.
[3]
Foxlin, E. Pedestrian tracking with shoe-mounted inertial sensors. IEEE Comput. Graph. Appl. 2005, 25, 38–46.
[4]
Welch, G.F.; Foxlin, E. Motion tracking: No silver bullet, but a respectable arsenal. IEEE Comput. Graph. Appl. 2002, 22, 24–38.
[5]
Sabatini, A.M. Inertial Sensing in Biomechanics: A Survey of Computational Techniques Bridging Motion Analysis and Personal Navigation. In Computational Intelligence for Movement Sciences, Neural Networks and other Emerging Techniques; Begg, R., Palaniswami, M., Eds.; IGP Idea Group Publishing: Hershey PA, USA, 2006; pp. 70–100.
[6]
Veltink, P.H.; Bussmann, H.B.J.; de Vries, W.H.K.; Martens, W.L.J.; van Lummel, R.C. Detection of static and dynamic activities using uniaxial accelerometers. IEEE Trans. Rehabil. Eng. 1996, 4, 375–385.
[7]
Bachmann, E.R.; Xiaoping, Y.; Peterson, C.W. 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.
[8]
de Vries, W.H.K.; Veeger, H.E.J.; Baten, C.T.M.; van der Helm, F.C.T. Magnetic distortion in motion labs, implications for validating inertial magnetic sensors. Gait Posture 2009, 29, 535–541.
[9]
Afzal, M.H.; Renaudin, V.; Lachapelle, G. Assessment of Indoor Magnetic Field Anomalies Using Multiple Magnetometers. Proceedings of the 23rd International Technical Meeting of The Satellite Division of the Institute of Navigation (ION GNSS 2010), Portland, OR, USA, 21–24 September 2010.
[10]
Sabatini, A.M. Estimating three-dimensional orientation of human body parts by inertial/magnetic sensing. Sensors 2011, 11, 1489–1525.
[11]
Yun, X.; Bachmann, E.R. Design, implementation, and experimental results of a quaternion-based Kalman filter for human body motion tracking. IEEE Trans. Robot. 2006, 22, 1216–1227.
[12]
Sabatini, A.M. Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing. IEEE Trans. Biomed. Eng. 2006, 53, 1346–1356.
[13]
Sabatini, A.M. Kalman-filter-based orientation determination using inertial/magnetic sensors: Observability analysis and performance evaluation. Sensors 2011, 11, 9182–9206.
[14]
Lefferts, E.J.; Markley, F.L.; Shuster, M.D. Kalman filtering for spacecraft attitude estimation. J. Guid. 1982, 5, 417–429.
[15]
Crassidis, J.L.; Markley, F.L. Unscented filtering for spacecraft attitude estimation. J. Guid. Contr. Dyn. 2003, 26, 536–542.
[16]
Tomé, P.; Yalak, O. Improvement of orientation estimation in pedestrian navigation by compensation of magnetic disturbances. J. Navig. 2008, 55, 179–190.
Shuster, M.D. A survey of attitude representations. J. Astronaut. Sci. 1993, 41, 439–517.
[19]
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.
[20]
Gebre-Egziabher, D.; Elkaim, G.H.; Powell, J.D.; Parkinson, B.W. Calibration of strapdown magnetometers in magnetic field domain. J. Aerosp. Eng. 2006, 19, 87–102.
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.
[24]
Lee, J.K.; Park, E.J. A fast quaternion-based orientation optimizer via virtual rotation for human motion tracking. IEEE Trans. Biomed. Eng. 2009, 56, 1574–1582.
[25]
Shuster, M.D.; Oh, S. Three-axis attitude determination from vector observations. J. Guid. Control 1981, 4, 70–77.
[26]
Bar-Shalom, Y.; Li, X.R.; Kirubarajan, T. Estimation with Applications to Tracking and Navigation; John Wiley & Sons: Hoboken, NJ, USA, 2001.
[27]
Maybeck, P.S. Stochastic Models, Estimation and Control; Academic Press: New York, NY, USA, 1982.
