Towards Robust GNSS Positioning and Real-time Kinematic Using Factor Graph Optimization

Global navigation satellite systems (GNSS) are one of the utterly popular sources for providing globally referenced positioning for autonomous systems. However, the performance of the GNSS positioning is significantly challenged in urban canyons, due to the signal reflection and blockage from buildings. Given the fact that the GNSS measurements are highly environmentally dependent and time-correlated, the conventional filtering-based method for GNSS positioning cannot simultaneously explore the time-correlation among historical measurements. As a result, the filtering-based estimator is sensitive to unexpected outlier measurements. In this paper, we present a factor graph-based formulation for GNSS positioning and real-time kinematic (RTK). The formulated factor graph framework effectively explores the time-correlation of pseudorange, carrier-phase, and doppler measurements, and leads to the non-minimal state estimation of the GNSS receiver. The feasibility of the proposed method is evaluated using datasets collected in challenging urban canyons of Hong Kong and significantly improved positioning accuracy is obtained, compared with the filtering-based estimator.

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

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

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

[4]  Hao Wang,et al.  Robust and Precise Vehicle Localization Based on Multi-Sensor Fusion in Diverse City Scenes , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Marcus Obst,et al.  GNSS positioning in non-line-of-sight context—A survey , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

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

[7]  Li-Ta Hsu,et al.  3D building model-based pedestrian positioning method using GPS/GLONASS/QZSS and its reliability calculation , 2016, GPS Solutions.

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

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

[10]  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).

[11]  Mounir Adjrad,et al.  Likelihood-based GNSS positioning using LOS/NLOS predictions from 3D mapping and pseudoranges , 2017, GPS Solutions.

[12]  Kubo,et al.  Performance Evaluation of RTK-GNSS with Existing Sensors in Dense Urban Areas , 2014 .

[13]  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.

[14]  Ryan M. Watson,et al.  Robust Navigation In GNSS Degraded Environment Using Graph Optimization , 2017, ArXiv.

[15]  Peter Teunissen,et al.  The Lambda Method for the GNSS Compass , 2006 .

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

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

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

[19]  Michael J. Rycroft,et al.  Understanding GPS. Principles and Applications , 1997 .

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

[21]  Peter Teunissen,et al.  Theory of integer equivariant estimation with application to GNSS , 2003 .

[22]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[23]  Clark N. Taylor,et al.  Robust Incremental State Estimation Through Covariance Adaptation , 2019, IEEE Robotics and Automation Letters.

[24]  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).

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

[26]  Taro Suzuki,et al.  High-accuracy GPS and GLONASS positioning by multipath mitigation using omnidirectional infrared camera , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

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

[29]  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).

[30]  Clark N. Taylor,et al.  Uncertainty Model Estimation in an Augmented Data Space for Robust State Estimation , 2019, Proceedings of the 33rd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2020).

[31]  Akio Yasuda,et al.  Cycle Slip Detection and Fixing by MEMS-IMU/GPS Integration for Mobile Environment RTK-GPS , 2008 .

[32]  Libor Preucil,et al.  Swarms of micro aerial vehicles stabilized under a visual relative localization , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[33]  Mingquan Lu,et al.  A robust graph optimization realization of tightly coupled GNSS/INS integrated navigation system for urban vehicles , 2018, Tsinghua Science and Technology.