基于三维坐标旋转补偿和动态滤波的双向地基定位方法

本发明涉及导航定位、航天测控，具体涉及一种基于三维坐标旋转补偿和动态滤波的双向地基定位方法。

背景技术：

1、基于双向测量的地基定位在导航定位、航天测控中具有广泛的应用。

2、在地基站和航天器进行双向测量时，地球自转和信号处理延时期间航天器的机动，会导致上行和下行传输延时不相等。地球自转和航天器在信号处理延时期间的机动，改变了地基站和航天器在惯性坐标系下的位置，导致上行和下行传输链路不一致，进而使得上行和下行传输延时不相等。然而，在传统双向地基定位观测模型中，认为无线电信号在航天器和地基站间的双向传输延时相同，这种模型误差会导致双向地基定位精度变差。将造成传输延时不一致的因素进行建模和补偿，可以有效提高双向定位精度，在航天测控中具有十分重要的意义。

3、在2018年8月ieee transactions on ultrasonics,ferroelectrics,andfrequency control期刊第65卷，第8期1475-1486页的“an improved protocol forperforming two-way satellite time and frequency transfer using a satellite inan inclined geo-synchronous orbit”中，在已知地基站和航天器坐标的前提下，对地球自转导致的双向传输延时不一致特性进行了建模和补偿。另外，通过测量航天器相对地基站的俯仰角和方位角，将地球自转造成的地基站位移矢量，投影到地基站和航天器间的径向矢量上，可以一定程度上补偿地球自转导致的双向传输延时不一致特性，相比认为双向传输链路对称下传输延时相同的方法，可以提高定位精度，但该补偿方法仍然存在一定的缺陷，短时间内将地基站随地球自转的运动，近似为一维匀速直线运动的模型假设，存在模型误差，并且需要准确的角度测量值计算补偿量。

4、因此如何将因地球自转和航天器机动导致的对双向传输延时不一致因素去除，从而实现更为准确的定位，是目前尚未解决的问题。

技术实现思路

1、有鉴于此，本发明提供了一种基于三维坐标旋转补偿和动态滤波的双向地基定位方法，能够根据实际无线电信号传输路径，在观测方程中将地球自转和航天器机动等，造成双向传输延时不一致的因素，通过三维坐标旋转矩阵进行建模，根据估计的航天器状态，将航天器位置和速度，对齐到待定位时刻的地固坐标系中，获得更为精确的定位结果。

2、为达到上述目的，本发明的技术方案为：利用双向地基定位系统对航天器进行定位，双向地基定位系统由多个钟差已知的固定地基站组成，该双向地基定位方法包括如下步骤：

3、收集所有地基站在一次双向地基定位期间获得的相位差。

4、根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到离散形式的状态更新方程，利用状态更新方程根据历史信息预测得到当前航天器预测状态。

5、获取航天器的观测值，利用观测值修正当前航天器预测状态，得到当前航天器估计状态，其中包含航天器位置估计值和速度估计值。

6、根据航天器位置估计值获得传输延时，并将航天器坐标修正到待定位时刻的地心地固坐标系中，坐标系修正后得到航天器在待定位时刻地固坐标系下的三维位置和速度。

7、进一步地，收集所有地基站在一次双向地基定位期间获得的相位差，具体为：每次定位期间地基站i发射上行信号，信号经过上行传输延时τui后被航天器接收；航天器采样上行信号相位，并经过信号处理延时tp后发送下行信号给地基站；信号经过下行传输延时τdi后被地基站i接收，同时地基站i对下行信号的相位进行采样和解帧，获得航天器采样的上行相位，并计算得到上行和下行相位差将所有地基站在一次双向地基定位期间获得的相位差收集并记为其中n为地基站数目。

8、进一步地，根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到离散形式的状态更新方程，利用状态更新方程根据历史信息预测得到当前航天器预测状态，具体为：

9、根据动力学建模获得的航天器状态空间方程为

10、

11、其中pm为航天器位置，为pm的一阶导数；vm为航天器的速度；为航天器燃料推进力对应的加速度，为航天器所受空气阻力对应的加速度，为航天器重力对应加速度，为航天器所受科里奥利力对应的加速度，为航天器向心力对应的加速度；

12、待定位航天器的状态为k时刻时间一步预测的输入为上一时刻估计得到的航天器状态xm(k-1)、输入向量u(k-1)和后验均方误差阵p(k-1)，输出为时间一步预测状态和先验估计均方误差阵根据(1)得到离散形式状态更新方程为

13、

14、其中a为状态转移矩阵、b为噪声分配矩阵，q为过程噪声协方差阵；

15、

16、其中，t动态滤波更新时间，i3×3为维度为3×3的单位阵，σ1为扩散系数；利用上述离散形式状态更新方程根据历史信息预测得到当前航天器预测状态。

17、进一步地，获取航天器的观测值，利用观测值修正当前航天器预测状态，得到当前航天器估计状态，具体为：

18、k时刻航天器预测状态为k时刻的观测向量为y(k)和先验均方误差阵k时刻航天器估计状态为和后验估计均方误差阵为p(k)：

19、

20、其中k(k)为卡尔曼增益，h(k)为非线性观测方程的雅克比矩阵，ν(k)为残差向量。

21、根据双向地基定位期间，实际无线电信号传输情况，得到地基站i的时差观测模型

22、

23、其中fpn为码速率，c为光速，为相位差集合，pm为航天器位置，c(·)代表地球自转有关的旋转矩阵，δ为其他地基站与地基站i的钟差，pg为地基站位置，vm为航天器的速度，tp为信号处理延时，am为航天器加速度，为上行和下行传输延时总和，η为零均值方差为σ的高斯噪声。

24、在上行和下行通信链路获得多普勒频移观测量为fd：

25、

26、其中，fd为多普勒频移观测量，vg为地基站发射上行信号时刻地固坐标系下的速度，对于固定地基站速度为0，ωi为零均值均方差为σfi的高斯噪声。

27、由此获得航天器位置估计值，航天器位置估计值记为

28、进一步地，根据航天器位置估计值获得传输延时，并将航天器坐标修正到待定位时刻的地心地固坐标系中，坐标系修正后得到航天器在待定位时刻地固坐标系下的三维位置和速度，具体为：

29、根据卡尔曼滤波得到估算航天器位置和地基站位置计算上行传输延时进而将这段时间内的地球自转引起的位置和速度修正为

30、

31、其中为单边传输延时。

32、坐标系修正后完成航天器在待定位时刻地固坐标系下的三维位置和速度。

33、有益效果：

34、本发明利用三维坐标旋转矩阵，对双向地基定位期间，地球自转和航天器机动等，造成双向传输延时不一致的因素进行三维建模，构建非对称双向测量模型，并通过卡尔曼动态滤波完成双向地基定位。相对于常规认为双向传输延时一致的地基定位方法，和将地基站位移投影到径向矢量上补偿双向传输延时不一致的地基定位方法，本方法观测模型更加符合实际无线电信号传输特性，因此定位精度更高。此外，本方法不需要高精度的角度测量对传输延时不一致特性进行补偿。