A fault tolerant state estimation framework with application to UGV navigation in complex terrain

In this paper a fault tolerant state estimation (FTSE) framework is developed for reliable navigation. The framework features kinematic state estimation using Bayesian filtering of sensor measurements, and sensor fault detection and isolation. Another development is an uncoupled fusion architecture that allows the system state to be updated by asynchronous sensors, makes the system easily scalable and allows the system to degenerate gracefully during one or more sensor outage. A novel procedure to incorporate relative measurements, such as relative pose from stereo sensors, into the Bayesian filtering framework is also developed. In addition, a novel kinematic state transition model is developed that exploits the dynamics of UGV, provides a coupled linear and angular motion model and avoids over-fitting of measurement data. The FTSE system's performance is demonstrated based on results from processing real data.

[1]  Youmin Zhang,et al.  Bibliographical review on reconfigurable fault-tolerant control systems , 2003, Annu. Rev. Control..

[2]  Hugh F. Durrant-Whyte,et al.  Decentralized Architecture for Asynchronous Sensors , 1999, Auton. Robots.

[3]  J. Stuelpnagel.  On the Parametrization of the Three-Dimensional Rotation Group , 1964 .

[4]  F. H. Schlee,et al.  Use of an external cascade Kalman filter to improve the performance of a Global Positioning System (GPS) inertial navigator , 1988, Proceedings of the IEEE 1988 National Aerospace and Electronics Conference.

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

[6]  Takashi Tsubouchi,et al.  Outdoor navigation of a mobile robot between buildings based on DGPS and odometry data fusion , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[7]  Niels Kjølstad Poulsen,et al.  Derivative free Kalman filtering used for orchard navigation , 2010, 2010 13th International Conference on Information Fusion.

[8]  Wolfram Burgard,et al.  Probabilistic Algorithms and the Interactive Museum Tour-Guide Robot Minerva , 2000, Int. J. Robotics Res..

[9]  Oliver E. Drummond,et al.  Tracklets and a hybrid fusion with process noise , 1997, Optics & Photonics.

[10]  Clark F. Olson,et al.  Rover navigation using stereo ego-motion , 2003, Robotics Auton. Syst..

[11]  Berthold K. P. Horn,et al.  Closed-form solution of absolute orientation using unit quaternions , 1987 .

[12]  Salah Sukkarieh,et al.  Real-time implementation of airborne inertial-SLAM , 2007, Robotics Auton. Syst..

[13]  Takashi Tsubouchi,et al.  Vehicle localization in outdoor woodland environments with sensor fault detection , 2008, 2008 IEEE International Conference on Robotics and Automation.

[14]  Huamin Jia.  Data fusion methodologies for multisensor aircraft navigation systems , 2004 .

[15]  Paul M. Frank,et al.  Fuzzy logic and neural network applications to fault diagnosis , 1997, Int. J. Approx. Reason..

[16]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[17]  Rama Chellappa,et al.  Performance bounds for estimating three-dimensional motion parameters from a sequence of noisy images , 1989 .

[18]  Youmin Zhang,et al.  Detection and diagnosis of sensor and actuator failures using IMM estimator , 1998 .

[19]  Markus Vincze,et al.  Fusion of Vision and Inertial Data for Motion and Structure Estimation , 2004, J. Field Robotics.

[20]  Brad Seanor,et al.  A fault tolerant flight control system for sensor and actuator failures using neural networks , 2000 .

[21]  Joseph J. LaViola,et al.  On Kalman Filtering With Nonlinear Equality Constraints , 2007, IEEE Transactions on Signal Processing.

[22]  Peter Corke,et al.  An Introduction to Inertial and Visual Sensing , 2007, Int. J. Robotics Res..

[23]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[24]  Jinling Wang,et al.  INTEGRATION OF GPS / INS / VISION SENSORS TO NAVIGATE UNMANNED AERIAL VEHICLES , 2008 .

[25]  Hugh F. Durrant-Whyte,et al.  Process models for the high-speed navigation of road vehicles , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.