A double stage Kalman filter for sensor fusion and orientation tracking in 9D IMU
Authors:
- 1 February 2012
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- p. 1-5
Abstract
This work presents an orientation tracking system based on a double stage Kalman filter for sensor fusion in 9D IMU. The IMU is composed by a 3D gyro, a 3D accelerometer and a magnetic compass. The filter was divided into two stages to reduce algorithm complexity. Gyro data are used to first estimate the angular position, then the first stage corrects roll and pitch angles using accelerometer data. The second stage processes magnetic compass data to correct the yaw angle. One of the advantages of this kind of filter is that a magnetic anomaly does not influence roll and pitch estimation accuracy. The flexibility is also desirable, because if the magnetic compass is not available, it is simply possible to switch off the second stage of the filter. In this work an ASIP was designed to process the filter algorithm and a proof of concept on FPGA was successfully realized. In the future the ASIP will be integrated within the logic of a new 6D sensor that could be optionally interfaced with an external magnetic compass.Keywords
This publication has 7 references indexed in Scilit:
- An application specific instruction set processor for angular position estimation with inertial measurement units2011
- Attitude and Heading System based on EKF total state configuration2011
- A sensor fusion algorithm for an integrated angular position estimation with inertial measurement units2011
- A Simplified Quaternion-Based Algorithm for Orientation Estimation From Earth Gravity and Magnetic Field MeasurementsIEEE Transactions on Instrumentation and Measurement, 2008
- Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion TrackingIEEE Transactions on Robotics, 2006
- A comparison of unscented and extended Kalman filtering for estimating quaternion motion2004
- A quaternion-based unscented Kalman filter for orientation tracking2003