Filtering algorithms and avionics systems for unmanned aerial vehicles

This thesis deals with theoretical and experimental results of original filtering algorithms for unmanned aerial vehicles. These filters bypass the limitations of the commonly used estimators (e.g. the Extended Kalman Filter or the particular filters), and they can be easily and efficiently implemented in a low-cost avionics system. First, we propose "generic" invariant observers, which preserve the natural symmetries of the considered physical system. These observers merge measurements from standard low-cost sensors (such as inertial and magnetic sensors, GPS or barometers) to accurately estimate the state of the vehicle (attitude and heading, velocity and position) without any knowledge of the system dynamics. They possess a large domain of convergence; they are also easy to tune and computationally very thrifty. Then, we develop "specific" observers, well-designed for a given kind of aerial vehicle, which is in our case a mini quadrotor. Based on a physical model that takes into account the rotor drag, the proposed filters estimate the quadrotor velocity only from inertial measurements. Thus, the filtering algorithm leads to a velocity-controlled vehicle. We validate this approach through autonomous flights. Finally, we present in detail the integration of the low-cost avionics system: it is made of low-cost sensors and a microcontroller, on which the previous observers have been implemented. We validate the filtering algorithms through experimental comparisons with an expensive commercial device. By doing so, we highlight the excellent quality-price ratio of the filters developped in this thesis.

[1]  Roland Siegwart,et al.  Full control of a quadrotor , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Philippe Martin,et al.  The true role of accelerometer feedback in quadrotor control , 2010, 2010 IEEE International Conference on Robotics and Automation.

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

[4]  R. Mahony,et al.  Complementary filter design on the Special Euclidean group SE(3) , 2007, 2007 European Control Conference (ECC).

[5]  L. Derafa,et al.  Dynamic Modelling and Experimental Identification of Four Rotors Helicopter Parameters , 2006, 2006 IEEE International Conference on Industrial Technology.

[6]  D.M. Dawson,et al.  Velocity control for a quad-rotor uav fly-by-camera interface , 2007, Proceedings 2007 IEEE SoutheastCon.

[7]  Farhan A. Faruqi,et al.  Extended Kalman filter synthesis for integrated global positioning/inertial navigation systems , 2000, Appl. Math. Comput..

[8]  Leonid Fridman,et al.  High‐order sliding‐mode observer for a quadrotor UAV , 2008 .

[9]  J. Farrell,et al.  The global positioning system and inertial navigation , 1999 .

[10]  Abdelhamid Tayebi,et al.  Attitude stabilization of a VTOL quadrotor aircraft , 2006, IEEE Transactions on Control Systems Technology.

[11]  Robert E. Mahony,et al.  Attitude control of rigid body dynamics from biased IMU measurements , 2007, 2007 46th IEEE Conference on Decision and Control.

[12]  Jeong-Hwa Park,et al.  FAST CALIBRATION TECHNIQUE FOR A GIMBALLED INERTIAL NAVIGATION SYSTEM , 2002 .

[13]  Fan-Ren Chang,et al.  The attitude determination algorithm using integrated GPS/INS data , 2005 .

[14]  D. H. S. Maithripala,et al.  An intrinsic observer for a class of simple mechanical systems on a Lie group , 2004, Proceedings of the 2004 American Control Conference.

[15]  G. Burstein Algebraic and geometric methods in nonlinear control theory , 1988 .

[16]  I. Bar-Itzhack,et al.  Schuler Period in LEO Satellites , 2004 .

[17]  J. Grizzle,et al.  The Extended Kalman Filter as a Local Asymptotic Observer for Nonlinear Discrete-Time Systemsy , 1995 .

[18]  Jordan M. Berg,et al.  Intrinsic Observer-Based Stabilization for Simple Mechanical Systems on Lie Groups , 2005, SIAM J. Control. Optim..

[19]  Robert C. Nelson,et al.  Flight Stability and Automatic Control , 1989 .

[20]  Robert Mahony,et al.  Modelling and control of a quad-rotor robot , 2006 .

[21]  N. Roy,et al.  Autonomous Navigation and Exploration of a Quadrotor Helicopter in GPS-denied Indoor Environments , 2009 .

[22]  Philippe Martin,et al.  The role of propeller aerodynamics in the model of a quadrotor UAV , 2009, 2009 European Control Conference (ECC).

[23]  Bijoy K. Ghosh,et al.  Pose estimation using line-based dynamic vision and inertial sensors , 2003, IEEE Trans. Autom. Control..

[24]  Yong Li,et al.  Low-cost tightly coupled GPS / INS integration based on a nonlinear Kalman filtering design , 2006 .

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

[26]  Carlos Silvestre,et al.  A Nonlinear GPS/IMU based observer for rigid body attitude and position estimation , 2008, 2008 47th IEEE Conference on Decision and Control.

[27]  Roland Siegwart,et al.  PID vs LQ control techniques applied to an indoor micro quadrotor , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[28]  Rita Cunha,et al.  Landmark based nonlinear observer for rigid body attitude and position estimation , 2007, 2007 46th IEEE Conference on Decision and Control.

[29]  John L. Crassidis Sigma-point Kalman filtering for integrated GPS and inertial navigation , 2006 .

[30]  Rogelio Lozano,et al.  Real-Time Stabilization and Tracking of a , 2004 .

[31]  Carlos Silvestre,et al.  Inertial Navigation System Aided by GPS and Selective Frequency Contents of Vector Measurements , 2005 .

[32]  F. Markley Attitude Error Representations for Kalman Filtering , 2003 .

[33]  S. Marcus Algebraic and Geometric Methods in Nonlinear Filtering , 1984 .

[34]  J. Z. Sasiadek,et al.  Fuzzy adaptive Kalman filtering for INS/GPS data fusion , 1999, Proceedings of the 2000 IEEE International Symposium on Intelligent Control. Held jointly with the 8th IEEE Mediterranean Conference on Control and Automation (Cat. No.00CH37147).

[35]  Abdelaziz Benallegue,et al.  Backstepping control with exact 2-sliding mode estimation for a quadrotor unmanned aerial vehicle , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[36]  D. Sherrington Stochastic Processes in Physics and Chemistry , 1983 .

[37]  Nicolas Petit,et al.  An Embedded System for Small-scaled Autonomous Vehicles , 2008, ICINCO-RA.

[38]  Philippe Martin,et al.  Invariant Extended Kalman Filter: theory and application to a velocity-aided attitude estimation problem , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[39]  V. Moreau,et al.  Dynamic modeling and intuitive control strategy for an "X4-flyer" , 2005, 2005 International Conference on Control and Automation.

[40]  Y. Oshman,et al.  Attitude Estimation from Vector Observations Using a Genetic-Algorithm-Embedded Quaternion Particle Filter , 2006 .

[41]  M. Shuster,et al.  Three-axis attitude determination from vector observations , 1981 .

[42]  M. Moallem,et al.  Attitude estimation and stabilization of a rigid body using low-cost sensors , 2007, 2007 46th IEEE Conference on Decision and Control.

[43]  Robert E. Mahony,et al.  A Practical Visual Servo Control for an Unmanned Aerial Vehicle , 2008, IEEE Transactions on Robotics.

[44]  Christian Lageman,et al.  State observers for invariant dynamics on a Lie group , 2008 .

[45]  J. Crassidis,et al.  Particle Filtering for Sequential Spacecraft Attitude Estimation , 2004 .

[46]  I. Bar-Itzhack,et al.  Control theoretic approach to inertial navigation systems , 1988 .

[47]  R. Lozano,et al.  Embedded control system for a four‐rotor UAV , 2007 .

[48]  Silvere Bonnabel,et al.  Left-invariant extended Kalman filter and attitude estimation , 2007, 2007 46th IEEE Conference on Decision and Control.

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

[50]  R. Lozano,et al.  Real-Time Nonlinear Embedded Control for an Autonomous Quadrotor Helicopter , 2007 .

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

[52]  Hassan K. Khalil,et al.  Singular perturbation methods in control : analysis and design , 1986 .

[53]  Robert E. Mahony,et al.  Hovering flight and vertical landing control of a VTOL Unmanned Aerial Vehicle using optical flow , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[54]  Chris Hide,et al.  Adaptive Kalman Filtering for Low-cost INS/GPS , 2002, Journal of Navigation.

[55]  Rita Cunha,et al.  A dynamic estimator on SE(3) using range-only measurements , 2008, 2008 47th IEEE Conference on Decision and Control.

[56]  P. Groves Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

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

[58]  R. P. G. Collinson,et al.  Introduction to Avionics Systems , 2003 .

[59]  Steven L. Waslander,et al.  The Stanford testbed of autonomous rotorcraft for multi agent control (STARMAC) , 2004, The 23rd Digital Avionics Systems Conference (IEEE Cat. No.04CH37576).

[60]  Daniel Choukroun,et al.  Adaptive Optimal-REQUEST Algorithm for Attitude Determination , 2007 .

[61]  Willem H. Steyn,et al.  Kalman filter configurations for a low-cost loosely integrated inertial navigation system on an airship , 2008 .

[62]  John L. Crassidis,et al.  Survey of nonlinear attitude estimation methods , 2007 .