Sensitivity Analysis of a Tightly-Coupled GPS/INS System for Autonomous Navigation

The work presented here empirically analyzes the design of the tightly-coupled position, velocity, and attitude estimator used as a feedback signal for autonomous navigation in a large scale robot driving in urban settings. The estimator fuses GNSS/INS signals in an extended square root information filter (ESRIF), a numerically-robust implementation of an extended Kalman filter (EKF), and was used as the basis for Cornell University's 2007 DARPA Urban Challenge robot, "Skynet." A statistical sensitivity analysis is conducted on Skynet's estimator by examining the changes in its behavior as critical design elements are removed. The effects of five design elements are considered: map aiding via computer vision algorithms, inclusion of differential corrections, filter integrity monitoring, Wide Area Augmentation System (WAAS) augmentation, and inclusion of carrier phases; the effects of extensive signal blackouts are also considered. Metrics of comparison include the statistical differences between the full solution and variant; the Kullback-Leibler divergence; and the average and standard deviation of the position errors, attitude errors, and filter update discontinuities.

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

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

[3]  I. Miller,et al.  Particle filtering for map-aided localization in sparse GPS environments , 2008, 2008 IEEE International Conference on Robotics and Automation.

[4]  Sean Ryan,et al.  ALEXIS Spacecraft Attitude Reconstruction with Thermal/Flexible Motions Due to Launch Damage , 1997 .

[5]  Bruno M. Scherzinger,et al.  Precise Robust Positioning with Inertial/GPS RTK , 2000 .

[6]  P. Savage Strapdown Inertial Navigation Integration Algorithm Design Part 1: Attitude Algorithms , 1998 .

[7]  Sebastian Thrun,et al.  Stanley: The robot that won the DARPA Grand Challenge , 2006, J. Field Robotics.

[8]  Luke Fletcher,et al.  The MIT - Cornell Collision and Why It Happened , 2009, The DARPA Urban Challenge.

[9]  Elizabeth Cannon,et al.  Map-Aided GPS Navigation: Linking Vehicles and Maps to Support Location-Based Services , 2005 .

[10]  Shuzhi Sam Ge,et al.  Autonomous vehicle positioning with GPS in urban canyon environments , 2001, IEEE Trans. Robotics Autom..

[11]  T. W. Anderson An Introduction to Multivariate Statistical Analysis , 1959 .

[12]  R. A. Leibler,et al.  On Information and Sufficiency , 1951 .

[13]  Santiago Alban,et al.  Performance Analysis and Architectures for INS-Aided GPS Tracking Loops , 2003 .

[14]  C. O'Connor An introduction to multivariate statistical analysis: 2nd edn. by T. W. Anderson. 675 pp. Wiley, New York (1984) , 1987 .

[15]  P. Savage STRAPDOWN INERTIAL NAVIGATION INTEGRATION ALGORITHM DESIGN. PART 2: VELOCITY AND POSITION ALGORITHMS , 1998 .

[16]  Maan El Badaoui El Najjar,et al.  A Road-Matching Method for Precise Vehicle Localization Using Belief Theory and Kalman Filtering , 2005, Auton. Robots.

[17]  J. Saastamoinen Atmospheric Correction for the Troposphere and Stratosphere in Radio Ranging Satellites , 2013 .

[18]  G. Bierman Factorization methods for discrete sequential estimation , 1977 .

[19]  I. Shapiro,et al.  Geodesy by radio interferometry: Effects of atmospheric modeling errors on estimates of baseline length , 1985 .

[20]  J. F. Bosen A FORMULA FOR APPROXIMATION OF THE SATURATION VAPOR PRESSURE OVER WATER , 1960 .

[21]  I. Miller,et al.  Tightly-coupled GPS / INS system design for autonomous urban navigation , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[22]  Mark L. Psiaki,et al.  Modeling, Analysis, and Simulation of GPS Carrier Phase for Spacecraft Relative Navigation , 2005 .

[23]  Ernest J. Ohlmeyer,et al.  GPS-AIDED NAVIGATION SYSTEM REQUIREMENTS FOR SMART MUNITIONS AND GUIDED MISSILES , 1997 .

[24]  A. Niell Global mapping functions for the atmosphere delay at radio wavelengths , 1996 .

[25]  Ephrahim Garcia,et al.  Team Cornell's Skynet: Robust perception and planning in an urban environment , 2008, J. Field Robotics.

[26]  M. Psiaki,et al.  Satellite Relative Navigation Using Carrier-Phase Differential GPS with Integer Ambiguities , 2005 .

[27]  P. D. Jonge,et al.  The LAMBDA method for integer ambiguity estimation: implementation aspects , 1996 .

[28]  J. Lundberg,et al.  Recursion formulas of Legendre functions for use with nonsingular geopotential models , 1988 .

[29]  Aaron Nathan,et al.  Cornell University's 2005 DARPA Grand Challenge Entry , 2006 .

[30]  Salah Sukkarieh,et al.  Tightly Coupled INS/GPS with Bias Estimation for UAV Applications , 2004 .