A non-linear observer for attitude estimation of a fixed-wing unmanned aerial vehicle without GPS measurements

In this paper we propose a simple non-linear observer for attitude estimation based only on output from a typical inertial measurement unit (IMU) and dynamic pressure sensor embarked on a low-cost unmanned aerial vehicle. In particular, we aim to provide a good quality attitude estimate in the absence of global positioning system (GPS) ground truth and with potential low-frequency bias and high-frequency noise in the IMU sensor measurements. In addition, the case where the IMU only provides gyrometer and accelerometer outputs is considered; that is, there is no magnetometer output or it cannot be used due to local magnetic disturbances such as are common on a vehicle with electric motors. The proposed observer uses a simple centripetal force model (based on gyrometer and dynamic pressure measurements), augmented by a first-order dynamic model for angle of attack, to estimate non-inertial components of the acceleration. This estimate is used to correct the accelerometer output to provide a low-frequency estimate of the gravitational direction. This inertial direction, along with the gyrometer output, is then used to drive a fully non-linear attitude observer posed on the orthogonal group of rotation matrices SO(3). The observer is augmented with an integral state that ensures compensation of gyrometer bias. The resulting observer is simple to implement and fully non-linear. Experimental results are provided on a real-world data set and the performance of the filter is evaluated against the output from a full GPS/inertial navigation system (INS) that was available for the data set.

[1]  Peter Corke.  An Inertial and Visual Sensing System for a Small Autonomous Helicopter , 2004, J. Field Robotics.

[2]  Philippe Martin,et al.  An Invariant Observer for Earth-Velocity-Aided Attitude Heading Reference Systems , 2008 .

[3]  T. Hamel,et al.  Complementary filter design on the special orthogonal group SO(3) , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[4]  P. Rouchon,et al.  A non-linear symmetry-preserving observer for velocity-aided inertial navigation , 2006, 2006 American Control Conference.

[5]  Philippe Martin,et al.  Non-Linear Symmetry-Preserving Observers on Lie Groups , 2007, IEEE Transactions on Automatic Control.

[6]  Philippe Martin,et al.  Non-linear observer on Lie Groups for left-invariant dynamics with right-left equivariant output , 2008 .

[7]  Yanhua Zhang,et al.  Adaptive filter for a miniature MEMS based attitude and heading reference system , 2004, PLANS 2004. Position Location and Navigation Symposium (IEEE Cat. No.04CH37556).

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

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

[10]  Jonghyuk Kim,et al.  Autonomous Navigation for Airborne Applications , 2004 .

[11]  A.-J. Baerveldt,et al.  A low-cost and low-weight attitude estimation system for an autonomous helicopter , 1997, Proceedings of IEEE International Conference on Intelligent Engineering Systems.

[12]  Robert M. Sanner,et al.  A coupled nonlinear spacecraft attitude controller and observer with an unknown constant gyro bias and gyro noise , 2003, IEEE Trans. Autom. Control..

[13]  F. Markley,et al.  Nonlinear Attitude Filtering Methods , 2005 .

[14]  Tarek Hamel,et al.  Robust Nonlinear Observers for Attitude Estimation of Mini UAVs , 2007 .

[15]  S. Salcudean.  A globally convergent angular velocity observer for rigid body motion , 1991 .

[16]  R.C. Hayward,et al.  Design of multi-sensor attitude determination systems , 2004, IEEE Transactions on Aerospace and Electronic Systems.

[17]  Philippe Martin,et al.  Invariant observers for attitude and heading estimation from low-cost inertial and magnetic sensors , 2007, 2007 46th IEEE Conference on Decision and Control.

[18]  Frank L. Lewis,et al.  Aircraft Control and Simulation , 1992 .

[19]  王永泉,et al.  Adaptive filter for a miniature MEMS based attitude and heading reference system , 2006 .

[20]  Robert E. Mahony,et al.  Gradient-Like Observers for Invariant Dynamics on a Lie Group , 2008, IEEE Transactions on Automatic Control.

[21]  Gaurav S. Sukhatme,et al.  State estimation of an autonomous helicopter using Kalman filtering , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[22]  Peter I. Corke,et al.  Low-cost flight control system for a small autonomous helicopter , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[23]  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..

[24]  Gaurav S. Sukhatme,et al.  A tale of two helicopters , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).