An Invariant Observer for Earth-Velocity-Aided Attitude Heading Reference Systems

Abstract In this paper we propose an invariant nonlinear observer (i.e. a “filter”) for estimating the velocity vector and orientation of a flying rigid body, using measurements from low-cost Earth-fixed velocity, inertial and magnetic sensors. It has a nice geometric structure which respects meaningful physical symmetries of the system. It can be seen as an easier-to-tune and computationally much simpler alternative to an Extended Kalman Filter.

[1]  Frank L. Lewis,et al.  Aircraft Control and Simulation , 1992 .

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

[3]  R. P. G. Collinson,et al.  Introduction to Avionics Systems , 2003 .

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

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

[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]  P. Rouchon,et al.  A non-linear symmetry-preserving observer for velocity-aided inertial navigation , 2006, 2006 American Control Conference.

[8]  Philippe Martin,et al.  Invariant observers for attitude and heading estimation from low-cost inertial and magnetic sensors , 2007, 2007 46th IEEE Conference on Decision and Control.

[9]  Robert E. Mahony,et al.  Robust Nonlinear Fusion of Inertial and Visual Data for position, velocity and attitude estimation of UAV , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[10]  R. Mahony,et al.  Complementary filter design on the Special Euclidean group SE(3) , 2007, 2007 European Control Conference (ECC).