Submitted:
27 May 2024
Posted:
27 May 2024
You are already at the latest version
Abstract
Keywords:
1. Introduction
2. Methodology
2.1. Virtual Jconstraints Establishment from Pesudorange
2.2. Graph Model Construction with Virtual Constraints
2.2.1. IMU Factor
2.2.2. GNSS Pseudorange Factor
3.1.3. Graph Model Analysis Akin to SLAM Model
2.2.3. Marginalization
3. Experiments and Results
| Title 1 | Title 2 |
|---|---|
| GNSS Signal Frequency (Hz) | 1 |
| IMU Frequency (Hz) | 125 |
| Gyroscope Bias (rad/s) | 0.0005 |
| ) | 80 |
| Carrier-to-Noise Ratio Threshold | 30 |
| Operation Time (s) | 292 |
4. Conclusions
Author Contributions
Funding
Acknowledgments
Conflicts of Interest
References
- Ai Qingsong, Zhang Baocheng, Yuan Yunbin et al. Evaluation and mitigation of the influence of pseudorange biases on GNSS satellite clock offset estimation[J]. Measurement, 2022, 193.
- Wen W, Hsu L T. Towards robust GNSS positioning and real-time kinematic using factor graph optimization[C]//2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2021: 5884-5890.
- Zhang Xiaohong, ZHANG Yuantai, Zhu Feng, et al. Factor Graph Optimization Method of GNSS positioning in complex urban Scenarios and its resistance Analysis [J]. Journal of Wuhan University (Department of Information Learning edition),2023,48(7):1050-1057. [CrossRef]
- Tian Y ,Liu F ,Liu H , et al. A Real‐Time and Fast LiDAR–IMU–GNSS SLAM System with Point Cloud Semantic Graph Descriptor Loop‐Closure Detection [J]. Advanced Intelligent Systems, 2023, 5 (10): .
- C S N ,N M C ,T A . Analysis of GNSS and IMU Sensor Data Fusion Using the Unscented Kalman Filter Method on Medical Drones in Open Air [J]. IOP Conference Series: Earth and Environmental Science, 2023, 1250 (1):.
- Kaczmarek Adrian, Rohm Witold, Klingbeil Lasse et al. Experimental 2D extended Kalman filter sensor fusion for low-cost GNSS/IMU/Odometers precise positioning system[J]. Measurement, 2022, 193.
- McGrath Timothy and Stirling Leia. Body-Worn IMU Human Skeletal Pose Estimation Using a Factor Graph-Based Optimization Framework.[J]. Sensors (Basel, Switzerland), 2020, 20(23).
- Chang L, Niu X, Liu T, et al. GNSS/INS/LiDAR-SLAM integrated navigation system based on graph optimization[J]. Remote Sensing, 2019, 11(9): 1009.
- Wen W, Pfeifer T, Bai X, et al. Factor graph optimization for GNSS/INS integration: A comparison with the extended Kalman filter[J]. NAVIGATION: Journal of the Institute of Navigation, 2021, 68(2): 315-331.
- Suzuki, T. Time-relative RTK-GNSS: GNSS loop closure in pose graph optimization[J]. IEEE robotics and automation letters, 2020, 5(3): 4735-4742.
- Zhang G, Ng H F, Wen W, et al. 3D mapping database aided GNSS based collaborative positioning using factor graph optimization[J]. IEEE Transactions on Intelligent Transportation Systems, 2020, 22(10): 6175-6187.
- Li W, Cui X, Lu M. A robust graph optimization realization of tightly coupled GNSS/INS integrated navigation system for urban vehicles[J]. Tsinghua Science and Technology, 2018, 23(6): 724-732.
- Wen W, Zhang G, Hsu L T. GNSS outlier mitigation via graduated non-convexity factor graph optimization[J]. IEEE Transactions on Vehicular Technology, 2021, 71(1): 297-310.
- Jiang C, Chen Y, Xu B, et al. Vector tracking based on factor graph optimization for GNSS NLOS bias estimation and correction[J]. IEEE Internet of Things Journal, 2022, 9(17): 16209-16221.
- Das A, Elfring J, Dubbelman G. Real-time vehicle positioning and mapping using graph optimization[J]. Sensors, 2021, 21(8): 2815.
- Weiqiang, Fu,Shupeng, Hu,Changhai et al. Development and Test of GNSS/IMU-Based Speed Measurement Device for Agricultural Machinery[C]//.Proceedings of the International Conference on Intelligent Agriculture 2017(ICIA2017) PartI.,2017:455-466.
- Jiang C, Chen S, Chen Y, et al. GNSS vector tracking method using graph optimization[J]. IEEE Transactions on Circuits and Systems II: Express Briefs, 2020, 68(4): 1313-1317.
- Wen W, Kan Y C, Hsu L T. Performance comparison of GNSS/INS integrations based on EKF and factor graph optimization[C]//Proceedings of the 32nd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2019). 2019: 3019-3032.
- Kaess M, Ranganathan A, Dellaert F. iSAM: Incremental smoothing and mapping[J]. IEEE Transactions on Robotics, 2008, 24(6): 1365-1378.
- Dellaert, F. Factor graphs and GTSAM: A hands-on introduction[J]. Georgia Institute of Technology, Tech. Rep, 2012, 2: 4.
- Groves P, D. Principles of GNSS, inertial, and multisensor integrated navigation systems, [Book review][J]. IEEE Aerospace and Electronic Systems Magazine, 2015, 30(2): 26-27. https://githubcom/benzenemo/TightlyCoupledINSGNSS.














| X-direction Error | Y-direction Error | Z-direction Error | |
|---|---|---|---|
| Kalman filter | 2.8337 | 4.1623 | 0.6126 |
| FGO | 1.9592 | 2.6421 | 0.4540 |
| Error reduction | 30.1% | 36.5% | 25.8% |
| X-direction Error | Y-direction Error | Z-direction Error | |
|---|---|---|---|
| VC FGO | 1.9921 | 2.6849 | 0.4762 |
| FGO | 1.9592 | 2.6421 | 0.4540 |
| Error variation | 1.667% | 1.623% | 4.891% |
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2024 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).