Please wait a minute...
浙江大学学报(工学版)  2023, Vol. 57 Issue (11): 2325-2336    DOI: 10.3785/j.issn.1008-973X.2023.11.020
航空航天技术     
基于抗差自适应估计的微纳卫星相对定位算法
王昊泽(),金小军*(),侯聪,周立山,徐兆斌,金仲和
浙江大学 微小卫星研究中心,浙江 杭州 310027
Relative positioning algorithm based on robust adaptive estimation for micro-nano satellite
Hao-ze WANG(),Xiao-jun JIN*(),Cong HOU,Li-shan ZHOU,Zhao-bin XU,Zhong-he JIN
Micro-satellite Research Center, Zhejiang University, Hangzhou 310027, China
 全文: PDF(2308 KB)   HTML
摘要:

为了解决微纳卫星编队执行姿态机动任务时,差分定位性能降低甚至不能定位的问题,提出基于全视角天线组件的GPS接收和差分定位系统方案. 针对星载高动态环境,改进基于几何无关(GF)差分组合和衰减窗口的伪距粗差探测方法. 采用抗差自适应扩展卡尔曼滤波算法,将基于新息向量的观测噪声协方差矩阵开窗估计法应用于实时差分定位. 建立半物理仿真平台,开展不同场景下的差分定位性能对比验证. 结果表明,在全弧段侧摆与区间“侧摆-回正”机动条件下,所提出的基于全视角方案的滤波和估计算法相比于常规方案的扩展卡尔曼滤波(EKF)算法在定位星数、定位精度上均有大幅提升,在短、长基线情况下分别可以达到厘米、分米级的相对定位精度.

关键词: 实时相对定位微纳卫星GPS抗差自适应扩展卡尔曼滤波 (ARKF)全视角接收系统抗差估计Sage滤波    
Abstract:

A solution consisting of a GPS receiver and a differential positioning system with a full-view antenna assembly was proposed, to solve the problem of diminished or even non-functional positioning performance during attitude maneuvering tasks conducted by micro-nano satellites formations. In the context of spaceborne high-dynamic environments, improvements were made to the pseudorange gross error detection method based on geometry free (GF) differential combination and attenuation window. With the help of robust adaptive extended Kalman filtering algorithm, the open-window estimation method of the observed noise covariance matrix based on the innovation vector was applied to the real-time difference algorithm. Comparative validation in different scenarios was carried out upon a semi-physical simulation platform, and the results demonstrate that the proposed filtering and estimation algorithm based on the full-view scheme has a substantial increase in the number of satellite-used and positioning accuracy compared with the extended Kalmen filter (EKF) algorithm of the conventional scheme in full-arc side-swing and interval "side-swing-return" maneuvers. In short and long baseline cases, centimeter and decimeter level relative positioning accuracy can be achieved.

Key words: real-time relative orbit determination    micro-nano satellite    GPS    robust adaptive extended Kalmen filter (ARKF)    full-view receiving system    robust estimation    Sage filtering
收稿日期: 2022-12-07 出版日期: 2023-12-11
CLC:  P 228.4  
基金资助: 国家自然科学基金资助项目(62073289)
通讯作者: 金小军     E-mail: 22124024@zju.edu.cn;axemaster@zju.edu.cn
作者简介: 王昊泽(1999—),男,硕士生,从事星载GPS/BDS精密定轨技术研究. orcid.org/0009-0004-2118-7879. E-mail: 22124024@zju.edu.cn
服务  
把本文推荐给朋友
加入引用管理器
E-mail Alert
作者相关文章  
王昊泽
金小军
侯聪
周立山
徐兆斌
金仲和

引用本文:

王昊泽,金小军,侯聪,周立山,徐兆斌,金仲和. 基于抗差自适应估计的微纳卫星相对定位算法[J]. 浙江大学学报(工学版), 2023, 57(11): 2325-2336.

Hao-ze WANG,Xiao-jun JIN,Cong HOU,Li-shan ZHOU,Zhao-bin XU,Zhong-he JIN. Relative positioning algorithm based on robust adaptive estimation for micro-nano satellite. Journal of ZheJiang University (Engineering Science), 2023, 57(11): 2325-2336.

链接本文:

https://www.zjujournals.com/eng/CN/10.3785/j.issn.1008-973X.2023.11.020        https://www.zjujournals.com/eng/CN/Y2023/V57/I11/2325

图 1  星载GPS接收机的全视角天线安装示意图
伪距粗差探测方法 N n ${ {P} }_{ {{\rm{M}}} }$/m ${ {P} }_{ \rm{m} }$/m
GF组合的一阶差分项衰减窗口法 5735 50 16.84 2.15
高度角剔除法 5735 34 16.84 6.16
表 1  伪距粗差探测效果对比表
摄动力 轨道动力学模型
地球引力 JGM3(20阶)
日月引力 低精度解析式递推
太阳光压 地影模型
大气阻力 Harris-Priester密度模型
经验力 一阶马尔科夫过程
表 2  低轨卫星轨道动力学模型
图 2  ARKF算法流程图
图 3  实时相对定位算法流程图
图 4  全视角GPS接收系统
图 5  星载GPS定轨仿真实验流程图
图 6  GDOP分布图
系统 AR/cm AT/cm AN/cm A3D/cm n Pn/%
单天线差分(5 km) 9.94 7.62 4.49 13.30 96 1.76
单天线差分(50 km) 17.68 6.95 15.71 24.65 31 0.94
单天线差分(300 km)
全视角差分(5 km) 2.21 2.25 5.38 6.23 71 1.23
全视角差分(50 km) 5.83 7.48 7.49 12.09 50 0.87
全视角差分(300 km) 7.15 16.13 33.86 38.18 74 1.26
表 3  接收系统相对定位精度对比表
图 7  全弧度侧摆接收系统相对定位精度对比图
?L/km 案例 AR/cm AT/cm AN/cm A3D/cm
Case-(a) 2.21 2.25 5.38 6.23
5 Case-(b) 1.91 2.96 3.70 5.11
Case-(c) 1.29 2.01 3.15 3.95
Case-(a) 5.83 7.48 7.49 12.09
50 Case-(b) 3.55 7.99 3.71 9.49
Case-(c) 2.66 8.08 3.64 9.25
Case-(a) 7.15 16.13 33.86 38.18
300 Case-(b) 7.19 17.27 30.45 35.74
Case-(c) 7.15 16.10 33.86 38.17
表 4  多基线相对定位精度统计表
图 8  全弧度侧摆三轴位置误差对比图
图 9  全弧段侧摆相对定位精度对比图
图 10  定轨可用星数对比图
图 11  定轨弧段自适应因子变化图
?L/km n/个 Pn/% PM/m Pm/m
5 17 0.30 16.20 2.46
50 39 0.69 32.51 5.12
300 10 0.17 16.17 6.30
表 5  伪距粗差探测效果统计表
?L/km 案例 AR/cm AT/cm AN/cm A3D/cm
5 Case-(1)
Case-(2) 2.29 1.92 4.61 5.49
Case-(3) 2.89 1.86 2.70 4.37
Case-(4) 2.48 1.22 2.29 3.59
50 Case-(1)
Case-(2) 3.12 3.84 8.95 10.24
Case-(3) 2.37 5.07 6.04 8.24
Case-(4) 1.49 4.70 5.84 7.64
300 Case-(1)
Case-(2) 6.76 23.99 19.37 31.56
Case-(3) 8.74 22.60 19.20 30.91
Case-(4) 6.75 24.00 19.37 31.57
表 6  多基线机动相对定位精度统计表
图 12  机动三轴位置误差对比图
图 13  机动相对定位精度对比图
1 AMBROSINI M. The key role and advantages of GNSS Precise relative positioning in spacecraft formation flying missions design, analysis and operations [C]// Proceedings of the 2018 SpaceOps Conference. Marseille: SpaceOps, 2018.
2 BISNATH S. Relative positioning and real-time Kinematic (RTK) [M]// Position, navigation, and timing technologies in the 21st century: integrated satellite navigation, sensor systems, and civil applications. Hoboken: John Wiley & Sons, Inc 2020: 481-502.
3 KAWANO I, MOKUNO M, KASAI T, et al First autonomous rendezvous using relative GPS navigation by ETS‐VII[J]. Navigation, 2001, 48 (1): 49- 56
doi: 10.1002/j.2161-4296.2001.tb00227.x
4 EBINUMA T. Precision spacecraft rendezvous using global positioning system: an integrated hardware approach [M]. Ann Arbor: The University of Texas at Austin, 2001.
5 BUSSE F D. Precise formation-state estimation in low earth orbit using carrier differential GPS [M]. Ann Arbor: Stanford University, 2003.
6 LEUNG S, MONTENBRUCK O Real-time navigation of formation-flying spcacecraft using global-positioning- system measurements[J]. Journal of Guidance, Control, and Dynamics, 2005, 28 (2): 226- 235
doi: 10.2514/1.7474
7 D'AMICO S, ARDAENS J S, MONTENBRUCK O. Navigation of formation flying spacecraft using GPS: the PRISMA technology demonstration [C]// Proceedings of the Proceedings of the 22nd International Technical Meeting of the Satellite Division of The Institute of Navigation . Washington: ION, 2009: 2331-5911.
8 李仕学, 沈欣, 姚璜, 等 面向区域成像任务的环月卫星侧摆角优化方法[J]. 武汉大学学报: 信息科学版, 2019, 44 (4): 593- 600
LI Shi-xue, SHEN Xin, YAO Huang, et al Optimization method of circumlunar satellite lateral swing angle for regional imaging missions[J]. Journal of Wuhan University: Information Science Edition, 2019, 44 (4): 593- 600
9 CARLIN L, HAUSCHILD A, MONTENBRUCK O Precise point positioning with GPS and Galileo broadcast ephemerides[J]. GPS Solutions, 2021, 25 (2): 1- 13
10 MONTENBRUCK O, KUNZI F, HAUSCHILD A Performance assessment of GNSS-based real-time navigation for the Sentinel-6 spacecraft[J]. GPS Solutions, 2022, 26 (1): 1- 11
doi: 10.1007/s10291-021-01184-1
11 谢钢. GPS 原理与接收机设计 [M]. 北京: Electronics Industry Press, 2009.
12 ALKAN R M Cm-level high accurate point positioning with satellite-based GNSS correction service in dynamic applications[J]. Journal of Spatial Science, 2021, 66 (2): 351- 9
doi: 10.1080/14498596.2019.1643795
13 李林阳, 吕志平, 周海涛, 等 对 TurboEdit 周跳探测及修复算法的改进[J]. 测绘科学技术学报, 2015, 32 (2): 140- 145
LI Lin-yang, LV Zhi-ping, ZHOU Hai-tao, et al Improvement to TurboEdit weekly jump detection and repair algorithm[J]. Journal of Surveying and Mapping Science and Technology, 2015, 32 (2): 140- 145
14 孙荣恒, 伊亨云, 刘琼荪, 等. 概率论和数理统计[M]. 重庆: 重庆大学出版社, 2000.
15 BLEWITT G An automatic editing algorithm for GPS data[J]. Geophysical Research Letters, 1990, 17 (3): 199- 202
doi: 10.1029/GL017i003p00199
16 LIU H, XIN M, WEI J, et al GNSS doppler velocity based on adaptive robust Kalman filtering[J]. The International Archives of Photogrammetry, Remote Sensing and Spatial Information Sciences, 2020, 42: 1005- 1012
17 OLIVER M, GILL E. 卫星轨道: 模型, 方法和应用 [M]. 王家松, 祝开建, 胡小工, 译. 北京: 国防工业出版社, 2012.
18 MEHRA R Approaches to adaptive filtering[J]. IEEE Transactions on Automatic Control, 1972, 17 (5): 693- 698
doi: 10.1109/TAC.1972.1100100
19 李兆洋. 基于自适应卡尔曼滤波的 GPS 精密单点定位研究 [D]. 成都: 西南交通大学, 2017.
LI Zhao-yang. Research on GPS precision single point positioning based on adaptive Kalman filter [D]. Chengdu: Southwest Jiaotong University, 2017
20 杨元喜. 自适应动态导航定位 [M]. 北京: 测绘出版社, 2006.
21 AVALLONE A, BRIOLE P, AGATZA-BALODIMOU A M, et al Analysis of eleven years of deformation measured by GPS in the Corinth Rift Laboratory area[J]. Comptes Rendus Geoscience, 2004, 336 (4/5): 301- 311
22 KROES R. Precise relative positioning of formation flying spacecraft using GPS [M]. Delft: Nederlandse Commissie voor Geodesie, Netherlands Geodetic Commission, 2006.
23 余鑫, 金小军, 莫仕明, 等 基于北斗 B3 频点的低轨卫星实时定轨性能评估[J]. 浙江大学学报: 工学版, 2020, 54 (3): 589- 596
YU Xin, JIN Xiao-jun, MO Shi-ming, et al Real-time orbiting performance evaluation of low-orbiting satellites based on BeiDou B3 frequency points[J]. Journal of Zhejiang University: Engineering Science, 2020, 54 (3): 589- 596
24 肖国锐, 隋立芬, 陈泉余, 等 利用接收机钟差建模提升 PPP 收敛速度及精度[J]. 测绘科学技术学报, 2015, 32 (6): 555- 558
XIAO Guo-rui, SUI Li-fen, CHEN Quan-yu, et al Improving the convergence speed and accuracy of PPP by using receiver clock difference modeling[J]. Journal of Surveying and Mapping Science and Technology, 2015, 32 (6): 555- 558
[1] 胡淼淼, 敬忠良, 董鹏, 周贵荣, 郑智明. 基于T分布变分贝叶斯滤波的SINS/GPS组合导航[J]. 浙江大学学报(工学版), 2018, 52(8): 1482-1488.
[2] 赵文杰,方舟,李平. 基于地磁场矢量误差反馈的姿态补偿算法[J]. 浙江大学学报(工学版), 2014, 48(9): 1704-1709.
[3] 赵文杰,方舟,李平. 基于地磁场矢量误差反馈的姿态补偿算法[J]. J4, 2014, 48(4): 0-00.
[4] 徐玉 李平 韩波. 微型无人直升机姿态测量系统设计与实现[J]. J4, 2009, 43(1): 172-176.
[5] 徐旭松 杨将新 曹衍龙 茅健. 渐开线圆柱斜齿轮齿面的公差建模[J]. J4, 2008, 42(11): 1946-1950.
[6] 许峰 赵民建 沈雷 李式巨. 一种基于相位差分的GPS比特同步方法[J]. J4, 2007, 41(12): 2031-2035.
[7] 裘正军 宋海燕 何勇 林丽兰. 基于虚拟仪器的农田信息采集与处理系统[J]. J4, 2006, 40(11): 1931-1936.