Attitude Estimation Using Biased Gyro and Vector Measurements With Time-Varying Reference Vectors

We present two results on attitude estimation using vector and rate gyro measurements. The first result concerns an observer previously presented by Hamel, Mahony, and Pflimlin, with proven stability results when i) the reference vectors are stationary; or ii) the gyro measurements are unbiased. We prove semiglobal stability without either of these assumptions when a parameter projection is added, and convergence from all initial attitudes when using a resetting strategy. The second result is an algorithm for estimation of bias in the body-fixed vector measurements, which is analyzed in combination with the attitude and gyro bias observer.

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

[2]  Yuan Wang,et al.  Stabilization in spite of matched unmodeled dynamics and an equivalent definition of input-to-state stability , 1996, Math. Control. Signals Syst..

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

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

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

[6]  Tor Arne Johansen,et al.  Parameter estimation and compensation in systems with nonlinearly parameterized perturbations , 2010, Autom..

[7]  G. Wahba.  A Least Squares Estimate of Satellite Attitude , 1965 .

[8]  Zhong-Ping Jiang,et al.  A small-gain control method for nonlinear cascaded systems with dynamic uncertainties , 1997, IEEE Trans. Autom. Control..

[9]  Tor Arne Johansen,et al.  Attitude Estimation Based on Time-Varying Reference Vectors with Biased Gyro and Vector Measurements , 2011 .

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

[11]  Thor I. Fossen,et al.  Handbook of Marine Craft Hydrodynamics and Motion Control , 2011 .

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

[13]  Malcolm D. Shuster,et al.  Attitude-Independent Magnetometer-Bias Determination: A Survey , 2002 .

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

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

[16]  Prashanth Krishnamurthy,et al.  Dynamic high-gain scaling: State and output feedback with application to systems with ISS appended dynamics driven by all States , 2004, IEEE Transactions on Automatic Control.

[17]  David Angeli,et al.  Nonlinear norm-observability notions and stability of switched systems , 2005, IEEE Transactions on Automatic Control.

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

[19]  Zhong-Ping Jiang,et al.  Small-gain theorem for ISS systems and applications , 1994, Math. Control. Signals Syst..

[20]  Karl Johan Åström,et al.  Adaptive Control (2 ed.) , 1995 .

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

[22]  Zhong-Ping Jiang,et al.  A Lyapunov formulation of the nonlinear small-gain theorem for interconnected ISS systems , 1996, Autom..

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

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

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

[26]  Thor I. Fossen,et al.  Handbook of Marine Craft Hydrodynamics and Motion Control: Fossen/Handbook of Marine Craft Hydrodynamics and Motion Control , 2011 .

[27]  Antoine Chaillet,et al.  Quantised control of nonlinear systems: analysis of robustness to parameter uncertainty, measurement errors, and exogenous disturbances , 2010, Int. J. Control.

[28]  Hyungbo Shim,et al.  Quasi-ISS reduced-order observers and quantized output feedback , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

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

[30]  Marco F. Huber.  Optimal Pruning for Multi-Step Sensor Scheduling , 2012, IEEE Transactions on Automatic Control.

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

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

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

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

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

[36]  Zhong-Ping Jiang,et al.  A generalization of the nonlinear small-gain theorem for large-scale complex systems , 2008, 2008 7th World Congress on Intelligent Control and Automation.

[37]  Zhong-Ping Jiang,et al.  A combined backstepping and small-gain approach to adaptive output feedback control , 1999, Autom..

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

[39]  Lorenzo Marconi,et al.  About the Existence of Locally Lipschitz Output Feedback Stabilizers for Nonlinear Systems , 2009, SIAM J. Control. Optim..

[40]  Miroslav Krstic,et al.  Nonlinear and adaptive control de-sign , 1995 .