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

本发明专利技术公开了基于三维坐标旋转补偿和动态滤波的双向地基定位方法，涉及导航定位、航天测控技术领域，该方法包括如下步骤：收集所有地基站在一次双向地基定位期间获得的相位差；根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到离散形式的状态更新方程，利用状态更新方程根据历史信息预测得到当前航天器预测状态；获取航天器的观测值，利用观测值修正当前航天器预测状态，得到当前航天器估计状态，其中包含航天器位置估计值和速度估计值；根据航天器位置估计值获得传输延时，并将航天器坐标修正到待定位时刻的地心地固坐标系中，坐标系修正后得到航天器在待定位时刻地固坐标系下的三维位置和速度。在待定位时刻地固坐标系下的三维位置和速度。在待定位时刻地固坐标系下的三维位置和速度。

【技术实现步骤摘要】
基于三维坐标旋转补偿和动态滤波的双向地基定位方法


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

技术介绍

[0002]基于双向测量的地基定位在导航定位、航天测控中具有广泛的应用。
[0003]在地基站和航天器进行双向测量时，地球自转和信号处理延时期间航天器的机动，会导致上行和下行传输延时不相等。地球自转和航天器在信号处理延时期间的机动，改变了地基站和航天器在惯性坐标系下的位置，导致上行和下行传输链路不一致，进而使得上行和下行传输延时不相等。然而，在传统双向地基定位观测模型中，认为无线电信号在航天器和地基站间的双向传输延时相同，这种模型误差会导致双向地基定位精度变差。将造成传输延时不一致的因素进行建模和补偿，可以有效提高双向定位精度，在航天测控中具有十分重要的意义。
[0004]在2018年8月IEEE TRANSACTIONS ON ULTRASONICS,FERROELECTRICS,AND FREQUENCY CONTROL期刊第65卷，第8期1475
‑
1486页的“An Improved Protocol for Performing Two
‑
Way Satellite Time and Frequency Transfer Using a Satellite in an Inclined Geo
‑
Synchronous Orbit”中，在已知地基站和航天器坐标的前提下，对地球自转导致的双向传输延时不一致特性进行了建模和补偿。另外，通过测量航天器相对地基站的俯仰角和方位角，将地球自转造成的地基站位移矢量，投影到地基站和航天器间的径向矢量上，可以一定程度上补偿地球自转导致的双向传输延时不一致特性，相比认为双向传输链路对称下传输延时相同的方法，可以提高定位精度，但该补偿方法仍然存在一定的缺陷，短时间内将地基站随地球自转的运动，近似为一维匀速直线运动的模型假设，存在模型误差，并且需要准确的角度测量值计算补偿量。
[0005]因此如何将因地球自转和航天器机动导致的对双向传输延时不一致因素去除，从而实现更为准确的定位，是目前尚未解决的问题。

技术实现思路

[0006]有鉴于此，本专利技术提供了一种基于三维坐标旋转补偿和动态滤波的双向地基定位方法，能够根据实际无线电信号传输路径，在观测方程中将地球自转和航天器机动等，造成双向传输延时不一致的因素，通过三维坐标旋转矩阵进行建模，根据估计的航天器状态，将航天器位置和速度，对齐到待定位时刻的地固坐标系中，获得更为精确的定位结果。
[0007]为达到上述目的，本专利技术的技术方案为：利用双向地基定位系统对航天器进行定位，双向地基定位系统由多个钟差已知的固定地基站组成，该双向地基定位方法包括如下步骤：
[0008]收集所有地基站在一次双向地基定位期间获得的相位差。
[0009]根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到
离散形式的状态更新方程，利用状态更新方程根据历史信息预测得到当前航天器预测状态。
[0010]获取航天器的观测值，利用观测值修正当前航天器预测状态，得到当前航天器估计状态，其中包含航天器位置估计值和速度估计值。
[0011]根据航天器位置估计值获得传输延时，并将航天器坐标修正到待定位时刻的地心地固坐标系中，坐标系修正后得到航天器在待定位时刻地固坐标系下的三维位置和速度。
[0012]进一步地，收集所有地基站在一次双向地基定位期间获得的相位差，具体为：每次定位期间地基站i发射上行信号，信号经过上行传输延时τ
ui
后被航天器接收；航天器采样上行信号相位，并经过信号处理延时T
p
后发送下行信号给地基站；信号经过下行传输延时τ
di
后被地基站i接收，同时地基站i对下行信号的相位进行采样和解帧，获得航天器采样的上行相位，并计算得到上行和下行相位差将所有地基站在一次双向地基定位期间获得的相位差收集并记为其中N为地基站数目。
[0013]进一步地，根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到离散形式的状态更新方程，利用状态更新方程根据历史信息预测得到当前航天器预测状态，具体为：
[0014]根据动力学建模获得的航天器状态空间方程为
[0015][0016]其中p
m
为航天器位置，为p
m
的一阶导数；v
m
为航天器的速度；为航天器燃料推进力对应的加速度，为航天器所受空气阻力对应的加速度，为航天器重力对应加速度，为航天器所受科里奥利力对应的加速度，为航天器向心力对应的加速度；
[0017]待定位航天器的状态为k时刻时间一步预测的输入为上一时刻估计得到的航天器状态X
m
(k
‑
1)、输入向量U(k
‑
1)和后验均方误差阵P(k
‑
1)，输出为时间一步预测状态和先验估计均方误差阵根据(1)得到离散形式状态更新方程为
[0018][0019]其中A为状态转移矩阵、B为噪声分配矩阵，Q为过程噪声协方差阵；
[0020][0021]其中，T动态滤波更新时间，I3×3为维度为3
×
3的单位阵，σ1为扩散系数；利用上述离散形式状态更新方程根据历史信息预测得到当前航天器预测状态。
[0022]进一步地，获取航天器的观测值，利用观测值修正当前航天器预测状态，得到当前航天器估计状态，具体为：
[0023]k时刻航天器预测状态为k时刻的观测向量为Y(k)和先验均方误差阵k时刻航天器估计状态为和后验估计均方误差阵为P(k)：
[0024][0025]其中K(k)为卡尔曼增益，H(k)为非线性观测方程的雅克比矩阵，ν(k)为残差向量。
[0026]根据双向地基定位期间，实际无线电信号传输情况，得到地基站i的时差观测模型
[0027][0028]其中f
PN
为码速率，c为光速，为相位差集合，p
m
为航天器位置，C(
·
)代表地球自转有关的旋转矩阵，Δ为其他地基站与地基站i的钟差，p
g
为地基站位置，v
m
为航天器的速度，T
p
为信号处理延时，a
m
为航天器加速度，为上行和下行传输延时总和，η为零均值方差为σ的高斯噪声。
[0029]在上行和下行通信链路获得多普勒频移观测量为f
d
：
[0030][0031]其中，f
d
为多普勒频移观测量，v
g
为地基站发射上行信号时刻地固坐标系下的速度，对于固定地基站速度为0，ω
i
为零均值均方差为σ
fi
的高斯噪声。
[0032本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于三维坐标旋转补偿和动态滤波的双向地基定位方法，其特征在于，该方法利用双向地基定位系统对航天器进行定位，所述双向地基定位系统由多个钟差已知的固定地基站组成，该双向地基定位方法包括如下步骤：收集所有地基站在一次双向地基定位期间获得的相位差；根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到离散形式的状态更新方程，利用所述状态更新方程根据历史信息预测得到当前航天器预测状态；获取航天器的观测值，利用观测值修正当前航天器预测状态，得到当前航天器估计状态，其中包含航天器位置估计值和速度估计值；根据所述航天器位置估计值获得传输延时，并将航天器坐标修正到待定位时刻的地心地固坐标系中，坐标系修正后得到航天器在待定位时刻地固坐标系下的三维位置和速度。2.如权利要求1所述的基于三维坐标旋转补偿和动态滤波的双向地基定位方法，其特征在于，所述收集所有地基站在一次双向地基定位期间获得的相位差，具体为：每次定位期间地基站i发射上行信号，信号经过上行传输延时τ
ui
后被航天器接收；航天器采样上行信号相位，并经过信号处理延时T
p
后发送下行信号给地基站；信号经过下行传输延时τ
di
后被地基站i接收，同时地基站i对下行信号的相位进行采样和解帧，获得航天器采样的上行相位，并计算得到上行和下行相位差将所有地基站在一次双向地基定位期间获得的相位差收集并记为其中N为地基站数目。3.如权利要求1或2所述的基于三维坐标旋转补偿和动态滤波的双向地基定位方法，其特征在于，所述根据动力学建模获得航天器状态空间方程，根据航天器状态空间方程进一步得到离散形式的状态更新方程，利用所述状态更新方程根据历史信息预测得到当前航天器预测状态，具体为：所述根据动力学建模获得的航天器状态空间方程为其中p
m
为航天器位置，为p
m
的一阶导数；v
m
为航天器的速度；为航天器燃料推进力对应的加速度，为航天器所受空气阻力对应的加速度，为航天器重力对应加速度，为航天器所受科里奥利力对应的加速度，为航天器向心力对应的加速度；待定位航天器的状态为k时刻时间一步预测的输入为上一时刻估计得到的航天器状态X
m
(k
‑
1)、输入向量U(k
‑
1)和后验均方误差阵P(k
‑

【专利技术属性】
技术研发人员：王永庆，申宇瑶，杨振华，陈岩，何宜根，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：