Quaternion-Based Extended Kalman Filter for Determining Orientation by Inertial and Magnetic Sensing

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…