A Double-Stage Kalman Filter for Orientation Tracking With an Integrated Processor in 9-D IMU

This paper presents an application-specific integrated processor for an angular estimation system that works with 9-D inertial measurement units. The application-specific instruction-set processor (ASIP) was implemented on field-programmable gate array and interfaced with a gyro-plus-accelerometer 6-D sensor and with a magnetic compass. Output data were recorded on a personal computer and also used to perform a live demo. During system modeling and design, it was chosen to represent angular position data with a quaternion and to use an extended Kalman filter as sensor fusion algorithm. For this purpose, a novel two-stage filter was designed: The first stage uses accelerometer data, and the second one uses magnetic compass data for angular position correction. This allows flexibility, less computational requirements, and robustness to magnetic field anomalies. The final goal of this work is to realize an upgraded application-specified integrated circuit that controls the microelectromechanical systems (MEMS) sensor and integrates the ASIP. This will allow the MEMS sensor gyro plus accelerometer and the angular estimation system to be contained in a single package; this system might optionally work with an external magnetic compass.

[1]  王永泉,et al.  Adaptive filter for a miniature MEMS based attitude and heading reference system , 2006 .

[2]  Oliver J. Woodman,et al.  An introduction to inertial navigation , 2007 .

[3]  M.F. Golnaraghi,et al.  A quaternion-based orientation estimation algorithm using an inertial measurement unit , 2004, PLANS 2004. Position Location and Navigation Symposium (IEEE Cat. No.04CH37556).

[4]  Jack B. Kuipers,et al.  Quaternions and Rotation Sequences: A Primer with Applications to Orbits, Aerospace and Virtual Reality , 2002 .

[5]  L. Vicci.  Quaternions and Rotations in 3-Space: The Algebra and its Geometric Interpretation , 2001 .

[6]  Luca Fanucci,et al.  An application specific instruction set processor for angular position estimation with inertial measurement units , 2011, 2011 IEEE SENSORS Proceedings.

[7]  Luca Fanucci,et al.  A sensor fusion algorithm for an integrated angular position estimation with inertial measurement units , 2011, 2011 Design, Automation & Test in Europe.

[8]  Robert B. McGhee,et al.  An improved quaternion-based Kalman filter for real-time tracking of rigid body orientation , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[9]  L. Fanucci,et al.  A double stage Kalman filter for sensor fusion and orientation tracking in 9D IMU , 2012, 2012 IEEE Sensors Applications Symposium Proceedings.

[10]  Jr. J.J. LaViola,et al.  A comparison of unscented and extended Kalman filtering for estimating quaternion motion , 2003, Proceedings of the 2003 American Control Conference, 2003..

[11]  Xiaoping Yun,et al.  Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion Tracking , 2006, IEEE Trans. Robotics.

[12]  Greg Welch,et al.  Welch & Bishop , An Introduction to the Kalman Filter 2 1 The Discrete Kalman Filter In 1960 , 1994 .

[13]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.