专利名称：一种卫星飞行参数实时预测方法
技术领域：
本发明涉及卫星控制领域，更具体的说，涉及一种卫星飞行参数实时预测方法。
背景技术：
卫星的控制存在着大时延、有限测控弧段、实测信息缺损等问题。大时延问题是指由于空间跨度大而实测信息获取不及时，造成了信息传输大时延，一般达到4-10秒，这样大的通信时延破坏了系统的透明度，甚至导致控制不稳定；有限测控弧段是指卫星一般不是全球测控的，因此无法全程监视卫星的飞行状态，影响下一步的决策与操作；实测信息的缺损是指信息在传输过程中，难免产生信息包的丢失、坏损等问题，导致无法正确监视卫星状态。
发明内容
为了解决上述传统问题，因此本发明的一个目的就是提出了一种卫星飞行参数实时预测方法。
在本发明的一方面中，卫星飞行参数实时预测方法包括(A)对相应的变量进行初始化；(B)将控制指令加入相应的指令桶中；(C)获得当前飞行时间t；(D)依据飞行时间t在轨道指令桶中查询轨控指令OC；(E)将查询到的指令输入到在轨系统仿真模块的卫星轨道模型中进行实时仿真，预测卫星位置参数x，y，z并输出。
根据这个方面，进一步包括步骤(F)将计算出的x，y，z代入星下点轨迹计算模块中，计算出卫星的实时经/纬度并输出。
根据这个方面，进一步包括步骤(G)将计算出的x，y，z代入卫星轨道参数计算模块中，计算出卫星的轨道参数并输出。
根据这个方面，进一步包括步骤(H)按当前飞行时间t，在卫星姿态指令桶中查询轨控指令AC；以及(I)将查询到的指令输入到在轨系统仿真模块的卫星姿态模型中，预测姿态角。
根据这个方面，其中在步骤(B)中，若控制指令为轨道控制指令，则将轨道控制指令加载到轨控指令桶中；并且如果若控制指令为姿态控制指令，则将姿态控制指令加载到姿控指令桶中。
通过这种卫星飞行参数实时预测技术，可以接收地面对卫星的操作指令，并及时对其进行响应，最终达到实时、全程、准确地反映卫星飞行状态的控制目的。此外，还可以通过该发明软件离线应用，对飞行计划等任务进行离线仿真，定性地给出相应的结论，并且还可以离线训练操作员，提高操作员的操作技巧和操作精度，从而提高了训练的经济性和有效性。
结合随后的附图，从下面的详细说明中可显而易见的得出本发明的上述及其他目的、特征及优点。在附图中图1给出了空间飞行机器应用实例；以及图2给出了根据本发明的卫星飞行参数实时预测方法的流程图；图3给出了预测卫星位置参数的流程图；图4给出了卫星姿态开环控制模型图；图5给出了卫星姿态闭环控制模型图。
具体实施例方式
在下文中，参考附图对本发明的优选实施例进行详细的说明。在附图中，相同的附图标记表示相同或者相似的部分，即使它们是在不同附图中进行描述的。在下面描述中，当形成本发明的主题而不会造成不清楚时，省略对这里所采用的已知功能和步骤进行详细说明。
下面以空间飞行机器人为应用实例来阐述本发明。空间飞行机器人由飞行平台(即卫星)和机械臂构成如图1所示。其中卫星的质量、几何尺寸(长、宽、高)、转动惯量(Ix，Iy，Iz)、入轨初始位姿参数、机械臂几何参数，以及地球等参数写成文件表，如下Parameter_Table.txt80 //卫星质量kg1.1 //卫星长m1.2 //卫星宽m1.1 //卫星高m80 //Ix100 //Iy110 //Iz……//机械臂参数
3.986005e14 //地球引力常数3.352819e-3 //地球扁率二阶带谐项6.37814e6 //地球赤道半径7.2722e-5 //地球自转角速度-1.0097//零时刻子午线赤经20081201；11:35:00.000 //入轨时刻7148860 //入轨点的地心距114.07 //入轨点的经度22.60 //入轨点的纬度7466.860 //入轨点的速度22.640 //入轨点的速度倾角67.40 //入轨点的速度方位角0.0010445 //卫星轨道的角速度-3.670e6，-5.486e6，2.747e6 //卫星的初始位置(在地心赤道惯性坐标系OCS中)2.812e3，1.732e3，6.815e3 //卫星的初始速度(在地心赤道惯性坐标系OCS中)0，0，0//入轨时刻卫星本体的姿态角(卫星轨道坐标系CCS)0，0，0 //入轨时刻卫星主惯性轴的角速度(卫星本体坐标系BCS中)6015.6 //轨道周期下面结合图2，对根据本发明的卫星飞行参数实时预测方法的流程图进行详细的说明。
首先读入Parameter_Table.txt，并对相应的变量进行初始化(步骤S101)。如果未接收到控制指令，则将姿态控制指令加载到姿控指令桶中(步骤S104)。如果接收到控制指令，则将轨道控制指令加入相应的指令缓存堆栈中(步骤S104)。其中控制指令包括卫星的轨道控制指令、卫星的姿态控制指令以及机械臂控制指令，各自的格式如下控制指令格式
此后，获得系统的飞行时间(步骤S106)，并依据飞行时间t在轨道指令堆栈中查询OC指令(S107)，然后将查询到的指令输入到在轨系统仿真模块的卫星轨道模型中进行实时仿真，预测卫星位置参数x，y，z并输出(步骤S108)，具体处理过程如图3所示，其中输入(Fx，Fy，Fz)为施加在卫星上的轨道推力输出(x，y，z)为根据卫星轨道模型计算出来的卫星下一时刻的位置坐标。
轨道模型为x··=-μr3x+32J2μRE2xr5[5(zr)2-1]+1mFxy··=-μr3y+32J2μRE2yr5[5(zr)2-1]+1mFyz··=-μr3z+32J2μRE2zr5[5(zr)2-1]+1mFz,]]>利用二阶差分近似得到下式x(tn)=x(tn-1)+(tn-tn-1)x(tn-1)-x(tn-2)tn-1-tn-2-(tn-tn-1)2μx(tn-1)r3(tn-1)]]>+(tn-tn-1)232J2μRE2x(tn-1)r5(tn-1){5[z(tn-1)r(tn-1)]2-1}+(tn-tn-1)2Fx(tn)m]]>y(tn)=y(tn-1)+(tn-tn-1)y(tn-1)-y(tn-2)tn-1-tn-2-(tn-tn-1)2μy(tn-1)r3(tn-1)]]>+(tn-tn-1)232J2μRE2y(tn-1)r5(tn-1){5[z(tn-1)r(tn-1)]2-1}+(tn-tn-1)2Fy(tn)m]]>z(tn)=z(tn-1)+(tn-tn-1)z(tn-1)-z(tn-2)tn-1-tn-2-(tn-tn-1)2μz(tn-1)r3(tn-1)]]>+(tn-tn-1)232J2μRE2z(tn-1)r5(tn-1){5[z(tn-1)r(tn-1)]2-3}+(tn-tn-1)2Fz(tn)m]]>其中(x，y，z)为卫星在地心赤道惯性坐标系中的坐标(Fx，Fy，Fz)为卫星的轨道推力在地心赤道惯性坐标系中的分量r为卫星地心距
m为卫星质量u为地球引力常数J2为地球二阶引力带状协常数RE为地球赤道半径此后将x，y，z代入星下点轨迹计算模块中，计算出卫星的实时经/纬度χ/λ并输出(步骤S109)；然后将x，y，z代入卫星轨道参数计算模块中，计算出卫星的轨道参数r，a，e，i，Ω，η，ω并输出(步骤S110)。
此后按当前飞行时间t，在卫星姿态指令堆栈中查询指令(步骤S111)，然后将查询到的指令输入到在轨系统仿真模块的卫星姿态模型中进行实时仿真，具体如下卫星姿态模型卫星姿态模型又分为两类卫星姿态开环控制模型和卫星姿态闭环控制模型。其中开环控制模型是通过施加力矩直接调节卫星姿态；而闭环控制模型是通过反馈控制使卫星达到期望姿态角。因此，在姿态仿真计算时先确认姿态指令的种类，当姿态指令为力矩指令时，调用姿态开环控制模型，如图4所示，其中输入 输出 动力学模型ω·x=1Ix[Mx-(Iz-Iy)ωyωz]ω·y=1Iy[My-(Ix-Iz)ωxωz]ω·z=1Iz[Mz-(Iy-Ix)ωxωy]]]>离散化得
wx(tn)=wx(tn-1)+(tn-tn-1)[-(Iz-Iy)]Ixwy(tn-1)wz(tn-1)+(tn-tn-1)1IxMx(tn)wy(tn)=wy(tn-1)+(tn-tn-1)[-(Ix-Iz)]Iywx(tn-1)wz(tn-1)+(tn-tn-1)1IyMy(tn)wz(tn)=wz(tn-1)+(tn-tn-1)[-(Iy-Ix)]Izwx(tn-1)wy(tn-1)+(tn-tn-1)1IzMz(tn)]]>运动学模型 +W0sinφ(t-1)sinθ(t-1)]]]>θ(t)＝θ(t-1)+h[wy(t-1)cos(t-1)-wz(t-1)sin(t-1)+W0cosφ(t-1)](t)＝(t-1)+h[wx(t-1)+W0sinφ(t-1)cosθ(t-1)+tanθ(t-1)[wy(t-1)sin(t-1)+wz(t-1)cos(t-1)+W0sinφ(t-1)sinθ(t-1)]]其中(φ，θ，)为卫星的三个姿态角(偏航角、俯仰角、横滚角)(ωx，ωy，ωz)为卫星转动角速度在轨道坐标系下的三个分量(Mx，My，Mz)为施加在卫星上的力矩在主惯性轴上的三个分量(控制量)(Ix，Iy，Iz)为卫星的转动惯量W0为卫星的轨道角速度当指令为期望值指令时，调用闭环控制模型，如图5所示，其中，输入 输出 采用一阶控制模型近似为 对其进行一阶差分得
其中Aφ，aφ，Aθ，aθ，A，a为控制模型参数由此计算得到卫星的飞行姿态参数ψ，θ，并输出(步骤S112)。经过在轨系统的实时仿真计算得到t时刻的卫星飞行状态参数
然后判断仿真是否结束(步骤S113)，若结束仿真则退出系统；否则另t＝t+h，循环仿真，直到仿真结束。
该系统已成功地嵌入到空间机器人遥操作系统当中，达到实时预测卫星飞行参数的目的。
虽然参考其某些优选实施例而给出并描述了本发明，但是对于本领域普通技术人员来说应该明白的是，在不脱离本发明精神和范围的情况下可对其结构及细节做出各种变化。因此，本发明的范围并不局限于这些实施例，而是由随后权利要求及其等效体来定义。
权利要求
1.一种卫星飞行参数实时预测方法，包括(A)对相应的变量进行初始化；(B)将控制指令加入相应的指令桶中；(C)获得当前飞行时间t；(D)依据飞行时间t在轨道指令桶中查询轨控指令OC；以及(E)将查询到的指令输入到在轨系统仿真模块的卫星轨道模型中进行实时仿真，预测卫星位置参数x，y，z并输出。
2.根据权利要求1的方法，进一步包括步骤(F)将计算出的x，y，z代入星下点轨迹计算模块中，计算出卫星的实时经/纬度并输出。
3.根据权利要求2的方法，进一步包括步骤(G)将计算出的x，y，z代入卫星轨道参数计算模块中，计算出卫星的轨道参数并输出。
4.根据权利要求3的方法，进一步包括步骤(H)按当前飞行时间t，在卫星姿态指令桶中查询轨控指令AC；以及(I)将查询到的指令输入到在轨系统仿真模块的卫星姿态模型中，预测姿态角。
5.根据权利要求1的方法，其中在步骤(B)中，若控制指令为轨道控制指令，则将轨道控制指令加载到轨控指令桶中；并且若控制指令为姿态控制指令，则将姿态控制指令加载到姿控指令桶中。
全文摘要
本发明提出了一种卫星飞行参数实时预测方法，通过这种方法，可以接收地面对卫星的操作指令，并及时对其进行响应，最终达到实时、全程、准确地反映卫星飞行状态的控制目的。此外，还可以通过该发明软件离线应用，对飞行计划等任务进行离线仿真，定性地给出相应的结论，并且还可以离线训练操作员，提高操作员的操作技巧和操作精度，从而提高了训练的经济性和有效性。
文档编号B64G3/00GK1923622SQ20061009100
公开日2007年3月7日 申请日期2006年7月7日 优先权日2006年7月7日
发明者张珩, 赵猛, 陈靖波 申请人:中国科学院力学研究所