基于抗差自适应估计的微纳卫星相对定位算法
Relative positioning algorithm based on robust adaptive estimation for micro-nano satellite
通讯作者:
收稿日期: 2022-12-7
基金资助: |
|
Received: 2022-12-7
Fund supported: | 国家自然科学基金资助项目(62073289) |
作者简介 About authors
王昊泽(1999—),男,硕士生,从事星载GPS/BDS精密定轨技术研究.orcid.org/0009-0004-2118-7879.E-mail:
为了解决微纳卫星编队执行姿态机动任务时,差分定位性能降低甚至不能定位的问题,提出基于全视角天线组件的GPS接收和差分定位系统方案. 针对星载高动态环境,改进基于几何无关(GF)差分组合和衰减窗口的伪距粗差探测方法. 采用抗差自适应扩展卡尔曼滤波算法,将基于新息向量的观测噪声协方差矩阵开窗估计法应用于实时差分定位. 建立半物理仿真平台,开展不同场景下的差分定位性能对比验证. 结果表明,在全弧段侧摆与区间“侧摆-回正”机动条件下,所提出的基于全视角方案的滤波和估计算法相比于常规方案的扩展卡尔曼滤波(EKF)算法在定位星数、定位精度上均有大幅提升,在短、长基线情况下分别可以达到厘米、分米级的相对定位精度.
关键词:
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.
Keywords:
本文引用格式
王昊泽, 金小军, 侯聪, 周立山, 徐兆斌, 金仲和.
WANG Hao-ze, JIN Xiao-jun, HOU Cong, ZHOU Li-shan, XU Zhao-bin, JIN Zhong-he.
实时动态测量技术(real-time kinematic,RTK)是基于载波相位的动态差分技术,其工作原理为通过对观测量做差,减弱甚至消除公共误差,从而达到提升定位精度的目的. 对于高动态以及需要高精度定位的场景具有重要意义,广泛应用于测量领域,本研究即针对低轨卫星双星编队对RTK技术展开研究[1-2]. 20世纪90年代,由日本宇宙事业开发集团(national space development agency of Japan,NASDA)指定的ETS-VII任务,首次使用星载GPS差分技术,以星载GPS伪距作为基本观测量用于后续的差分处理,并选择扩展卡尔曼滤波(extended Kalman filter,EKF)作为该任务的滤波算法,最终取得了小于10 m的实时相对位置精度(3DRMS)(3DRMS表示三维均方根)以及1 cm/s的速度精度(3DRMS)[3],远高于任务需求,证实了星载差分GPS技术在航天任务中的可行性和有效性. 随着技术的发展,不少学者开始借助半物理仿真平台开展星载GPS差分技术的研究. Ebinuma等[4]借助GSS STR 4760模拟器,采用载波相位双差技术,对2颗基线距离为0~10 km的卫星展开研究,最终获得了小于5 cm的实时相对位置精度(3DRMS)以及1 mm/s的速度精度(3DRMS). Busse[5]基于GPS模拟和分析工具包(GPS simulation and analysis toolkit,GSAT)对相距1 km的椭圆形卫星编队进行数据的分析与处理,使用载波相位单差技术,最终获得了小于2 cm (1
卫星在太空中会有一些特殊的姿态要求,其中最常见的就是卫星侧摆,通常见于光学成像、对地凝视任务. 由于低轨卫星轨道高度较低,直接对地观测的成像幅宽较小,须调整卫星姿态,采用侧摆技术来提高对地观测效率[8]. 这样就会对星间GPS测量产生负面影响,最直接的影响就是减少了共视星的数目,从而降低了相对定位的精度,在中长基线场景下甚至还会导致无法定位. 为了解决上述问题,本研究提出基于全视角星载GPS接收系统的低轨卫星实时相对定位方法. 该系统采用全视角天线,使可视卫星范围大大提高,从而提升相对定位性能. 针对星载高动态环境,提出基于几何无关(geometry free, GF)差分组合和衰减窗口的伪距粗差探测方法,同时基于抗差自适应扩展卡尔曼滤波(robust adaptive extended Kalmen filter, ARKF),在短基线下使用基于新息向量的观测噪声协方差矩阵开窗估计法来代替传统方法.
1. 数据质量控制
接收系统采用基于全视角天线的星载GPS接收结构,用以增强相对定位性能,其中3副天线分别安装于等三角锥底座的3个侧面上,且三角锥的侧面与底面的夹角互呈60°,使得天线组件能够接收到的导航信号覆盖±120°空域范围. 具体结构如图1所示.
图 1
图 1 星载GPS接收机的全视角天线安装示意图
Fig.1 Installation diagram of full-view antenna assembly of satellite-based GPS receiver
单根天线只能覆盖所在平面法线±60°范围,因此要实现全视角覆盖,至少需要3根天线,通过这种设计,全视角天线能够在±120°空域范围,即在低轨卫星轨道的全视角范围内保证较高的天线增益,从而保证有效接收全视角范围内的导航卫星信号. 同时,即使卫星执行较大幅度的机动,卫星定位或者卫星编队相对定位仍能收到足够多的导航星信号从而保证性能. 须说明的是,全视角天线的相位中心已在接收机内部进行了归一化处理. 作为对比,传统单天线方案是将一副天线安装于卫星对天面,GPS接收机仅能在相对较小的视角范围内收到导航信号,当卫星执行机动时,卫星定位或者卫星编队相对定位的性能有可能大幅下降甚至定位失败.
1.1. 粗差探测
1.1.1. 观测模型
全视角星载GPS接收系统的伪距和载波相位观测方程可以表示为
式中:
式中:
很多观测量的误差项具有空间、时间相关性,因此可以通过差分的方式消除掉公共误差,从而提升定位精度,本研究采用无电离层单差观测组合[11]. 用户u和基准站b对卫星i的单差载波相位
式中:
1.1.2. 基于几何无关(GF)差分组合和衰减窗口的伪距粗差探测方法
接收机观测数据质量的优劣直接影响卫星定位和星间基线测量结果,因此接收机观测质量分析与控制是获取高精度定位结果的基本前提[12].
基于TurboEdit算法的改进[13]提出基于几何无关(GF)差分组合和衰减窗口的伪距粗差探测方法,对较大粗差进行探测、剔除,对于较小粗差则使用抗差滤波算法进行处理. 其中GF组合
GF组合的一阶差分项
式中:
式中:
式中:σW为粗差检验量的标准差,σp为伪距噪声标准差.
简化得到
本研究中取a=9, b=3, m=20.
前向衰减窗口平均值
则基于衰减窗口的伪距GF组合一阶差分项只须满足以下条件即可认为此历元的伪距测量值为粗差:
式中:
考虑到电离层在每个时段的变化趋势不一样,以当前时段的电离层变化量作为参考,可以增加粗差探测的成功率,如果单纯以伪距GF组合一阶差分项作为判别标准,在电离层活动较为频繁的情况下,难免会发生粗差探测错误、甚至失败的情况,进而影响定位解算质量.
借助半物理平台进行验证,采用思博伦GSS9000型号的导航信号模拟器产生轨道高度500 km 的GPS L1C/A、GPS L2C 双频民码信号,通过射频线连接到L1/L2双频星载GPS接收机进行数据采集. 在某些卫星的连续观测历元可能存在粗差,进而导致该卫星模糊度重新初始化,影响收敛时间,因此,规定只有在连续锁定历元大于5且不存在粗差的情况下,才可参与定位解算.
采用高度角剔除法作为对比试验以验证本研究所提方法的优势,其中对于单天线接收系统,截止高度角一般选择 5°~10°. 本研究使用的全视角接收系统可视区域为±120°,对应截止高度角范围为−25°~−20°,本研究选取截止高度角为−20°. 如表1所示展示了2种方法的探测效果. 表中,N表示伪距粗差探测采样点个数,n表示探测粗差总个数,
表 1 伪距粗差探测效果对比表
Tab.1
伪距粗差探测方法 | N | n | | |
GF组合的一阶差分项衰减窗口法 | 5735 | 50 | 16.84 | 2.15 |
高度角剔除法 | 5735 | 34 | 16.84 | 6.16 |
1.2. 周跳探测
周跳是接收机在连续跟踪信号的过程中,接收机计数器中断或者信号传播途中被障碍物遮挡亦或是卫星仰角过低致使观测质量变差,最终导致载波相位发生跳变. 目前在导航领域常用的周跳探测手段为TurboEdit算法[15],主要基于Melbourne-Wübbena(MW)组合和GF组合对测量值进行处理,可以覆盖大部分的周跳情况,从而剔除超过判别门限的数据.
2. 实时差分定位技术研究
2.1. 抗差自适应扩展卡尔曼滤波
低轨卫星所处空间环境较为复杂,并且全视角接收系统的信号覆盖范围较大,很难保证所有卫星信号质量,为此本研究选用抗差自适应扩展卡尔曼滤波作为研究的滤波算法[16].
2.1.1. 自适应因子求解
在观测值可靠的情况下,预测残差向量能反映动力学模型误差的大小,可以通过比较理论预测残差协方差
式中:
由式(17)~(20)可以看出,在ARKF算法中,当系统模型出现异常干扰时,会通过自适应因子对系统模型的协方差矩阵进行方差膨胀,从而降低预测信息对系统状态变量的影响. 当模型无异常干扰时,
2.1.2. 基于观测残差的抗差估计
自适应因子的求解是在测量值可靠的前提下进行的,一旦测量值存在粗差,就会将误差引入到最终的状态量中. 为了防止滤波发散,应时刻调整测量值噪声大小.
类似于预测残差,观测残差
式中:
式中:
2.1.3. 基于新息向量的Sage-Husa滤波
新息序列的实际协方差
式中:
式中:
然而,新息序列实际协方差的预测过程各历元残差要满足同类、同维且同分布,否则不能按照式(24)计算
式中:c、d为噪声系数,按照经验并结合开源软件rtklib相关部分,一般取0.3;E为高度角,经多次测试,选择与实际情况最符合,精度最高的arcsin 0.1 rad 作为本次测试的高度角参数. 对于载波相位测量噪声
在ARKF算法中,通过自适应因子的调节以及抗差滤波算法分别降低单历元下异常动力学模型以及异常观测数据对最终定位结果的影响.
2.2. 相对轨道动力学
在ARKF算法中选取状态变量
式中:r、v分别为卫星的相对位置、速度;
表 2 低轨卫星轨道动力学模型
Tab.2
摄动力 | 轨道动力学模型 |
地球引力 | JGM3(20阶) |
日月引力 | 低精度解析式递推 |
太阳光压 | 地影模型 |
大气阻力 | Harris-Priester密度模型 |
经验力 | 一阶马尔科夫过程 |
双星编队的相对动力学模型将两星的各自运动状态做差即可,其相对状态转移矩阵
式中:
图 2
图 3
图 3 实时相对定位算法流程图
Fig.3 Real-time relative orbit determination algorithm flow chart
3. 半物理平台仿真验证
图 4
图 5
图 5 星载GPS定轨仿真实验流程图
Fig.5 Flowchart of satellite-based GPS orbiting simulation experiment
3.1. GDOP
卫星几何分布优劣可以通过几何精度因子(geometric dilution precision,GDOP)表示,假设存在一个各颗可见卫星与GPS接收机为顶点所组成的单位边长的锥形多面体,则此锥面体的体积大致与GDOP成反比. 不难得出,接收机的可视范围越大,可视卫星越多,则卫星的几何分布越好,GDOP越小.
图 6
3.2. 相对定位精度
3.2.1. 全弧度侧摆
表 3 接收系统相对定位精度对比表
Tab.3
系统 | 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 |
图 7
图 7 全弧度侧摆接收系统相对定位精度对比图
Fig.7 Comparison of relative orbit determination of receiving systems in full-arc side-swing process
对于中长基线数据(300 km),单天线差分无法正确差分定位,全视角差分则可以达到分米级的相对定位精度,但是由于基线过长,有些误差不再具有很强的时间、空间上的相关性,且在侧摆情况下,观测星数受限,因此差分的优势无法最大程度地发挥.
对于短基线数据(5 、50 km),单天线差分虽然可以正确地定位解算,但是由于共视星数的限制,精度只能达到分米级水平. 全视角差分则增加了一倍左右的共视星数,在观测方程上有一定的冗余,分别可以达到厘米级、近厘米级的相对定位精度.
表 4 多基线相对定位精度统计表
Tab.4
∆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 |
图 8
图 8 全弧度侧摆三轴位置误差对比图
Fig.8 Three axis position error comparison chart in full-arc side-swing process
图 9
图 9 全弧段侧摆相对定位精度对比图
Fig.9 Comparison chart of relative orbit determination accuracy in full-arc side-swing process
根据仿真结果可以得到以下结论:
1) 整体对比3种基线定位结果,基线越短,相对定位精度越高,且其受基线长度影响程度较大,本次算法侧重实时性,并未使用精密星历、精密钟差事后产品,主要误差源除了模型修正外,主要依靠差分算法来抑制或者消除,基线越短,差分效果越明显,因此基线长度是实时算法中的重要因素.
3)对比3种基线的case-(a)和case-(b),相对定位精度提升分别在12.68%、22.08%和5.89%,证明基于观察残差的观测噪声等价协方差矩阵估计法可以适应大部分基线长度,且相对定位精度提升与基线长度没有明显关系.
4) 对比3种基线的case-(a)和case-(c),相对定位精度提升分别在36.60%、23.49%和0%,且基线长度越短,相对定位精度提升效果越好. 基线长度的增加,会导致部分误差时间、空间相关性下降,并且共视星平均高度角下降,进一步导致作为差分算法中主要误差源的多径效应带来的误差增大,从而使新息序列的理论方差预测难度增大,预测精度下降,在长基线情况下体现不出其明显优势.
5) 综合对比不同基线定位精度图,可以看出,在短基线情况下使用基于新息向量的观测噪声协方差矩阵开窗估计法可以得到较好的相对定位结果,最终定位精度可以达到厘米级;在长基线情况下,基于观察残差的观测噪声等价协方差矩阵估计法拥有比基于新息向量的观测噪声协方差矩阵开窗估计法更好的适用性,最终相对定位精度可以达到分米级.
3.2.2. 区间“侧摆-回正”过程
上述分析场景建立在极端场景下,即全弧段侧摆,旨在验证算法可行性. 为了进一步验证实际卫星编队任务,建立机动仿真场景,在正常对地姿态情况下,在第350历元附近,以
图 10
图 10 定轨可用星数对比图
Fig.10 Comparison of available tracking satellites for orbit determination
图 11
图 11 定轨弧段自适应因子变化图
Fig.11 Adaptive factor variation for orbit determination arc
图11反映了自适应因子随时间变化的情况. 除了收敛段个别历元,自适应因子调节历元大多集中在侧摆区间,这主要是由于卫星在侧摆区间,姿态发生较大变化,从而使得动力学模型误差增大. 但本研究对象为轨道高度为500 km的低轨卫星,其轨道高度大于GRACE、GOCE典型低轨卫星轨道高度,大气阻力模型之类的其他动力学模型更加精准,且研究平台为半实物平台,动力学模型均为已知状态,结合自适应因子的调节作用,使得动力学模型对定位结果的影响降到了最小.
表 5 伪距粗差探测效果统计表
Tab.5
∆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 |
表 6 多基线机动相对定位精度统计表
Tab.6
∆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 |
图 12
图 12 机动三轴位置误差对比图
Fig.12 Comparison chart of three axis position error in motorization process
图 13
图 13 机动相对定位精度对比图
Fig.13 Comparison chart of relative orbit determination accuracy in motorization process
根据仿真结果可以得到以下结论.
2) 对比图12中各基线长度下case-(1)与case-(2)~ case-(4),单天线接收系统对部分可观测卫星来说在侧摆区间会经历由失锁到重新捕获的过程,而接收机重新捕获则需要一个过程,因此观测星数不能及时随侧摆阶段的结束而恢复正常,进而导致定位精度存在较长时间大幅度抖动,而全视角接收系统则由于其较多的观测星数而基本不受影响,进一步证明了本研究提出的新方法在应用场景的可行性.
4) 对比图13各基线下case-(3)、 case-(4),2种情况下相对定位精度差别较小,证明在低轨卫星高动态场景下,可用星数仍是制约相对定位精度的主要因素,本研究提出的伪距粗差探测方法以及使用的2种观测噪声协方差矩阵估计法仅起辅助作用,且随着整体相对定位精度的提升,观测质量以及观测噪声协方差矩阵对相对定位精度影响的权重逐渐降低.
4. 结 语
半物理仿真结果表明,在全弧段侧摆与机动条件下,本研究所提出的新方法相比于单天线方案,可用星数大幅增加、相对定位精度大幅提升;在短基线情况下,使用基于新息向量的观测噪声协方差矩阵开窗估计法可以达到厘米级的相对定位精度,在长基线情况下,使用基于观察残差的观测噪声等价协方差矩阵估计法可以达到分米级相对定位精度. 本研究的目的在于突出全视角接收系统相对于单天线接收系统的优势以及抗差滤波算法的优越性,为了在简化算法的同时达到实验目的,选择了浮点解作为量化指标. 出于本项目特殊的应用场景以及独特的接收系统设计构造,模糊度的固定方法与常规固定方法有所不同,后续将单独对此进行更深入的研究. 本研究提出的新方法适用于搭载全视角接收系统的微纳卫星编队实时相对定位,并可在全弧段侧摆与机动条件下,实现高精度、稳定的编队相对定位. 未来有望应用于微纳卫星编队光学成像、对地凝视之类的特殊姿态任务中.
参考文献
First autonomous rendezvous using relative GPS navigation by ETS‐VII
[J].DOI:10.1002/j.2161-4296.2001.tb00227.x [本文引用: 1]
Real-time navigation of formation-flying spcacecraft using global-positioning- system measurements
[J].
面向区域成像任务的环月卫星侧摆角优化方法
[J].
Optimization method of circumlunar satellite lateral swing angle for regional imaging missions
[J].
Precise point positioning with GPS and Galileo broadcast ephemerides
[J].
Performance assessment of GNSS-based real-time navigation for the Sentinel-6 spacecraft
[J].DOI:10.1007/s10291-021-01184-1 [本文引用: 1]
Cm-level high accurate point positioning with satellite-based GNSS correction service in dynamic applications
[J].DOI:10.1080/14498596.2019.1643795 [本文引用: 1]
对 TurboEdit 周跳探测及修复算法的改进
[J].
Improvement to TurboEdit weekly jump detection and repair algorithm
[J].
An automatic editing algorithm for GPS data
[J].DOI:10.1029/GL017i003p00199 [本文引用: 1]
GNSS doppler velocity based on adaptive robust Kalman filtering
[J].
Approaches to adaptive filtering
[J].DOI:10.1109/TAC.1972.1100100 [本文引用: 1]
Analysis of eleven years of deformation measured by GPS in the Corinth Rift Laboratory area
[J].
基于北斗 B3 频点的低轨卫星实时定轨性能评估
[J].
Real-time orbiting performance evaluation of low-orbiting satellites based on BeiDou B3 frequency points
[J].
利用接收机钟差建模提升 PPP 收敛速度及精度
[J].
Improving the convergence speed and accuracy of PPP by using receiver clock difference modeling
[J].
/
〈 |
|
〉 |
