A Linear Kalman Filter for MARG Orientation Estimation Using the Algebraic Quaternion Algorithm

This paper presents a novel orientation algorithm designed to support a computationally efficient, wearable inertial human motion tracking system for rehabilitation applications. It is applicable to inertial measurement units (IMUs) consisting of tri-axis gyroscopes and accelerometers, and magnetic angular rate and gravity (MARG) sensor arrays that also include tri-axis magnetometers. The MARG implementation incorporates magnetic distortion compensation. The algorithm uses a quaternion representation, allowing accelerometer and magnetometer data to be used in an analytically derived and optimised gradient descent algorithm to compute the direction of the gyroscope measurement error as a quaternion derivative. Performance has been evaluated empirically using a commercially available orientation sensor and reference measurements of orientation obtained using an optical measurement system. Performance was also benchmarked against the propriety Kalman-based algorithm of orientation sensor. Results indicate the algorithm achieves levels of accuracy matching that of the Kalman based algorithm; < 0.8° static RMS error, < 1.7° dynamic RMS error. The implications of the low computational load and ability to operate at small sampling rates significantly reduces the hardware and power necessary for wearable inertial movement tracking, enabling the creation of lightweight, inexpensive systems capable of functioning for extended periods of time. © 2011 IEEE

In this paper, a quaternion based extended Kalman filter (EKF) is developed for determining the orientation of a rigid body from the outputs of a sensor which is configured as the integration of a tri-axis gyro and an aiding system mechanized using a tri-axis accelerometer and a tri-axis magnetometer. The suggested applications are for studies in the field of human movement. In the proposed EKF, the quaternion associated with the body rotation is included in the state vector together with the bias of the aiding system sensors. Moreover, in addition to the in-line procedure of sensor bias compensation, the measurement noise covariance matrix is adapted, to guard against the effects which body motion and temporary magnetic disturbance may have on the reliability of measurements of gravity and earth's magnetic field, respectively. By computer simulations and experimental validation with human hand orientation motion signals, improvements in the accuracy of orientation estimates are demonstrated for the proposed EKF, as compared with filter implementations where either the in-line calibration procedure, the adaptive mechanism for weighting the measurements of the aiding system sensors, or both are not implemented.