Globally exponentially stable attitude and gyro bias estimation with application to GNSS/INS integration

This paper deals with the construction of nonlinear observers for navigation purposes. We first present a globally exponentially stable observer for attitude and gyro bias, based on gyro measurements and two or more pairs of vector measurements. We avoid the well-known topological obstructions to global stability by not confining the attitude estimate to SO ( 3 ) , but rather estimating a full rotation matrix with nine degrees of freedom. We also show how the attitude can be estimated under a relaxed persistency-of-excitation condition, with a single vector measurement as a special case. Next, we use the attitude observer to construct a globally exponentially stable observer for gnss/ins integration, based on accelerometer, gyro, and magnetometer measurements, as well as gnss measurements of position and (optionally) velocity. We verify the stability properties of the design using experimental data from a light fixed-wing aircraft.

[1]  A. Michel,et al.  Stability of Dynamical Systems — Continuous , Discontinuous , and Discrete Systems , 2008 .

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

[3]  Leigh McCue,et al.  Handbook of Marine Craft Hydrodynamics and Motion Control [Bookshelf] , 2016, IEEE Control Systems.

[4]  S. Bhat,et al.  A topological obstruction to continuous global stabilization of rotational motion and the unwinding phenomenon , 2000 .

[5]  Alessandro Astolfi,et al.  Stability of Dynamical Systems - Continuous, Discontinuous, and Discrete Systems (by Michel, A.N. et al.; 2008) [Bookshelf] , 2007, IEEE Control Systems.

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

[7]  M. Athans,et al.  The design of suboptimal linear time-varying systems , 1968 .

[8]  Taeyoung Lee,et al.  Global Attitude Estimation using Single Direction Measurements , 2007, 2007 American Control Conference.

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

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

[11]  Carlos Silvestre,et al.  A GES attitude observer with single vector observations , 2012, Autom..

[12]  Carlos Silvestre,et al.  Sensor-Based Globally Asymptotically Stable Filters for Attitude Estimation: Analysis, Design, and Performance Evaluation , 2012, IEEE Transactions on Automatic Control.

[13]  Carlos Silvestre,et al.  Globally exponentially stable cascade observers for attitude estimation , 2012 .

[14]  Tor Arne Johansen,et al.  A nonlinear observer for integration of GNSS and IMU measurements with gyro bias estimation , 2012, 2012 American Control Conference (ACC).

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

[16]  Chuck Bye,et al.  GPS / INS Integration , 2005 .

[17]  Tor Arne Johansen,et al.  Observers for cascaded nonlinear and linear systems , 2011, IEEE Conference on Decision and Control and European Control Conference.

[18]  Carlos Silvestre,et al.  GES Attitude Observers – Part II: Single Vector Observations , 2011 .

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

[20]  D. Mayne.  Nonlinear and Adaptive Control Design [Book Review] , 1996, IEEE Transactions on Automatic Control.

[21]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .

[22]  Peter S. Maybeck,et al.  Stochastic Models, Estimation And Control , 2012 .

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

[24]  Michael Cramer.  GPS / INS Integration , 1997 .

[25]  Minh-Duc Hua.  Attitude estimation for accelerated vehicles using GPS/INS measurements , 2010 .

[26]  Robert E. Mahony,et al.  Nonlinear attitude observers on SO(3) for complementary and compatible measurements: A theoretical study , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[27]  Carlos Silvestre,et al.  GES Attitude Observers – Part I: Multiple General Vector Observations , 2011 .

[28]  J. Vasconcelos,et al.  A Nonlinear Observer for Rigid Body Attitude Estimation using Vector Observations , 2008 .

[29]  Louis L. Whitcomb,et al.  Adaptive Identification on the Group of Rigid-Body Rotations and its Application to Underwater Vehicle Navigation , 2007, IEEE Trans. Robotics.

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

[31]  Tor Arne Johansen,et al.  Observers for interconnected nonlinear and linear systems , 2012, Autom..

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