Building a robust integrity monitoring algorithm for a low cost GPS-aided-INS system

In this paper, the integrity of low cost GPS/INS systems is investigated to ensure the ability to obtain continuous high-integrity, high-accuracy vehicle state estimate under low-computational system requirement. The utilization of two fault detection and identification (FDI) techniques, the χ2 (or sometimes referred to as chi-squared) gating function and the multiple model adaptive estimation (MMAE), is proposed to monitor the integrity of GPS measurements. A fault in GPS measurements is modeled with an increase in GPS measurements noise covariance matrix which may result from mistuning of filter’s noise parameters, interference, jamming, or multipath errors. These types of faults are covered by this work and are assumed to last for unconstrained period of time. ξ2 FDI systems are computationally very inexpensive, have good fault detection ability and require no a priori knowledge on system dynamics. However, they are sensitive to filter tuning and fail to detect faults when the filter converges to them rather than rejecting them. Model-based approaches provide outstanding FDI ability. However, they are computationally demanding, require a priori knowledge on system model, sensitive to mismodeling errors, have finite convergence time, and compromise filter optimality under no-failure conditions. The proposed fusion algorithm guarantees integrity and does not affect filter’s optimality under no-failure conditions. Simulated and experimental tests were conducted to verify the accuracy of the proposed techniques. Results are presented at the end of the paper to highlight the performance characteristics of the proposed FDI system implementation.

[1]  Jyh-Ching Juang,et al.  On GPS positioning and integrity monitoring , 2000, IEEE Trans. Aerosp. Electron. Syst..

[2]  Qingsong Yang,et al.  MODEL-BASED AND DATA DRIVEN FAULT DIAGNOSIS METHODS WITH APPLICATIONS TO PROCESS MONITORING , 2004 .

[3]  S. Sukkarieh,et al.  Camera Aided Inertial Navigation in Poor GPS Environments , 2007, 2007 IEEE Aerospace Conference.

[4]  Elliott D. Kaplan Understanding GPS : principles and applications , 1996 .

[5]  Peter S. Maybeck,et al.  Performance enhancement of a multiple model adaptive estimator , 1995 .

[6]  Mamoun F. Abdel-Hafez,et al.  The Autocovariance Least-Squares Technique for GPS Measurement Noise Estimation , 2010, IEEE Transactions on Vehicular Technology.

[7]  Ching-Fang Lin,et al.  Sensor failure detection with a bank of Kalman filters , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[8]  Hugh F. Durrant-Whyte,et al.  A high integrity IMU/GPS navigation loop for autonomous land vehicle applications , 1999, IEEE Trans. Robotics Autom..

[9]  P. Savage A Unified Mathematical Framework for Strapdown Algorithm Design , 2006 .

[10]  Amir Averbuch,et al.  Interacting Multiple Model Methods in Target Tracking: A Survey , 1988 .

[11]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[12]  Y. Bar-Shalom,et al.  Tracking a maneuvering target using input estimation versus the interacting multiple model algorithm , 1989 .

[13]  Hugh F. Durrant-Whyte,et al.  High-integrity navigation: a frequency-domain approach , 2000, IEEE Trans. Control. Syst. Technol..

[14]  Gaurav S. Sukhatme,et al.  Fault detection and identification in a mobile robot using multiple model estimation and neural network , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[15]  Alan S. Willsky,et al.  A survey of design methods for failure detection in dynamic systems , 1976, Autom..

[16]  Sangkyung Sung,et al.  Performance Improvement of the Wald Test for GPS RTK with the Assistance of INS , 2008 .

[17]  Gaurav S. Sukhatme,et al.  Sensor fault detection and identification in a mobile robot , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[18]  Raman K. Mehra,et al.  Failure detection and identification and fault tolerant control using the IMM-KF with applications to the Eagle-Eye UAV , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[19]  Gaurav S. Sukhatme,et al.  Fault detection and identification in a mobile robot using multiple-model estimation , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[20]  Ke Zhang,et al.  Adaptive Observer-based Fast Fault Estimation , 2008 .

[21]  A. Willsky,et al.  A generalized likelihood ratio approach to state estimation in linear systems subjects to abrupt changes , 1974, CDC 1974.

[22]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[23]  P K Houpt,et al.  Dynamic model-based techniques for the detection of incidents on freeways , 1980 .

[24]  J. R. Vasquez,et al.  Enhanced motion and sizing of bank in moving-bank MMAE , 2004 .

[25]  Peter S. Maybeck,et al.  Density algorithm based moving-bank MMAE , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[26]  Peter S. Maybeck,et al.  Characterization of Kalman filter residuals in the presence of mismodeling , 2000, IEEE Trans. Aerosp. Electron. Syst..

[27]  Washington Y. Ochieng,et al.  Failure Modes and Models for Integrated GPS/INS Systems , 2007, Journal of Navigation.

[28]  Joseph R. Cavallaro,et al.  A survey of NASA and military standards on fault tolerance and reliability applied to robotics , 1994 .

[29]  Jason L. Speyer,et al.  GPS Measurement Noise Estimation in Non-Ideal Environments , 2008 .

[30]  Alison Brown,et al.  Testing of Ultra-Tightly-Coupled GPS Operation Using a Precision GPS/Inertial Simulator , 2005 .

[31]  S. Qin,et al.  Active Fault-Tolerant Control for a Class of Nonlinear Systems with Sensor Faults , 2008 .