Extended Kalman Filter-based Attitude Estimation using Magnetometer- and Sun Sensor-Aided MEMS Gyros

An attitude estimation algorithm is developed using an adaptive extended Kalman filter for low-cost microelectromechanical-system (MEMS) triaxial accelerometers and gyroscopes, that is, inertial measurement units (IMUs). Although these MEMS sensors are relatively cheap, they give more inaccurate measurements than conventional high-quality gyroscopes and accelerometers. To be able to use these low-cost MEMS sensors with precision in all situations, a novel attitude estimation algorithm is proposed for fusing triaxial gyroscope and accelerometer measurements. An extended Kalman filter is implemented to estimate attitude in direction cosine matrix (DCM) formation and to calibrate gyroscope biases online. We use a variable measurement covariance for acceleration measurements to ensure robustness against temporary nongravitational accelerations, which usually induce errors when estimating attitude with ordinary algorithms. The proposed algorithm enables accurate gyroscope online calibration by using only a triaxial gyroscope and accelerometer. It outperforms comparable state-of-the-art algorithms in those cases when there are either biases in the gyroscope measurements or large temporary nongravitational accelerations present. A low-cost, temperature-based calibration method is also discussed for initially calibrating gyroscope and acceleration sensors. An open source implementation of the algorithm is also available.

Download Full-text

Attitude Estimation Using Kalman Filtering: External Acceleration Compensation Considerations

Journal of Sensors ◽

10.1155/2016/6943040 ◽

2016 ◽

Vol 2016 ◽

pp. 1-24 ◽

Cited By ~ 5

Author(s):

Romy Budhi Widodo ◽

Chikamune Wada

Keyword(s):

Kalman Filter ◽

Extended Kalman Filter ◽

Attitude Estimation ◽

Estimation Accuracy ◽

Compensation Model ◽

Measurement Noise Covariance ◽

Noise Covariance ◽

The One ◽

The Right ◽

External Acceleration

Attitude estimation is often inaccurate during highly dynamic motion due to the external acceleration. This paper proposes extended Kalman filter-based attitude estimation using a new algorithm to overcome the external acceleration. This algorithm is based on an external acceleration compensation model to be used as a modifying parameter in adjusting the measurement noise covariance matrix of the extended Kalman filter. The experiment was conducted to verify the estimation accuracy, that is, one-axis and multiple axes sensor movement. Five approaches were used to test the estimation of the attitude: (1) the KF-based model without compensating for external acceleration, (2) the proposed KF-based model which employs the external acceleration compensation model, (3) the two-step KF using weighted-based switching approach, (4) the KF-based model which uses thethreshold-basedapproach, and (5) the KF-based model which uses the threshold-based approach combined with a softened part approach. The proposed algorithm showed high effectiveness during the one-axis test. When the testing conditions employed multiple axes, the estimation accuracy increased using the proposed approach and exhibited external acceleration rejection at the right timing. The proposed algorithm has fewer parameters that need to be set at the expense of the sharpness of signal edge transition.

Download Full-text