GNSS Outlier Mitigation via Graduated Non-Convexity Factor Graph Optimization

Accurate and globally referenced global navigation satellite system (GNSS) based vehicular positioning can be achieved in outlier-free open areas. However, the performance of GNSS can be significantly degraded by outlier measurements, such as multipath effects and non-line-of-sight (NLOS) receptions arising from signal reflections of buildings. Inspired by the advantage of batch historical data in resisting outlier measurements, in this paper, we propose a graduated non-convexity factor graph optimization (FGO-GNC) to improve the GNSS positioning performance, where the impact of GNSS outliers is mitigated by estimating the optimal weightings of GNSS measurements. Different from the existing local solutions, the proposed FGO-GNC employs the non-convex Geman McClure (GM) function to globally estimate the weightings of GNSS measurements via a coarse-to-fine relaxation. The effectiveness of the proposed method is verified through several challenging datasets collected in urban canyons of Hong Kong using automobile level and low-cost smartphone level GNSS receivers.

[1]  Li-Ta Hsu,et al.  Exclusion of GNSS NLOS receptions caused by dynamic objects in heavy traffic urban scenarios using real-time 3D point cloud: An approach without 3D maps , 2018, 2018 IEEE/ION Position, Location and Navigation Symposium (PLANS).

[2]  Jay A. Farrell,et al.  High-Precision Vehicle Navigation in Urban Environments Using an MEM's IMU and Single-Frequency GPS Receiver , 2016, IEEE Transactions on Intelligent Transportation Systems.

[3]  Li-Ta Hsu,et al.  A Computation Effective Range-Based 3D Mapping Aided GNSS with NLOS Correction Method , 2020, Journal of Navigation.

[4]  Antonio F. Gómez-Skarmeta,et al.  GPS multipath detection and exclusion with elevation-enhanced maps , 2011, 2011 14th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[5]  Mirko Reguzzoni,et al.  goGPS: open-source MATLAB software , 2015, GPS Solutions.

[6]  GuYanlei,et al.  3D building model-based pedestrian positioning method using GPS/GLONASS/QZSS and its reliability calculation , 2016 .

[7]  Lei Wang,et al.  GNSS Shadow Matching: Improving Urban Positioning Accuracy Using a 3D City Model with Optimized Visibility Scoring Scheme , 2013 .

[8]  Li-Ta Hsu,et al.  Intelligent GPS L1 LOS/Multipath/NLOS Classifiers Based on Correlator-, RINEX- and NMEA-Level Measurements , 2019, Remote. Sens..

[9]  Marcus Obst,et al.  Switchable constraints and incremental smoothing for online mitigation of non-line-of-sight and multipath effects , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[10]  Niko Sünderhauf,et al.  Towards robust graphical models for GNSS-based localization in urban environments , 2012, International Multi-Conference on Systems, Sygnals & Devices.

[11]  P. Groves,et al.  Smartphone Shadow Matching for Better Cross-street GNSS Positioning in Urban Environments , 2015 .

[12]  Marcus Obst,et al.  Multipath mitigation in GNSS-based localization using robust optimization , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[13]  Marcus Obst,et al.  Multipath detection with 3D digital maps for robust multi-constellation GNSS/INS vehicle localization in urban areas , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[14]  Li-Ta Hsu,et al.  Robust Visual-Inertial Integrated Navigation System Aided by Online Sensor Model Adaption for Autonomous Ground Vehicles in Urban Areas , 2020, Remote. Sens..

[15]  P. Groves.  Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[16]  K. Rose.  Deterministic annealing for clustering, compression, classification, regression, and related optimization problems , 1998, Proc. IEEE.

[17]  Li-Ta Hsu,et al.  GPS Error Correction With Pseudorange Evaluation Using Three-Dimensional Maps , 2015, IEEE Transactions on Intelligent Transportation Systems.

[18]  Nobuaki Kubo,et al.  Correcting GNSS Multipath Errors Using a 3D Surface Model and Particle Filter , 2013 .

[19]  Weisong Wen,et al.  3D LiDAR Aided GNSS and Its Tightly Coupled Integration with INS Via Factor Graph Optimization , 2020, Proceedings of the 33rd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2020).

[20]  Li-Ta Hsu,et al.  Comparison of Extended Kalman Filter and Factor Graph Optimization for GNSS/INS Integrated Navigation System , 2020 .

[21]  Heng Yang,et al.  Graduated Non-Convexity for Robust Spatial Perception: From Non-Minimal Solvers to Global Outlier Rejection , 2020, IEEE Robotics and Automation Letters.

[22]  Tingting Mu,et al.  A Graduated Non-Convexity Relaxation for Large Scale Seriation , 2017, SDM.

[23]  Peter Protzel,et al.  Expectation-Maximization for Adaptive Mixture Models in Graph Optimization , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[24]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[25]  Li-Ta Hsu,et al.  Using Sky-pointing fish-eye camera and LiDAR to aid GNSS single-point positioning in urban canyons , 2020 .

[26]  Omar Garcia Crespillo,et al.  A Regularized Least Squares Estimator for Pseudorange-Based Terrestrial Positioning Under Degraded Geometries , 2020 .

[27]  Masayoshi Tomizuka,et al.  UrbanLoco: A Full Sensor Suite Dataset for Mapping and Localization in Urban Scenes , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[28]  Li-Ta Hsu,et al.  Intelligent GNSS/INS integrated navigation system for a commercial UAV flight control system , 2018, Aerospace Science and Technology.

[29]  Mohamed Sahmoudi,et al.  Performances Analysis of GNSS NLOS Bias Correction in Urban Environment Using a Three-Dimensional City Model and GNSS Simulator , 2018, IEEE Transactions on Aerospace and Electronic Systems.

[30]  Li-Ta Hsu,et al.  Analysis and modeling GPS NLOS effect in highly urbanized area , 2017, GPS Solutions.

[31]  Li-Ta Hsu,et al.  Tightly Coupled GNSS/INS Integration via Factor Graph and Aided by Fish-Eye Camera , 2019, IEEE Transactions on Vehicular Technology.

[32]  David E. Tyler.  A Distribution-Free $M$-Estimator of Multivariate Scatter , 1987 .

[33]  Li-Ta Hsu,et al.  Correcting NLOS by 3D LiDAR and building height to improve GNSS single point positioning , 2019, Navigation.

[34]  Michael J. Black,et al.  On the unification of line processes, outlier rejection, and robust statistics with applications in early vision , 1996, International Journal of Computer Vision.

[35]  Jonathan T. Barron,et al.  A General and Adaptive Robust Loss Function , 2017, 2019 IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR).

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

[37]  Sven Lange,et al.  Dynamic Covariance Estimation — A parameter free approach to robust Sensor Fusion , 2017, 2017 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[38]  Peter Protzel,et al.  Robust Sensor Fusion with Self-Tuning Mixture Models , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[39]  Bernhard Hofmann-Wellenhof,et al.  GNSS - Global Navigation Satellite Systems: GPS, GLONASS, Galileo, and more , 2007 .

[40]  Lei Wang,et al.  Urban Positioning on a Smartphone: Real-time Shadow Matching Using GNSS and 3D City Models , 2013 .

[41]  Jun-ichi Meguro,et al.  GPS Multipath Mitigation for Urban Area Using Omnidirectional Infrared Camera , 2009, IEEE Transactions on Intelligent Transportation Systems.

[42]  Miguel Ortiz,et al.  About Non-Line-Of-Sight Satellite Detection and Exclusion in a 3D Map-Aided Localization Algorithm , 2013, Sensors.

[43]  Li-Ta Hsu,et al.  GNSS NLOS Exclusion Based on Dynamic Object Detection Using LiDAR Point Cloud , 2021, IEEE Transactions on Intelligent Transportation Systems.

[44]  Ming Liu,et al.  PointMoSeg: Sparse Tensor-Based End-to-End Moving-Obstacle Segmentation in 3-D Lidar Point Clouds for Autonomous Driving , 2021, IEEE Robotics and Automation Letters.

[45]  Paul D. Groves,et al.  Combining Inertially-aided Extended Coherent Integration (Supercorrelation) with 3D-Mapping-Aided GNSS , 2020, Proceedings of the 33rd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2020).

[46]  Li-Ta Hsu,et al.  Towards Robust GNSS Positioning and Real-time Kinematic Using Factor Graph Optimization , 2021, 2021 IEEE International Conference on Robotics and Automation (ICRA).

[47]  Tomoji Takasu,et al.  Development of the low-cost RTK-GPS receiver with an open source program package RTKLIB , 2009 .