Nonlinear observer for INS aided by time-delayed GNSS measurements: Implementation and UAV experiments

A nonlinear observer structure for estimating position, velocity and attitude in a GNSS/INS system with delayed GNSS-measurements is proposed. The structure consists of an inertial measurement data buffer, a nonlinear state observer and a fast simulator. The inertial and magnetometer measurements are synchronized and delayed to coincide in time with the GNSS-measurements. The state observer will hence estimate the delayed states, and a fast simulator is employed to recover the current states using inertial measurements. The nonlinear observer is semi-global exponentially stable. The magnitude and effect of the GNSS delay is investigated, and implementation aspect of the nonlinear observer and the fast simulator are discussed. The proposed observer structure is verified by comparison to an observer without time-synchronization through use of simulations and experimental data from a UAV flight test.

[1]  F. Allgower,et al.  An EKF-based observer for nonlinear time-delay systems , 2006, 2006 American Control Conference.

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

[3]  Robert E. Mahony,et al.  Observers for invariant systems on Lie groups with biased input measurements and homogeneous outputs , 2015, Autom..

[4]  Amit Ailon,et al.  Study on the effects of time-delays on quadrotor-type helicopter dynamics , 2014, 22nd Mediterranean Conference on Control and Automation.

[5]  Chris Rizos,et al.  Latency Determination and Compensation in Real-Time Gnss/ins Integrated Navigation Systems , 2012 .

[6]  Robert E. Mahony,et al.  Velocity aided attitude estimation on SO(3) with sensor delay , 2014, 53rd IEEE Conference on Decision and Control.

[7]  Robert E. Mahony,et al.  Recursive attitude estimation in the presence of multi-rate and multi-delay vector measurements , 2015, 2015 American Control Conference (ACC).

[8]  Isaac Skog,et al.  Time Synchronization Errors in Loosely Coupled GPS-Aided Inertial Navigation Systems , 2011, IEEE Transactions on Intelligent Transportation Systems.

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

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

[11]  P. Groves.  Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems, Second Edition , 2013 .

[12]  S. Niculescu,et al.  Stability analysis of time-delay systems : A lyapunov approach , 2006 .

[13]  Randal W. Beard,et al.  Real-Time Attitude and Position Estimation for Small UAVs Using Low-Cost Sensors , 2004 .

[14]  Pedro Albertos,et al.  Predictor–observer-based control of systems with multiple input/output delays☆ , 2012 .

[15]  P. Handel,et al.  Effects of time synchronization errors in GNSS-aided INS , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[16]  Elena Panteley,et al.  Advanced Topics in Control Systems Theory , 2005 .

[17]  Gaetano Scarano,et al.  Discrete time techniques for time delay estimation , 1993, IEEE Trans. Signal Process..

[18]  A. Papachristodoulou,et al.  Constructing Lyapunov-Krasovskii functionals for linear time delay systems , 2005, Proceedings of the 2005, American Control Conference, 2005..

[19]  Bjørnar Vikand Thor I.Fossen.  A Nonlinear Observer for Integration of GPS and INS Attitude , 1999 .

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

[21]  Tor Arne Johansen,et al.  Nonlinear observer for GNSS-aided inertial navigation with quaternion-based attitude estimation , 2013, 2013 American Control Conference.

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