An improved quaternion-based Kalman filter for real-time tracking of rigid body orientation

This paper presents an improved Kalman filter for real-time tracking of human body motions. An earlier version of the filter was presented at IROS 2001. Since then, the filter has been substantially improved. Real-time tracking of rigid body orientation is accomplished using the MARG (magnetic, angular rate, and gravity) sensors. A MARG sensor measures the three-dimensional local magnetic field, three-dimensional angular rate, and three-dimensional acceleration. A Kalman filter is designed to process measurements provided by the MARG sensors, and to produce real-time orientation represented in quaternions. There are many design decisions as related to choice of state vectors, output equations, process model, etc. The filter design presented in this paper utilizes the Gauss-Newton method for parameter optimization in conjunction with Kalman filtering. The use of the Gauss-Newton method, particularly the reduced-order implementation introduced in the paper, significantly simplifies the Kalman filter design, and reduces computational requirements.