Accurate state estimation using low-cost MEMS (Micro Electro- Mechanical Systems) sensors present on Commercial-off-the-shelf (COTS) drones is a challenging problem. Most UAV systems use a combination of a gyroscope, an accelerometer, and a magnetometer to obtain measurements and estimate attitude. Under this paradigm of sensor fusion, the Extended Kalman Filter (EKF) is the most popular algorithm for attitude estimation in UAVs. In this work, we propose a novel estimation technique called extended H2 filter that can overcome the limitations of the EKF, specifically with respect to computational speed, memory usage, and root mean squared error. We formulate our attitude-estimation algorithm using unit quaternions. The H2 optimal filter gain is designed offline about a nominal operating point by solving a convex optimization problem, and the filter dynamics is implemented using the nonlinear system dynamics. This implementation of this H2 optimal estimator is referred as the extended H2 estimator. The proposed technique is tested on four cases corresponding to long time-scale motion, fast time-scale motion, transition from hover to forward flight for VTOL aircrafts, and an entire flight cycle (from take-off to landing). Its results are compared against that of the EKF in terms of the aforementioned performance metrics.
On Fast Attitude Filtering Using Matrix Fisher Distributions with Stability Guarantee as an Observer
School of Astronautics, Shenyuan Honors College, Beihang University(北京航空航天大学宇航学院、深空探测学院);School of Astronautics and the MOE Key Laboratory of Spacecraft Design, Optimization and Dynamic Simulation, Beihang University(北京航空航天大学宇航学院、航天器设计与优化动态仿真教育部重点实验室);School of Astronautics, Beihang University(北京航空航天大学宇航学院)
Complementary Filtering on SO(3) for Attitude Estimation with Scalar Measurements
I3S, CNRS, Université Côte d’Azur(法国国家科学研究中心蔚蓝海岸大学I3S实验室);Institut Universitaire de France(法国大学研究院);Department of Computer Science and Engineering, Université du Québec en Outaouais (UQO)(魁北克大学乌塔韦校区计算机科学与工程系)