一种基于惯导系统量测滞后的动中通天线跟踪控制方法
【技术领域】
[0001] 本发明提供了一种基于惯导系统量测滞后的动中通天线跟踪控制方法，适用于要 求系统大动态下保持高精度卫星跟踪能力的场合，属于卫星通讯技术领域。
【背景技术】
[0002] 基于惯导方案的动中通天线系统的卫星跟踪控制主要是依赖惯导系统能实时解 算出载体的俯仰角P、滚动角R和航向角Y信息，再通过坐标转换引导天线隔离载体运动维 持天线始终指向目标卫星。惯导系统进行姿态解算时，前一个控制周期进行仪表数据采样， 下一个控制周期进行仪表数据解算，这样解算出的载体姿态比实际姿态延迟了一个控制周 期。另外，惯导系统为保证某些系统特性，有时会对仪表进行滤波，而不同阶次的滤波器也 必然会造成系统不同程度的量测延迟，同样会引起载体姿态的滞后输出。当系统根据滞后 的载体姿态信息控制天线指向目标卫星，必然会影响天线指向目标卫星的精度，尤其在大 动态情况下，载体较大的量测滞后会带来天线的较大跟踪延迟，从而严重影响天线的卫星 指向精度。
[0003] 因此，如何解决由于惯导系统量测滞后造成的天线跟踪卫星精度下降的问题，实 现大动态下天线高精度卫星指向功能，是基于惯导方案动中通系统的一个难点。
【发明内容】
[0004] 本发明的技术解决问题：克服现有技术的不足，提供了一种基于惯导系统量测滞 后的动中通天线跟踪控制方法，解决了由于惯导系统量测滞后造成的天线跟踪卫星精度下 降的问题。
[0005] 本发明的技术解决方案：
[0006] -种基于惯导系统量测滞后的动中通天线跟踪控制方法，步骤如下：
[0007] (1)进入天线跟踪状态时，预设超前驱动系数K。?。彡1. 0)，设置控制周期定时器T 和补偿标志MFlag，初值均为零；读取天线俯仰角和方位角值，存入数组变量fAInc_old[2] 中；
[0008] (2)控制周期定时器T开始计时，当达到预定控制时间后，进入步骤（3);
[0009] (3)根据惯导系统的导航信息解算出本周期天线俯仰角fPitch和方位角 fYaw，存入数组变量fAInc[2]中，并计算本周期天线俯仰和方位驱动角度fDrv[2]= fAInc[2]-fAInc_old[2];判断补偿标志MFLAG是否有效，MFLAG = 0时表示无效，MFLAG = 1时表示有效，若补偿标志MFLAG无效则执行步骤（a);若补偿标志MFLAG有效，则执行步骤 (b)；
[0010] (a)计算天线俯仰角和方位角的超前驱动补偿量fPulse[2] = K。· fDrv[2]，并设 置补偿标志MFlag有效，即MFlag = 1，之后进入步骤（4);
[0011] (b)计算天线俯仰角和方位角的超前驱动补偿量fPulse[2]= 1(0*(^)^[2]-^^￥_01(1[2])，之后进入步骤（4);
[0012] (4)根据超前驱动补偿量fPulse[2]解算出天线俯仰角和方位角本周期补偿后驱 动角度fModify[2] = fDrv[2]+fPulse[2]，并发送给天线控制系统驱动天线转动，之后进 入步骤（5);
[0013] (5)设置上周期天线俯仰角和方位角数组变量fAInc [2] = fAInc_oId [2]，上周期 天线俯仰和方位驱动角度fDrv_〇ld[2] =fDrv[2]，之后返回步骤（2)，进行下一周期的天 线跟踪补偿驱动控制。
[0014] 所述根据惯导系统的导航信息解算出本周期天线俯仰角fPitch和方位角fYaw具 体为：
[0015] (2. 1)计算卫星位置信息在地理坐标系上的投影fXt、fYt、fZt，具体为：
[0017] 其中，Re为地球半径，h。为载体当前高度，λ Sat、\。、外分别为卫星经度、载体经度 和载体炜度；
[0018] (2. 2)计算出卫星在载体坐标系上的投影fX。、fY。、fZ。，具体为：
[0020] 其中，P、R和Y为载体俯仰角、滚动角和航向角；
[0021] (2. 3)更新天线俯仰角和方位角为：
[0024] 其中，fPitch为天线俯仰角和fYaw为天线方位角。
[0025] 本发明与现有技术相比的优点如下：
[0026] (1)本发明在当前驱动控制的基础上进行了超前控制，利用超前控制技术弥补了 惯导系统由于量测滞后造成的天线驱动控制延迟。相比现有技术，本发明充分考虑了惯导 系统量测滞后对天线驱动控制精度的影响，并对量测延迟进行了补偿，进一步提高了天线 指向卫星的精度，尤其是大动态环境下的天线的卫星指向精度；
[0027] (2)本发明中提供了天线方位角和俯仰角的计算公式，通过载体姿态和卫星位置 等信息推导出天线方位角和俯仰角。与现有技术相比，简化了计算流程，提高了计算效率， 能够快速实现天线俯仰角和方位角的计算。
【附图说明】
[0028] 图1为本发明的方法流程图；
【具体实施方式】
[0029] 动中通（SOTM，Satcom On The Move)是"移动中的卫星地面站通信系统"的简称， 其利用地球同步静止卫星作为通信信号的中转平台，实现其覆盖区域内的点到点、点到多 点、多点到多点的实时通信。主要特点为：卫星覆盖区域大，不受地域、距离等因素限制，专 用传输信道，传输带宽大，传输速率高；可实现远程视频图像、伴音、电话以及数据传输。
[0030] 动中通包括天线、天线控制系统、惯导系统。其中惯导系统的地理坐标系是指原点 0选在载体重心处，X指向东，Y指向北，Z沿垂线方向指向天，即东北天坐标系OX YZ ;载体 坐标系是固连在载体上的坐标系，其坐标原点0位于载体的重心处，X1沿载体横轴指向右， Y1沿载体纵轴指向前，Z i垂直于OX J1，并沿飞行器的竖轴指向上，载体坐标系表示为OX1Y1Z1
[0031] 如图1所示，本发明提供了一种基于惯导系统量测滞后的动中通天线跟踪控制方 法，其特征在于步骤如下：
[0032] (1)进入天线跟踪状态时，预设超前驱动系数1(。(0〈1(。< 1.0)，设置控制周期定时 器T和补偿标志MFlag，初值均为零；读取天线俯仰角和方位角值，存入数组变量fAInc_ 〇ld[2]中；
[0033] (2)控制周期定时器T开始计时，当达到预定控制时间后，进入步骤（3);
[0034] (3)根据惯导系统的导航信息解算出本周期天线俯仰角fPitch和方位角 fYaw，存入数组变量fAInc[2]中，并计算本周期天线俯仰和方位驱动角度fDrv[2]= fAInc[2]-fAInc_old[2]；
[0035] 根据惯导系统的导航信息解算出本周期天线俯仰角fPitch和方位角fYaw具体 为：
[0036] 先计算卫星位置信息在地理坐标系上的投影fXt、fYt、fZ t，具体为：
[0038] 其中，Re为地球半径，h。为载体当前高度，λ Sat、λ。、外分别为卫星经度、载体经度 和载体炜度；
[0039] 然后计算出卫星在载体坐标系上的投影fX。、fY。、fZ。，具体为：
[0041] 其中，P、R和Y为载体俯仰角、滚动角和航向角；
[0042] 最后更新天线俯仰角和方位角为：
[0045] 其中，fPitch为天线俯仰角和fYaw为天线方位角。
[0046] 判断补偿标志MFLAG是否有效，MFLAG = 0时表示无效，MFLAG = 1时表示有效，若 补偿标志MFLAG无效则执行步骤（a);若补偿标志MFLAG有效，则执行步骤（b);
[0047] (a)计算天线俯仰角和方位角的超前驱动补偿量fPulse[2] = K。· fDrv[2]，并设 置补偿标志MFlag有效，即MFlag = 1，之后进入步骤（4);
[0048] (b)计算天线俯仰角和方位角的超前驱动补偿量fPulSe[2]= 1( 0*(^)^[2]-^^￥_01(1[2])，之后进入步骤（4)