Exponential convergence of a nonlinear attitude estimator

A nonlinear attitude estimator is presented. The estimator uses a minimum of two vector measurements and a rate-gyro to estimate the attitude and the rate-gyro bias. The estimator can be implemented using a low-cost inertial measurement unit such as those typically used on inexpensive aerial vehicles. Estimator design is based on an alternate attitude error function that yields an estimator with faster convergence properties than similar estimators previously considered in the literature. A proof of exponential stability about the desired equilibrium point is provided. Simulation and experimental results demonstrate the desirable properties of the proposed estimator.

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

[2]  F. Markley.  Attitude determination using vector observations and the singular value decomposition , 1988 .

[3]  Giancarlo Troni,et al.  Magnetometer bias calibration based on relative angular position: Theory and experimental comparative evaluation , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Dena Firoozi,et al.  Noise analysis in satellite attitude estimation using angular rate and a single vector measurement , 2011, IEEE Conference on Decision and Control and European Control Conference.

[5]  James Richard Forbes,et al.  A nonlinear attitude estimator with desirable convergence properties , 2015, 2015 European Control Conference (ECC).

[6]  A. D. Lewis,et al.  Geometric Control of Mechanical Systems , 2004, IEEE Transactions on Automatic Control.

[7]  Edwin Olson,et al.  AprilTag: A robust and flexible visual fiducial system , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[9]  Tarek Hamel,et al.  A coupled estimation and control analysis for attitude stabilisation of mini aerial vehicles , 2006 .

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

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

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

[13]  Kenneth Jensen.  Generalized Nonlinear Complementary Attitude Filter , 2011 .

[14]  P. Hughes.  Spacecraft Attitude Dynamics , 1986 .

[15]  Taeyoung Lee,et al.  Exponential stability of an attitude tracking control system on SO(3) for large-angle rotational maneuvers , 2012, Syst. Control. Lett..

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

[17]  Taeyoung Lee,et al.  Global optimal attitude estimation using uncertainty ellipsoids , 2006, Syst. Control. Lett..

[18]  Tor Arne Johansen,et al.  Attitude Estimation Using Biased Gyro and Vector Measurements With Time-Varying Reference Vectors , 2012, IEEE Transactions on Automatic Control.

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

[20]  David Hecker,et al.  Elementary Linear Algebra , 1993 .

[21]  John L. Crassidis,et al.  Fundamentals of Spacecraft Attitude Determination and Control , 2014 .

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

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

[24]  Alireza Khosravian,et al.  Rigid Body Attitude Control Using a Single Vector Measurement and Gyro , 2012, IEEE Transactions on Automatic Control.

[25]  Vineet R. Kamat,et al.  Plane Registration Leveraged by Global Constraints for Context‐Aware AEC Applications , 2013, Comput. Aided Civ. Infrastructure Eng..

[26]  Dena Firoozi,et al.  Analysis of gyro noise in non-linear attitude estimation using a single vector measurement , 2012 .