An extended Kalman filter for quaternion-based orientation estimation using MARG sensors

Presents an extended Kalman filter for real-time estimation of rigid body orientation using the newly developed MARG (magnetic, angular rate, and gravity) sensors. Each MARG sensor contains a three-axis magnetometer, a three-axis angular rate sensor, and a three-axis accelerometer. The filter represents rotations using quaternions rather than Euler angles, which eliminates the long-standing problem of singularities associated with attitude estimation. A process model for rigid body angular motions and angular rate measurements is defined. The process model converts angular rates into quaternion rates, which are integrated to obtain quaternions. The Gauss-Newton iteration algorithm is utilized to find the best quaternion that relates the measured accelerations and earth magnetic field in the body coordinate frame to calculated values in the earth coordinate frame. The best quaternion is used as part of the measurements for the Kalman filter. As a result of this approach, the measurement equations of the Kalman filter become linear, and the computational requirements are significantly reduced, making it possible to estimate orientation in real time. Extensive testing of the filter with synthetic data and actual sensor data proved it to be satisfactory. Test cases included the presence of large initial errors as well as high noise levels. In all cases the filter was able to converge and accurately track rotational motions.

[1]  D. Gebre-Egziabher,et al.  A gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors , 2000, IEEE 2000. Position Location and Navigation Symposium (Cat. No.00CH37062).

[2]  R. Hayward,et al.  GPS-BASED ATTITUDE FOR AIRCRAFT , .

[3]  Michael Zyda,et al.  Orientation tracking for humans and robots using inertial sensors , 1999, Proceedings 1999 IEEE International Symposium on Computational Intelligence in Robotics and Automation. CIRA'99 (Cat. No.99EX375).

[4]  J. Kuipers.  Quaternions and Rotation Sequences , 1998 .

[5]  Martin T. Hagan,et al.  Neural network design , 1995 .

[6]  Daniel Eugene Leader.  Kalman filter estimation of underwater vehicle position and attitude using Doppler velocity aided inertial motion unit , 1994 .

[7]  Joao L. Marins.  An Extended Kalman Filter for Quaternion-Based Attitude Estimation , 2000 .

[8]  Eric Michael Fuchs,et al.  Inertial head-tracking , 1993 .

[9]  Richard A. Brown,et al.  Introduction to random signals and applied kalman filtering (3rd ed , 2012 .

[10]  J. David Powell,et al.  Inertially Aided GPS Based Attitude Heading Reference System (AHRS) for General Aviation Aircraft , 1997 .

[11]  F. Raab,et al.  Magnetic Position and Orientation Tracking System , 1979, IEEE Transactions on Aerospace and Electronic Systems.

[12]  Eric Foxlin,et al.  Inertial head-tracker sensor fusion by a complementary separate-bias Kalman filter , 1996, Proceedings of the IEEE 1996 Virtual Reality Annual International Symposium.

[13]  David R. Ellison.  Real-Time Tracking and Display of Human Limb Segment Motions Using Sourceless Sensors and a Quaternion-Based Filtering Algorithm – Part I : Theory , 2001 .

[14]  Greg Welch,et al.  The HiBall Tracker: high-performance wide-area tracking for virtual and augmented environments , 1999, VRST '99.