Quaternion-based robust extended Kalman filter for attitude estimation of micro quadrotors using low-cost MEMS

In this paper, a quaternion-based robust extended Kalman filter (EKF) is developed for the attitude estimation of micro quadrotors. Since the raw data of low-cost MEMS is sensitive to the environmental conditions, the attitude estimation method is developed to minimize the influence of outlier and to estimate the bias effectively. In order to overcome the singularity of certain orientation, the quaternion is involved in the filter parameter. A cortex-M4 based micro quadrotor is developed to implement the proposed quaternion-based robust extended Kalman filter, and simulation results show good estimation accuracy and satisfactory real-time performance.

[1]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[2]  Cao Yonghong.  Kalman Filtering of Attitude Measurement with Magnetometer and Gyroscope , 2011 .

[3]  F. Markley,et al.  Unscented Filtering for Spacecraft Attitude Estimation , 2003 .

[4]  D. Powell,et al.  Land-vehicle navigation using GPS , 1999, Proc. IEEE.

[5]  Angelo M. Sabatini,et al.  Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing , 2006, IEEE Transactions on Biomedical Engineering.

[6]  Emil Fresk,et al.  Full quaternion based attitude control for a quadrotor , 2013, 2013 European Control Conference (ECC).

[7]  Vijay Kumar,et al.  Design of small, safe and robust quadrotor swarms , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[8]  Yuanxi Yang,et al.  Robust Kalman filter for rank deficient observation models , 1998 .

[9]  M. J. Caruso,et al.  Applications of magnetic sensors for low cost compass systems , 2000, IEEE 2000. Position Location and Navigation Symposium (Cat. No.00CH37062).

[10]  Wenqi Wu,et al.  Robust Kalman filtering for attitude estimation using low-cost MEMS-based sensors , 2014, Proceedings of 2014 IEEE Chinese Guidance, Navigation and Control Conference.

[11]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[12]  Ludwik Kurz,et al.  An adaptive robustizing approach to kalman filtering , 1983, Autom..