Fast Complementary Filter for Attitude Estimation Using Low-Cost MARG Sensors

Abstract

This paper proposes a novel quaternion-based attitude estimator with magnetic, angular rate, and gravity (MARG) sensor arrays. A new structure of a fixed-gain complementary filter is designed fusing related sensors. To avoid using iterative algorithms, the accelerometer-based attitude determination is transformed into a linear system. Stable solution to this system is obtained via control theory. With only one matrix multiplication, the solution can be computed. Using the increment of the solution, we design a complementary filter that fuses gyroscope and accelerometer together. The proposed filter is fast, since it is free of iteration. We name the proposed filter the fast complementary filter (FCF). To decrease significant effects of unknown magnetic distortion imposing on the magnetometer, a stepwise filtering architecture is designed. The magnetic output is fused with the estimated gravity from gyroscope and accelerometer using a second complementary filter when there is no significant magnetic distortion. Several experiments are carried out on real hardware to show the performance and some comparisons. Results show that the proposed FCF can reach the accuracy of Kalman filter. It successfully finds a balance between estimation accuracy and time consumption. Compared with iterative methods, the proposed FCF has much less convergence speed. Besides, it is shown that the magnetic distortion would not affect the estimated Euler angles.