Quantifying Robot Localization Safety: A New Integrity Monitoring Method for Fixed-Lag Smoothing

Localization safety, or integrity risk, is the probability of undetected localization failures and a common aviation performance metric used to verify a minimum accuracy requirement. As autonomous robots become more common, applying integrity risk metrics will be necessary to verify localization performance. This letter introduces a new method, solution separation, to quantify landmark-based mobile robot localization safety for fixed-lag smoothing estimators and compares it's computation time and fault detection capabilities to a chi-squared integrity monitoring method. Results show that solution separation is more computationally efficient and results in a tighter upper-bound on integrity risk when few measurements are included, which makes it the method of choice for lightweight, safety-critical applications such as UAVs. Conversely, chi-squared requires more computing resources but performs better when more measurements are included, making the method more appropriate for high performance computing platforms such as autonomous vehicles.

[1]  Matthew Spenko,et al.  Integrity Risk-Based Model Predictive Control for Mobile Robots , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[2]  Juan Blanch,et al.  Baseline advanced RAIM user algorithm and possible improvements , 2015, IEEE Transactions on Aerospace and Electronic Systems.

[3]  Bradford W. Parkinson,et al.  Autonomous GPS Integrity Monitoring Using the Pseudorange Residual , 1988 .

[4]  Mathieu Joerger,et al.  Local Nearest Neighbor Integrity Risk Evaluation for Robot Navigation , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Mathieu Joerger,et al.  A New Approach to Unwanted-Object Detection in GNSS/LiDAR-Based Navigation , 2018, Sensors.

[6]  Mathieu Joerger,et al.  Recursive Integrity Monitoring for Mobile Robot Localization Safety , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[7]  Mathieu Joerger,et al.  Integrity monitoring for Kalman filter-based localization , 2020, Int. J. Robotics Res..

[8]  Grace Xingxin Gao,et al.  Integrity for GPS/LiDAR Fusion Utilizing a RAIM Framework , 2018 .

[9]  Hamzah Ahmad,et al.  The Analysis of Covariance Matrix for Kalman Filter based SLAM with Intermittent Measurement , 2013 .

[10]  Niko Sünderhauf,et al.  Switchable constraints for robust pose graph SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Jinling Wang,et al.  Extended Receiver Autonomous Integrity Monitoring (eRAIM) for GNSS/INS Integration , 2010 .

[12]  Visakan Kadirkamanathan,et al.  Particle filtering-based fault detection in non-linear stochastic systems , 2002, Int. J. Syst. Sci..

[13]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[14]  Mathieu Joerger,et al.  Solution Separation Versus Residual-Based RAIM , 2014 .

[15]  R. J. Kelly,et al.  REQUIRED NAVIGATION PERFORMANCE (RNP) FOR PRECISION APPROACH AND LANDING WITH GNSS APPLICATION , 1994 .

[16]  Juan Blanch,et al.  Advanced RAIM user Algorithm Description: Integrity Support Message Processing, Fault Detection, Exclusion, and Protection Level Calculation , 2012 .

[17]  Juan Blanch,et al.  Reducing Computational Load in Solution Separation for Kalman Filters and an Application to PPP Integrity , 2019 .

[18]  Frank Dellaert,et al.  Factor Graphs for Robot Perception , 2017, Found. Trends Robotics.

[19]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[20]  Steven L. Waslander,et al.  Visual Measurement Integrity Monitoring for UAV Localization , 2019, 2019 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[21]  Mathieu Joerger,et al.  Efficient Integrity Monitoring for KF-based Localization , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[22]  Hannes Sommer,et al.  SegMap: Segment-based mapping and localization using data-driven descriptors , 2019, Int. J. Robotics Res..

[23]  Daniel J. Fagnant,et al.  Preparing a Nation for Autonomous Vehicles: Opportunities, Barriers and Policy Recommendations , 2015 .

[24]  Mathieu Joerger,et al.  Landmark Data Selection and Unmapped Obstacle Detection in Lidar-Based Navigation , 2017 .

[25]  Wolfram Burgard,et al.  Robust map optimization using dynamic covariance scaling , 2013, 2013 IEEE International Conference on Robotics and Automation.