论文

双重因子图与模糊度优化的双动态载体定位算法

  • 王尔申 ,
  • 刘泽新 ,
  • 王德琰 ,
  • 于腾丽 ,
  • 孟凡琛 ,
  • 刘亚仪 ,
  • 徐嵩
展开
  • 1.沈阳航空航天大学 电子信息工程学院,沈阳 110136
    2.极限环境光电动态测试技术与仪器全国重点实验室,太原 038507
    3.北京航天控制仪器研究所,北京 100039
    4.沈阳航空航天大学 航空宇航学院,沈阳 110136
.E-mail: wanges_2016@126.com

收稿日期: 2024-10-08

  修回日期: 2024-12-30

  录用日期: 2025-03-28

  网络出版日期: 2025-03-28

基金资助

国家自然科学基金(62173237);国家自然科学基金(62388101);极限环境光电动态测试技术与仪器全国重点实验室开放基金(2023-SYSJJ-04);航空科学基金(20240055054001)

Dual dynamic carrier positioning algorithm based on double factor graph and ambiguity optimization

  • Ershen WANG ,
  • Zexin LIU ,
  • Deyan WANG ,
  • Tengli YU ,
  • Fanchen MENG ,
  • Yayi LIU ,
  • Song XU
Expand
  • 1.School of Electronic and Information Engineering,Shenyang Aerospace University,Shenyang 110136,China
    2.State Key Laboratory of Dynamic Measurement Technology,Taiyuan 038507,China
    3.Beijing Institute of Aerospace Control Devices,Beijing 100039,China
    4.School of Aeronautics and Astronautics,Shenyang Aerospace University,Shenyang 110136,China

Received date: 2024-10-08

  Revised date: 2024-12-30

  Accepted date: 2025-03-28

  Online published: 2025-03-28

Supported by

National Natural Science Foundation of China(62173237);Open Foundation for State Key Laboratory of Optoelectronic Dynamic Measurement Technology and Instrumentation for Extreme Environments(2023-SYSJJ-04);Aeronautical Science Foundation of China(20240055054001)

摘要

随着无人系统、自动驾驶等领域的快速发展,双动态载体相对定位技术在满足高精度实时定位和复杂环境适应性方面变得愈加重要。为提升现有双动态载体相对定位算法的精度与可靠性,构建了参考站处理、模糊度固定、移动站解算优化方法,提出了一种双重因子图与模糊度优化(DF-AR)的双动态载体相对定位算法。利用融合多频多系统卡尔曼滤波的因子图优化模型抑制参考站端单点定位模式的误差,提升相对定位精度。并通过基线约束与数据质量定权,构建了改进的数据加模型驱动部分模糊度固定策略,优选出可靠性更高的模糊度子集,提升模糊度固定成功率和相对定位解的可靠性。在上述改进基础上,在因子图优化模型中引入滑动窗口,动态调整数据量,对移动站定位解进行再优化,获得了更为鲁棒的相对定位结果。分别开展了静态评估实验、双车载以及无人机/车载动态相对定位实验。实验结果表明:在不同的实验场景下,DF-AR算法相比于RTKLIB算法的基线误差分别降低了69.72%、94.89%和68.03%,基线解精度由米级提升至分米级,有效提高了相对定位的可靠性和精确性。

本文引用格式

王尔申 , 刘泽新 , 王德琰 , 于腾丽 , 孟凡琛 , 刘亚仪 , 徐嵩 . 双重因子图与模糊度优化的双动态载体定位算法[J]. 航空学报, 2025 , 46(13) : 531332 -531332 . DOI: 10.7527/S1000-6893.2024.31332

Abstract

With the rapid development of unmanned systems, autonomous driving, and other related fields, dual dynamic carrier relative positioning technology has become increasingly important for achieving high-precision real-time positioning and adapting to complex environments. To improve the accuracy and reliability of the existing relative positioning algorithm for dual dynamic carrier, this paper proposes a dual dynamic carrier relative positioning algorithm based on Double Factor graph and Ambiguity Resolution optimization (DF-AR), incorporating reference station processing, ambiguity resolution, and mobile station resolution optimization methods. To improve relative positioning accuracy, a factor graph optimization model integrating multi-frequency and multi-system Kalman filtering is used to suppress single-point positioning errors at the reference station. Using baseline constraints along with data quality weighting, an improved data and model-driven partial ambiguity resolution strategy is constructed. The ambiguity subset with higher reliability is selected to improve the success rate of ambiguity fixation and the reliability of the relative positioning solution. Based on these improvements, a sliding window is introduced in the factor graph optimization model to dynamically adjust the data amount. The positioning solution of the mobile station is reoptimized to achieve more robust relative positioning results. Static evaluation experiments, dual-vehicle and UAV/vehicle dynamic relative positioning experiments were carried out. The experimental results show that in different experimental scenarios, the baseline solution error of the DF-AR relative positioning algorithm has an error reduction of 69.72%, 94.89%, and 68.03% compared to the RTKLIB algorithm. The baseline solution accuracy has been improved from meter level to decimeter level, effectively enhancing the reliability and accuracy of relative positioning.

参考文献

[1] 张晓帆, 刘鑫, 黄婉君. 美国航母联合精确进近着舰系统[J]. 舰船科学技术202446(2): 185-189.
  ZHANG X F, LIU X, HUANG W J. US aircraft carrier joint precision approach and landing system[J]. Ship Science and Technology202446?(2): 185-189 (in Chinese).
[2] ZHANG L F, WANG S P, MARIA SERGEEVNA S, et al. A new adaptive Kalman filter for navigation systems of carrier-based aircraft[J]. Chinese Journal of Aeronautics202235(1): 416-425.
[3] TEUNISSEN P J G. A new method for fast carrier phase ambiguity estimation[C]?∥Proceedings of 1994 IEEE Position, Location and Navigation Symposium-PLANS’94. Piscataway: IEEE Press,1994.
[4] 杨卫平. 新一代飞行器导航制导与控制技术发展趋势[J]. 航空学报202445(5): 529720.
  YANG W P. Development trend of navigation guidance and control technology for new generation aircraft[J]. Acta Aeronautica et Astronautica Sinica202445(5): 529720 (in Chinese).
[5] 顾海燕, 熊健. 全自动精密进近引导与传输技术研究[J]. 电讯技术202464(7): 1102-1106.
  GU H Y, XIONG J. Research on fully automatic precision approach guidance and transmission technology?[J]. Telecommunication Engineering202464(7): 1102-1106 (in Chinese).
[6] KRASUSKI K, CIE?KO A, BAKU?A M, et al. New methodology of designation the precise aircraft position based on the RTK GPS solution[J]. Sensors202122(1): 21.
[7] KRASUSKI K, CIE?KO A, GRUNWALD G, et al. Improving positioning accuracy of aircraft using SPP method in GLONASS system?[J]. Archives of Transport202469(1): 21-37.
[8] JIANG C H, CHEN Y W, JIA J X, et al. Open-source optimization method for Android smartphone single point positioning[J]. GPS Solutions202226(3): 90.
[9] KANHERE A V, GUPTA S, SHETTY A, et al. Improving GNSS positioning using neural-network-based corrections[J]. NAVIGATION: Journal of the Institute of Navigation202269(4): 548.
[10] DELLAERT F, KAESS M. Factor graphs for robot perception[J]. Foundations and Trends in Robotics20156(1-2): 1-139.
[11] WEN W S, 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). Piscataway: IEEE Press, 2021.
[12] YAN S D, Lyu S L, LIU G, et al. Real-time kinematic positioning algorithm in graphical state space?[C]?∥Proceedings of the 2023 International Technical Meeting of The Institute of Navigation. Long Beach: Institute of Navigation, 2023.
[13] WEN W S, ZHANG G H, HSU L T. GNSS outlier mitigation via graduated non-convexity factor graph optimization[J]. IEEE Transactions on Vehicular Technology202271(1): 297-310.
[14] CHENG Q, CHEN W, SUN R, et al. Strategy for single-epoch RTK positioning using dual frequency in urban areas[J]. IEEE Internet of Things Journal202411(3): 4523-4534.
[15] TANG H B, WAN B H, MAO X C. Multi-system real-time kinematic positioning based on fast satellite selection and improved Kalman filter[J]. Journal of Shanghai Jiaotong University (Science)2024: 1-11.
[16] TEUNISSEN P J G, JOOSTEN P, TIBERIUS C C J M. Geometry-free ambiguity success rates in case of partial fixing[C]?∥Proceedings of the 1999 National Technical Meeting of the Institute of Navigation. San Diego: Institute of Navigation, 1999.
[17] ZHANG X, YANG J. MPARELAM: A robust approach for ambiguity resolution in complex RTK positioning scenarios[J]. IEEE Sensors Journal202323(17): 19582-19589.
[18] TEUNISSEN P.J.G., VERHAGEN S. The GNSS ambiguity ratio-test revisited: A better way of using it[J]. Survey Review200941(312): 138-151.
[19] TAO X L, LIU W K, WANG Y Z, et al. Smartphone RTK positioning with multi-frequency and multi-constellation raw observations: GPS L1/L5, Galileo E1/E5a, BDS B1I/B1C/B2a[J]. Journal of Geodesy202397(5): 43.
[20] HOU Y Q, VERHAGEN S, WU J. A data driven partial ambiguity resolution: Two step success rate criterion, and its simulation demonstration?[J]. Advances in Space Research201658(11): 2435-2452.
[21] LU L G, MA L Y, LIU W K, et al. A triple checked partial ambiguity resolution for GPS/BDS RTK positioning[J]. Sensors201919(22): 5034.
[22] CHEN C, ZHU J L, BO Y M, et al. Pedestrian smartphone navigation based on weighted graph factor optimization utilizing GPS/BDS multi-constellation?[J]. Remote Sensing202315(10): 2506.
[23] 徐正鹏, 张全, 牛小骥. GNSS单点解算用于组合导航性能分析[J]. 测绘地理信息201944(1): 32-35.
  XU Z P, ZHANG Q, NIU X J. Analysis of integrated navigation base on GNSS single point position[J]. Journal of Geomatics201944(1): 32-35 (in Chinese).
[24] BRACK A. Reliable GPS+BDS RTK positioning with partial ambiguity resolution[J]. GPS Solutions201721(3): 1083-1092.
[25] ZHOU Z L, LIU B Y, YANG H Z. A Hopular based weighting scheme for improving kinematic GNSS positioning in deep urban canyon[J]. Measurement Science and Technology202435(7): 076304.
[26] KHODABANDEH A, TEUNISSEN P J G. Bias-constrained integer least squares estimation: Distributional properties and applications in GNSS ambiguity resolution[J]. Journal of Geodesy202498(5): 40.
[27] MIAO W K, LI B F, GAO Y, et al. Vectorial integer bootstrapping of best integer equivariant estimation (VIB-BIE) for efficient and reliable GNSS ambiguity resolution[J]. Journal of Geodesy202498(4): 30.
[28] VERHAGEN S. On the approximation of the integer least-sqaures success rate: Which lower or upper bound to use??[J]. Journal of Global Positioning Systems20032(2): 117-124.
[29] JI S Y, WANG J, WENG D J, et al. Detailed investigation on ambiguity validation of long-distance RTK?[J]. Remote Sensing202416(16): 2982.
[30] WANG Z P, HOU X P, DAN Z Q, et al. Adaptive Kalman filter based on integer ambiguity validation in moving base RTK[J]. GPS Solutions202227(1): 34.
[31] 张小红, 张元泰, 朱锋. 城市复杂场景下GNSS定位的因子图优化方法及其抗差性能分析[J]. 武汉大学学报(信息科学版)202348(7): 1050-1057.
  ZHANG X H, ZHANG Y T, ZHU F. Factor graph optimization for urban environment GNSS positioning and robust performance analysis[J]. Geomatics and Information Science of Wuhan University202348(7): 1050-1057 (in Chinese).
文章导航

/