Abstract
The emergence of low-cost micro-electro-mechanical system inertial measurement units, cameras and global navigation satellite system (GNSS) receivers has promoted the research of multisensor fusion positioning. With the rapid development of chip technology, it has become a trend for low-cost GNSS chips to provide multi-frequency carrier phase observations while supporting multiple constellations. To enhance the positioning performance of multi-frequency and multi-system precise point positioning (PPP) in the difficult urban environment, we propose a tightly coupled system of monocular visual-inertial odometry (MVIO) and uncombined PPP (UC-PPP) based on factor graph optimization. The initialization of MVIO and UC-PPP adopts a coarse-to-fine approach to correct the transformation of local and global frames online. Moreover, the sliding window and marginalization methods are adopted to retain the constraints between adjacent observations and eliminate useless observations in the window. The pedestrian and vehicle tests in urban environments verify the performance of the proposed method. Compared with open-source software GVINS, the positioning accuracy of the proposed method has been further improved by using carrier phase observations with higher measurement accuracy. Compared with PPP alone, the improvement of the proposed method for the low-speed and short-distance pedestrian test in the east, north, and up directions is 73.3, 54.8 and 62.7%, respectively, while the improvement for the high-speed and long-distance vehicle test is 63.0, 59.3 and 70.5%, respectively. Experiment results show that the proposed method has better positioning accuracy and continuity in difficult urban environments.
Similar content being viewed by others
Data availability
The datasets used in the pedestrian and vehicle tests are available at https://github.com/HKUST-Aerial-Robotics/GVINS-Dataset.
References
Ashby N (2004) The sagnac effect in the global positioning system. In: Rizzi G, Ruggiero ML (eds) Relativity in rotating frames: relativistic physics in rotating reference frames. Springer, Netherlands, Dordrecht, pp 11–28
Bloesch M, Omari S, Hutter M, Siegwart R (2015) Robust visual inertial odometry using a direct EKF-based approach. In: 2015 IEEE/RSJ international conference on intelligent robots and systems (IROS). pp 298–304
Boehm J, Niell A, Tregoning P, Schuh H (2006) Global mapping function (GMF): a new empirical mapping function based on numerical weather model data. Geophys Res Lett. https://doi.org/10.1029/2005GL025546
Campos C, Elvira R, Rodríguez JJ, Montiel JM, Tardós JD (2021) ORB-SLAM3: an accurate open-source library for visual visual-inertial and multimap SLAM. IEEE Trans Robot 37(6):1874–1890. https://doi.org/10.1109/TRO.2021.3075644
Cao S, Lu X, Shen S (2022) GVINS: tightly coupled GNSS–visual–inertial fusion for smooth and consistent state estimation. IEEE Trans Robot 38(4):2004–2021. https://doi.org/10.1109/TRO.2021.3133730
Civera J, Davison AJ, Montiel JMM (2008) Inverse depth parametrization for monocular SLAM. IEEE Trans Robot 24(5):932–945. https://doi.org/10.1109/TRO.2008.2003276
Davison AJ, Reid ID, Molton ND, Stasse O (2007) MonoSLAM: real-time single camera SLAM. IEEE Trans Patt Anal Mach Intell 29(6):1052–1067. https://doi.org/10.1109/TPAMI.2007.1049
Gong Z, Liu P, Wen F, Ying R, Ji X, Miao R, Xue W (2021) Graph-based adaptive fusion of GNSS and VIO under intermittent GNSS-degraded environment. IEEE Trans Instrum Meas 70:1–16. https://doi.org/10.1109/TIM.2020.3039640
Klein G, Murray D (2007) Parallel tracking and mapping for small ar workspaces. In: 6th IEEE and ACM international symposium on mixed and augmented reality. pp 225–234
Leutenegger S, Lynen S, Bosse M, Siegwart R, Furgale P (2015) Keyframe-based visual-inertial odometry using nonlinear optimization. Int J Rob Res 34(3):314–334. https://doi.org/10.1177/0278364914554813
Li Z, Gao J, Wang J, Yao Y (2017) PPP/INS tightly coupled navigation using adaptive federated filter. GPS Solut 21(1):137–148. https://doi.org/10.1007/s10291-015-0511-z
Li T, Pei L, Xiang Y, Yu W, Truong T-K (2022a) P3-VINS: tightly-coupled PPP/INS/Visual SLAM based on optimization approach. IEEE Robot Autom Lett 7(3):7021–7027. https://doi.org/10.1109/LRA.2022.3180441
Li X, Li X, Li S, Zhou Y, Sun M, Xu Q, Xu Z (2022b) Centimeter-accurate vehicle navigation in urban environments with a tightly integrated PPP-RTK/MEMS/vision system. GPS Solut 26(4):124. https://doi.org/10.1007/s10291-022-01306-3
Li S, Li X, Wang H, Zhou Y, Shen Z (2023) Multi-GNSS PPP/INS/Vision/LiDAR tightly integrated system for precise navigation in urban environments. Inf Fusion 90:218–232. https://doi.org/10.1016/j.inffus.2022.09.018
Li X, Wang XB, Liao JC, Li X, Li SY, Lyu HB (2021) Semi-tightly coupled integration of multi-GNSS PPP and S-VINS for precise positioning in GNSS-challenged environments. Satell Navig. https://doi.org/10.1186/s43020-020-00033-9
Mur-Artal R, Tardós JD (2017) ORB-SLAM2: an open-source SLAM system for monocular stereo and RGB-D cameras. IEEE Trans Robot 33(5):1255–1262. https://doi.org/10.1109/TRO.2017.2705103
Newcombe RA, Lovegrove SJ, Davison AJ (2011) DTAM: dense tracking and mapping in real-time. In: International conference on computer vision. pp 2320–2327
Nikolic J, Rehder J, Burri M, Gohl P, Leutenegger S, Furgale PT, Siegwart R (2014) A synchronized visual-inertial sensor system with FPGA pre-processing for accurate real-time SLAM. In: IEEE international conference on robotics and automation (ICRA). pp 431–437
Pan C, Li Z, Gao J, Li F (2021) A variational bayesian-based robust adaptive filtering for precise point positioning using undifferenced and uncombined observations. Adv Sp Res 67(6):1859–1869. https://doi.org/10.1016/j.asr.2020.12.022
Qin T, Cao S, Pan J, Shen S (2019) A general optimization-based framework for global pose estimation with multiple sensors. https://doi.org/10.48550/arXiv.1901.03642
Shen S, Michael N, Kumar V (2015) Tightly-coupled monocular visual-inertial fusion for autonomous flight of rotorcraft MAVs. In: IEEE international conference on robotics and automation (ICRA). pp 5303–5310
Sun K, Mohta K, Pfrommer B, Watterson M, Liu S, Mulgaonkar Y, Taylor CJ, Kumar V (2018) Robust stereo visual inertial odometry for fast autonomous flight. IEEE Robot Autom Lett 3(2):965–972. https://doi.org/10.1109/LRA.2018.2793349
Wen W, Bai X, Kan YC, Hsu L-T (2019) Tightly coupled GNSS/INS integration via factor graph and aided by fish-eye camera. IEEE Trans Veh Technol 68(11):10651–10662. https://doi.org/10.1109/TVT.2019.2944680
Wen W, Hsu L-T (2021) Towards robust GNSS positioning and real-time kinematic using factor graph optimization. In: IEEE international conference on robotics and automation (ICRA). pp 5884–5890
Xu B, Zhang SJ, Kuang KF, Li XX (2023) A unified cycle-slip multipath estimation detection and mitigation method for VIO-aided PPP in urban environments. GPS Solut 27(2):59. https://doi.org/10.1007/s10291-023-01396-7
Zhang Y, Gao Y (2008) Integration of INS and un-differenced GPS measurements for precise position and attitude determination. J Navig 61(1):87–97. https://doi.org/10.1017/S0373463307004432
Zhang W, Wang J, El-Mowafy A, Rizos C (2023) Integrity monitoring scheme for undifferenced and uncombined multi-frequency multi-constellation PPP-RTK. GPS Solut 27(2):68. https://doi.org/10.1007/s10291-022-01391-4
Zhao S, Chen Y, Farrell JA (2016) High-precision vehicle navigation in urban environments using an MEM’s IMU and single-frequency GPS receiver. IEEE Trans Intell Transp Syst 17(10):2854–2867. https://doi.org/10.1109/TITS.2016.2529000
Acknowledgements
Thanks to the HKUST Aerial Robotics Group for the open datasets. Cheng Pan would like to thank the China Scholarship Council for sponsoring his visit to ETH Zurich.
Funding
This work was supported by the National Natural Science Foundation of China (41974026), the Graduate Innovation Program of China University of Mining and Technology (2022WLKXJ108) and the Postgraduate Research and Practice Innovation Program of Jiangsu Province (KYCX22_2591).
Author information
Authors and Affiliations
Contributions
CP: Conceptualization, methodology, software, writing—original draft. FL, YP, YW: Investigation, writing—review and editing. BS and JG: Supervision, writing—review and editing. ZL: Supervision, Project administration, Funding acquisition. All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Conflict of interest
The authors declare that they have no known competing financial interests or personal relationships that could have appeared to influence the work reported in this paper.
Ethics approval
Not applicable.
Consent for Publication
All authors give their consent for publication.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Pan, C., Li, F., Pan, Y. et al. Tightly coupled integration of monocular visual-inertial odometry and UC-PPP based on factor graph optimization in difficult urban environments. GPS Solut 28, 45 (2024). https://doi.org/10.1007/s10291-023-01586-3
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10291-023-01586-3