Robust Nonlinear Fusion of Inertial and Visual Data for position, velocity and attitude estimation of UAV

This paper presents a coupled observer that uses accelerometer, gyrometer and vision sensors to provide estimates of pose and linear velocity for an aerial robotic vehicle. The observer is based on a non-linear complimentary filter framework and incorporates adaptive estimates of measurement bias in gyrometers and accelerometers commonly encountered in low-cost inertial measurement systems. Asymptotic stability of the observer estimates is proved as well as bounded energy of the observer error signals. Experimental data is provided for the proposed filter run on data obtained from an experiment involving a remotely controlled helicopter.

[1]  Thor I. Fossen,et al.  A nonlinear observer for GPS and INS integration , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[2]  Tarek Hamel,et al.  Nonlinear attitude and gyroscope's bias estimation for a VTOL UAV , 2007, Int. J. Syst. Sci..

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

[4]  Salah Sukkarieh,et al.  Vehicle Model Aided Inertial Navigation For A Uav Using Low-Cost Sensors , 2004 .

[5]  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).

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

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

[8]  Jorge Dias,et al.  Vision and Inertial Sensor Cooperation Using Gravity as a Vertical Reference , 2003, IEEE Trans. Pattern Anal. Mach. Intell..

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

[10]  Tarek Hamel,et al.  Attitude and gyro bias estimation for a flying UAV , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  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).

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

[13]  Peter I. Corke.  An inertial and visual sensing system for a small autonomous helicopter , 2004 .

[14]  Rolf-Rainer Grigat,et al.  Real-time hybrid pose estimation from vision and inertial data , 2004, First Canadian Conference on Computer and Robot Vision, 2004. Proceedings..

[15]  Jorge Lobo,et al.  Integration of vision and inertial sensing , 2007 .

[16]  Markus Vincze,et al.  Multi-rate fusion with vision and inertial sensors , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[17]  Emilio Frazzoli,et al.  A Hybrid Control Architecture for Aggressive Maneuvering of Autonomous Aerial Vehicles , 2000 .