一种火星探测器自主对地定向控制方法技术

本发明专利技术公开一种火星探测器自主对地定向控制方法，使用于火星探测器任意姿态情况下完成全姿态捕获地球和对地定向，仅仅使用星敏感器作测量，反作用飞轮作为执行部件提供控制力矩。直接使用星敏感器的测量值，无须通过滤波算法确定姿态，实现了不依赖陀螺的安全模式。与现有技术相比，该方法不依赖地球敏感器和陀螺，能够自主完成全姿态捕获地球和对地定向，有较强的实用推广价值。

【技术实现步骤摘要】
一种火星探测器自主对地定向控制方法
本专利技术涉及火星探测器对地球定向姿态控制技术，尤其是用于火星探测器任意姿态情况下完成对地定向，仅仅使用星敏感器作测量部件，反作用飞轮作为执行部件提供控制力矩。直接使用星敏感器的测量值，不须通过滤波算法确定姿态，符合最小硬件配置原则。
技术介绍
国内研制火星探测器，在执行火星探测任务时，首先要数传天线对地定向，确保科学探测数据能够下传，在深空探测中，没有直接的地球敏感器可以测量对地姿态信息，需要星上自主进行火星、地球公转轨道及星历递推来确定对地定向基准，另外，由于火星与地球距离遥远无法进行实时遥控，火星探测器必须能够在任意姿态情况下自主完成捕获地球和对地定向，因此，需要研制一种火星探测器自主对地定向技术。
技术实现思路
针对现有技术不足，本专利技术要解决的技术问题是提供一种火星探测器自主对地定向控制方法，无需陀螺的角速度数据作为反馈，采用星敏感器和飞轮的最小配置，能够在任意姿态情况下自主完成捕获地球和对地定向。为解决上述技术问题，本专利技术是通过以下的技术方案实现的，一种火星探测器自主对地定向控制方法，其具体包括如下步骤：1.通过计算地球、火星的星历得到火星对地球指向矢量，根据对地坐标系的定义，计算惯性坐标系到对地定向基准坐标系的转换四元数；2.采用前馈+反馈策略的解耦控制律计算飞轮转速指令，通过飞轮转速控制实现对地定向机动；3.对地机动完成后，利用星敏感器测量值计算的姿态角作为P项反馈，姿态角积分作为I项反馈，利用飞轮PI控制律进行对地稳态控制；4.设置对地定向时间限制，进行计时或者整星蓄电池电量判断，当发生超时或者能源危机时自主转回对日定向模式；本专利技术采用的方法与现有技术相比，其优点和有益效果是：该专利技术方法，解决了火星探测任意姿态情况下捕获地球和对地定向问题，火星探测器长期运行时不需要陀螺测量信息，也可以降低火星探测器对陀螺的配置要求，从而增加系统长期运行的可靠性。附图说明以下将结合附图和实施例对本专利技术作进一步说明。图1是本专利技术方法对地定向关系示意图。具体实施方式当火星探测器进入全姿态捕获地球时，首先根据星上系统时钟值计算对地定向基准，进行对地定向机动，完成对地机动后，进入对地定向稳态控制以完成对地数传。各模式下的具体实施方式如下所述。如图1所示，对地定向姿态基准由火星指向地球的矢量rem和地球公转轨道的法线矢量he确定。火星与地球连线并指向地球为+Zre向，火星指向地球矢量rem和地球公转面法线矢量he所在平面的法线为+Xre，Yre轴根据右手坐标系法则得到，对地定向基准计算过程如下：地球平根数计算a‾e=1.00000102×1.4959787×108(km)e‾e=0.016704140i‾e=0Ω‾e=0ω‾e=102.971723·π/180M‾e=(357.529100+0.98560028169·MJD)·π/180]]>式中：为地球公转轨道半长轴；为地球公转轨道偏心率；为地球公转轨道倾角；为地球公转轨道升交点赤经；为地球公转轨道近日点幅角；为地球公转轨道平近点角。地球位置计算fe=M‾e+2e‾e·sinM‾e+1.25e‾e2·sin(2M‾e)]]>re=a‾e(1-e‾e2)/(1+e‾ecosfe)]]>ue=ω‾e+fe]]>式中：fe为地球公转轨道真近点角；re为地球太阳之间的距离；ue为地球公转轨道升交点幅角。地球绕太阳运动的位置在日心黄道坐标系中的分量为xe=re·cosueye=re·sinueze=0]]>火星平根数计算式中：为火星公转轨道半长轴；为火星公转轨道偏心率；为火星公转轨道倾角；为火星公转轨道升交点赤经；为火星公转轨道近日点幅角；为火星公转轨道平近点角。火星位置计算fM=M‾M+2e‾M·sinM‾M+1.25e‾M2·sin(2M‾M)]]>rM=a‾M(1-e‾M2)/(1+e‾McosfM)]]>uM=ω‾M+fM]]>式中：fM为火星公转轨道真近点角；rM为火星太阳之间的距离；uM为火星公转轨道升交点幅角。火星绕太阳运动的位置在日心黄道坐标系中的分量为xM=rM·(cosuMcosΩM-sinuMcosi‾MsinΩ‾M)ym=rm·(cosuMsinΩM+sinuMcosi‾McosΩ‾M)zm=rM·(sinuMsini‾M)]]>通过星历递推，可以得到日心黄道坐标系下的地球绕太阳的位置矢量火星绕太阳的位置矢量设火星指向地球球心的矢量为对地定向基准坐标系3个轴向的单位矢量分别为则s→e=r→e-r→m]]>h→e=[001]T]]>e→z=s→e/|s→e|]]>e→x=s→e×h→e]]>e→x=e→x/|e→x|]]>e→y=e→z×e→x]]>e→y=e→y/|e→y|]]>日心黄道坐标系到对地定向基准坐标系的转换矩阵Cr_E为Cr_E=e→xTe→yTe→zT=A11A12A13A21A22A23A31A32A33]]>转换为四元素形式得到qre日心地球赤道惯性坐系到日心黄道坐标系的转换四元数为qeie=cosϵe2sinϵe200,]]>其中εe＝23.437905°·π/180日心地球赤道惯性坐标系到对地定向基准坐标系的转换四元数qrEi为qrEi=qeie⊗qrE]]>根据星敏感器测量到的星体四元素qib和对地定向基准四元素qrEi，可以计算得到姿态机动四元素：q=qrEi-1⊗qib]]>对地机动过程中飞轮指令计算如下：Ω(t)=Iw-1B·A(q)·本文档来自技高网...

【技术保护点】
火星探测器自主对地定向控制方法，其特征在于包括如下步骤：1)根据地球、火星的星历计算火星对地球指向矢量，通过定义对地坐标系计算惯性坐标系到对地定向基准坐标系的转换四元数；2)采用前馈+反馈策略的解耦控制律计算飞轮转速指令，以此进行对地定向机动控制；3)对地机动完成后，利用星敏感器测量值计算的姿态角作为P项反馈，姿态角积分作为I项反馈，进行PI对地稳态控制；4)设置对地定向时间限制，进行计时或者整星蓄电池电量判断，当发生超时或者能源危机时自主转回对日定向模式。

【技术特征摘要】
1.火星探测器自主对地定向控制方法，其特征在于包括如下步骤：1)根据地球、火星的星历计算火星对地球指向矢量，通过定义对地坐标系计算惯性坐标系到对地定向基准坐标系的转换四元数；2)采用前馈+反馈策略的解耦控制律计算飞轮转速指令，以此进行对地定向机动控制；3)对地机动完成后，利用星敏感器测量值计算的姿态角作为P项反馈，姿态角积分作为I项反馈，进行PI对地稳态控制；4)设置对地定向时间限制，进行计时或者整星蓄电池电量判断，当发生超时或者能源危机时自主转回对日定向模式。2.根据权利要求1所述的火星探测器自主对地定向控制方法，其特征在于：所述步骤1)中，日心地球赤道惯性坐标系到对地定向基准坐标系的转换四元数qrEi计算公式为：式中：qrEi为对地基准四元素；为日心惯性系到日心黄道系转换四元素；qrE为日心黄道系到对地基准系转换四元素。3.根据权利要求1或2所述的火星探测器自主对地定向控制方法，其特征在于：所述步骤2)中对地机动过程中飞轮指令计算公式为：

【专利技术属性】
技术研发人员：尹海宁，聂章海，周连文，李芳华，杜宁，蔡陈生，袁彦红，
申请(专利权)人：上海航天控制工程研究所，
类型：发明
国别省市：