Time-Relative RTK-GNSS: GNSS Loop Closure in Pose Graph Optimization (2312.02448v1)
Abstract: A pose-graph-based optimization technique is widely used to estimate robot poses using various sensor measurements from devices such as laser scanners and cameras. The global navigation satellite system (GNSS) has recently been used to estimate the absolute 3D position of outdoor mobile robots. However, since the accuracy of GNSS single-point positioning is only a few meters, the GNSS is not used for the loop closure of a pose graph. The main purpose of this study is to generate a loop closure of a pose graph using a time-relative real-time kinematic GNSS (TR-RTK-GNSS) technique. The proposed TR-RTK-GNSS technique uses time-differential carrier phase positioning, which is based on carrier-phase-based differential GNSS with a single GNSS receiver. Unlike a conventional RTK-GNSS, we can directly compute the robot's relative position using only a stand-alone GNSS receiver. The initial pose graph is generated from the accumulated velocity computed from GNSS Doppler measurements. To reduce the accumulated error of velocity, we use the TR-RTK-GNSS technique for the loop closure in the graph-based optimization framework. The kinematic positioning tests were performed using an unmanned aerial vehicle to confirm the effectiveness of the proposed technique. From the tests, we can estimate the vehicle's trajectory with approximately 3 cm accuracy using only a stand-alone GNSS receiver.
- N. Sünderhauf and P. Protzel, “Towards a robust back-end for pose graph SLAM,” in IEEE International Conference on Robotics and Automation, 2012, pp. 1254–1261.
- H. Durrant-Whyte and T. Bailey, “Simultaneous localization and mapping: Part I,” IEEE Robotics and Automation Magazine, vol. 13, no. 2, pp. 99–108, jun 2006.
- Y. Zhao, “Applying Time-Differenced Carrier Phase in Nondifferential GPS/IMU Tightly Coupled Navigation Systems to Improve the Positioning Performance,” IEEE Transactions on Vehicular Technology, vol. 66, no. 2, pp. 992–1003, feb 2017.
- K. Takeyama, Y. Kojima, and E. Teramoto, “Trajectory estimation improvement based on time-series constraint of GPS Doppler and INS in urban areas,” in ION/IEEE PLANS, Position Location and Navigation Symposium, 2012, pp. 700–705.
- P. Freda, A. Angrisano, S. Gaglione, and S. Troisi, “Time-differenced carrier phases technique for precise GNSS velocity estimation,” GPS Solutions, vol. 19, no. 2, pp. 335–341, 2015.
- B. K. Soon, S. Scheding, H. K. Lee, H. K. Lee, and H. Durrant-Whyte, “An approach to aid INS using time-differenced GPS carrier phase (TDCP) measurements,” GPS Solutions, vol. 12, no. 4, pp. 261–271, sep 2008.
- J. Traugott, “Precise Flight Trajectory Reconstruction Based on Time-Differential GNSS Carrier Phase Processing,” Ph.D. dissertation, 2011.
- N. Sunderhauf and P. Protzel, “Switchable constraints for robust pose graph SLAM,” in IEEE International Conference on Intelligent Robots and Systems, 2012, pp. 1879–1884.
- D. Chen and G. X. Gao, “Probabilistic graphical fusion of LiDAR, GPS, and 3D building maps for urban UAV navigation,” Navigation, Journal of the Institute of Navigation, vol. 66, no. 1, pp. 151–168, jan 2019.
- N. Sünderhauf, M. Obst, G. Wanielik, and P. Protzel, “Multipath mitigation in GNSS-based localization using robust optimization,” in IEEE Intelligent Vehicles Symposium, 2012, pp. 784–789.
- W. Li, X. Cui, and M. Lu, “A robust graph optimization realization of tightly coupled GNSS/INS integrated navigation system for urban vehicles,” Tsinghua Science and Technology, vol. 23, no. 6, pp. 724–732, dec 2018.
- R. M. Watson and J. N. Gross, “Robust navigation in gnss degraded environment using graph optimization,” in 30th International Technical Meeting of the Satellite Division of the Institute of Navigation, ION GNSS 2017, vol. 5. Institute of Navigation, 2017, pp. 2906–2918.
- F. R. Kschischang, B. J. Frey, and H. A. Loeliger, “Factor graphs and the sum-product algorithm,” IEEE Transactions on Information Theory, vol. 47, no. 2, pp. 498–519, 2001.
- G. Grisetti, R. Kummerle, C. Stachniss, and W. Burgard, “A tutorial on graph-based SLAM,” IEEE Intelligent Transportation Systems Magazine, vol. 2, no. 4, pp. 31–43, dec 2010.
- L. Serrano, D. Kim, R. B. Langley, K. Itani, and M. Ueno, “A GPS velocity sensor: How accurate can it be? - A first look,” in Proceedings of the National Technical Meeting, Institute of Navigation, vol. 2004, 2004, pp. 875–885.
- P. J. Teunissen, “The least-squares ambiguity decorrelation adjustment: a method for fast GPS integer ambiguity estimation,” Journal of Geodesy, vol. 70, no. 1-2, pp. 65–82, nov 1995.
- T. Takasu and A. Yasuda, “Development of the low-cost RTK-GPS receiver with an open source program package RTKLIB,” in Proc. of The International Symposium on GPS/GNSS, Jeju, Korea, 2009.
- A. Geiger, P. Lenz, and R. Urtasun, “Are we ready for autonomous driving? the KITTI vision benchmark suite,” in IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2012, pp. 3354–3361.
- P. Reisdorf, T. Pfeifer, J. Breßler, S. Bauer, P. Weissig, S. Lange, G. Wanielik, and P. Protzel, “The Problem of Comparable GNSS Results – An Approach for a Uniform Dataset with Low-Cost and Reference Data,” in International Conference on Advances in Vehicular Systems Technologies and Applications, no. c, 2016, pp. 1–8.
- O. Mian, J. Lutes, G. Lipa, J. J. Hutton, E. Gavelle, and S. Borghini, “Direct georeferencing on small unmanned aerial platforms for improved reliability and accuracy of mapping without the need for ground control points,” International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences, vol. 40, no. 1W4, pp. 397–402, 2015.
- F. Dellaert, “Factor Graphs and GTSAM: A Hands-on Introduction,” Tech. Rep., 2012.