Attitude estimation for UAV using extended Kalman filter

A novel attitude estimation algorithm is proposed for unmanned aerial vehicles(UAV) in this paper. It uses attitude quaternion to represent the attitude of UAV, and uses extended Kalman filter(EKF) to fuse the merits of magnetic, angular rate, and gravity(MARG) sensors. First, attitude quaternion and drift bias of gyroscope are selected to construct the state vector, and the state equation is established based on the kinematics model of gyroscope. Then, an orthogonalization method is utilized to obtain the unit attitude quaternion from the outputs of accelerometer and magnetometer, it makes the magnetic field vector perpendicular to the measured gravity vector, which avoids the geomagnetic disturbance. And the unit attitude quaternion is used for the measurements for the EKF. Finally, the EKF update equation is used to determine the attitude of UAV. Experiments are provided on a real-world data set and the results show that the algorithm can precisely represents the orientation of UAV in both static and dynamic situation.

[1]  Farrokh Ayazi,et al.  Micromachined inertial sensors , 1998, Proc. IEEE.

[2]  R. Farrenkopf.  Analytic Steady-State Accuracy Solutions for Two Common Spacecraft Attitude Estimators , 1978 .

[3]  Hassen Fourati,et al.  Fast Complementary Filter for Attitude Estimation Using Low-Cost MARG Sensors , 2016, IEEE Sensors Journal.

[4]  Robert B. McGhee,et al.  An extended Kalman filter for quaternion-based orientation estimation using MARG sensors , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[5]  A. Makni,et al.  Energy-Aware Adaptive Attitude Estimation Under External Acceleration for Pedestrian Navigation , 2016, IEEE/ASME Transactions on Mechatronics.

[6]  Huei Peng,et al.  Robust Vehicle Sideslip Angle Estimation Through a Disturbance Rejection Filter That Integrates a Magnetometer With GPS , 2014, IEEE Transactions on Intelligent Transportation Systems.

[7]  Wang Tianmiao,et al.  Attitude estimation for small helicopter using extended kalman filter , 2008, 2008 IEEE Conference on Robotics, Automation and Mechatronics.

[8]  Sebastian Madgwick,et al.  Estimation of IMU and MARG orientation using a gradient descent algorithm , 2011, 2011 IEEE International Conference on Rehabilitation Robotics.

[9]  Ramasamy Kannan.  Orientation Estimation Based on LKF Using Differential State Equation , 2015, IEEE Sensors Journal.

[10]  G. Schmidt,et al.  Inertial sensor technology trends , 2001 .

[11]  Jizhong Xiao,et al.  Keeping a Good Attitude: A Quaternion-Based Orientation Filter for IMUs and MARGs , 2015, Sensors.

[12]  F. Markley,et al.  Fast Quaternion Attitude Estimation from Two Vector Measurements , 2002 .

[13]  Chang Liu,et al.  An improved quaternion Gauss–Newton algorithm for attitude determination using magnetometer and accelerometer , 2014 .

[14]  Sreenatha G. Anavatti,et al.  UAV Linear and Nonlinear Estimation Using Extended Kalman Filter , 2006, 2006 International Conference on Computational Inteligence for Modelling Control and Automation and International Conference on Intelligent Agents Web Technologies and International Commerce (CIMCA'06).

[15]  Jung Soon Jang,et al.  Small UAV Automation Using MEMS , 2007, IEEE Aerospace and Electronic Systems Magazine.

[16]  F. Daum.  Nonlinear filters: beyond the Kalman filter , 2005, IEEE Aerospace and Electronic Systems Magazine.

[17]  Robert E. Mahony,et al.  Nonlinear Complementary Filters on the Special Orthogonal Group , 2008, IEEE Transactions on Automatic Control.

[18]  G. Wahba.  A Least Squares Estimate of Satellite Attitude , 1965 .

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

[20]  Tarek Hamel,et al.  Attitude and gyro bias estimation for a VTOL UAV , 2006 .

[21]  Robert E. Mahony,et al.  Attitude estimation on SO[3] based on direct inertial measurements , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[22]  B. Kemp,et al.  Body position can be monitored in 3D using miniature accelerometers and earth-magnetic field sensors. , 1998, Electroencephalography and clinical neurophysiology.

[23]  Tianmiao Wang,et al.  Attitude estimation for small helicopter using extended kalman filter , 2008, RAM.

[24]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[25]  Robert J. Wood,et al.  Science, technology and the future of small autonomous drones , 2015, Nature.

[26]  Peter I. Corke,et al.  Multirotor Aerial Vehicles: Modeling, Estimation, and Control of Quadrotor , 2012, IEEE Robotics & Automation Magazine.