Nonlinear Complementary Filters on the Special Orthogonal Group

This paper considers the problem of obtaining good attitude estimates from measurements obtained from typical low cost inertial measurement units. The outputs of such systems are characterized by high noise levels and time varying additive biases. We formulate the filtering problem as deterministic observer kinematics posed directly on the special orthogonal group SO (3) driven by reconstructed attitude and angular velocity measurements. Lyapunov analysis results for the proposed observers are derived that ensure almost global stability of the observer error. The approach taken leads to an observer that we term the direct complementary filter. By exploiting the geometry of the special orthogonal group a related observer, termed the passive complementary filter, is derived that decouples the gyro measurements from the reconstructed attitude in the observer inputs. Both the direct and passive filters can be extended to estimate gyro bias online. The passive filter is further developed to provide a formulation in terms of the measurement error that avoids any algebraic reconstruction of the attitude. This leads to an observer on SO(3), termed the explicit complementary filter, that requires only accelerometer and gyro outputs; is suitable for implementation on embedded hardware; and provides good attitude estimates as well as estimating the gyro biases online. The performance of the observers are demonstrated with a set of experiments performed on a robotic test-bed and a radio controlled unmanned aerial vehicle.

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

[2]  M. Zimmermann,et al.  HIGH BANDWIDTH ORIENTATION MEASUREMENT AND CONTROL BASED ON COMPLEMENTARY FILTERING , 1991 .

[3]  Xiaoming Hu,et al.  Nonlinear state estimation for rigid-body motion with low-pass sensors , 2000 .

[4]  Richard A. Brown,et al.  Introduction to random signals and applied kalman filtering (3rd ed , 2012 .

[5]  Marie-José Aldon,et al.  Mobile robot attitude estimation by fusion of inertial data , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[6]  Tarek Hamel,et al.  NONLINEAR ATTITUDE AND GYROSCOPE'S BIAS ESTIMATION FOR A VTOL UAV , 2005 .

[7]  Xiaoming Hu,et al.  Drift-free attitude estimation for accelerated rigid bodies , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

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

[9]  Julie K. Thienel,et al.  NONLINEAR OBSERVER/CONTROLLER DESIGNS FOR SPACECRAFT ATTITUDE CONTROL SYSTEMS WITH UNCALIBRATED GYROS , 2004 .

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

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

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

[13]  Salah Sukkarieh,et al.  Airborne simultaneous localisation and map building , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[14]  J. Balaram.  Kinematic observers for articulated rovers , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[15]  O. Egeland,et al.  Passivity-based adaptive attitude control of a rigid spacecraft , 1994, IEEE Trans. Autom. Control..

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

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

[18]  Wing Ng,et al.  Improving Control System Effectiveness for Ducted Fan VTOL UAVs Operating in Crosswinds , 2003 .

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

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

[21]  Guang-Fu Ma,et al.  Spacecraft attitude estimation from vector measurements using particle filter , 2005, 2005 International Conference on Machine Learning and Cybernetics.

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

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

[24]  E. J. Lefferts,et al.  Kalman Filtering for Spacecraft Attitude Estimation , 1982 .

[25]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

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

[27]  Michael Harrington,et al.  Miniature six-DOF inertial system for tracking HMDs , 1998, Defense, Security, and Sensing.

[28]  A. Tayebi,et al.  Attitude stabilization of a four-rotor aerial robot , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).

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

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

[31]  Lorenzo Marconi,et al.  Control and Observer Design for Nonlinear Finite and Infinite Dimensional Systems , 2005 .

[32]  Pierre Rouchon,et al.  On invariant observers , 2005 .

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

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

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

[36]  M. Zimmermann,et al.  High Bandwidth Orientation Measurement and Control Based on Complementary Filtering , 1991 .

[37]  M. Morari,et al.  Optimal control of piecewise affine systems: A dynamic programming approach , 2005 .

[38]  David S. Bayard.  Fast observers for spacecraft pointing control , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[39]  Hugh F. Durrant-Whyte,et al.  Inertial navigation systems for mobile robots , 1995, IEEE Trans. Robotics Autom..

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

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

[42]  Mark B. Tischler,et al.  The Micro Craft iSTAR Micro Air Vehicle: Control System Design and Testing , 2001 .

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

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