倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法
技术领域
本发明属于航天器轨道控制
技术领域
，尤其涉及一种倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法。背景技术
海洋动力环境观测卫星主要使命是：观测全球海洋动力环境参数，包括海面风场、海面高度场、浪场、海流、海上风暴、潮汐、海洋动力场、大洋环流和海表温度场等重要海洋参数。它是海洋防灾减灾的重要监测手段，其中全球高分辨率海洋大地水准面数据可直接为国防服务。
为解决对海洋连续实时的观测，减少海洋动力环境全球海洋区域覆盖所需时间，海洋动力环境监测网卫星一般由三颗海洋动力环境观测卫星组成，一颗卫星运行在极轨轨道上，两颗运行在倾斜轨道上。为了海洋动力环境卫星具有高精度高分辨率海洋大地水准面测量数据，对卫星轨道保持精度提出了很高的要求，一般要求地面轨迹的最大漂移范围优于1km，则卫星轨道半场轴控制误差要求优于1m，对于极轨海洋卫星，可以采用HY-2卫星已经实现轮控模式下的小推力轨控方案，但是对于倾斜轨道海洋动力环境观测卫星，在能源、偏航机动控制、轨道等多方面约束下，实现卫星高精度轨道控制，具有很大挑战。
发明内容
本发明的技术解决问题：克服现有技术的不足，提供一种倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法，在保证整星能源安全前提下，很好的实现卫星的高精度轨道控制。
为了解决上述技术问题，本发明公开了一种倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法，包括：
步骤1，地面注入变轨数据块，确定变轨时刻Torbit和变轨时长L1；
步骤2，当星上确定地面注入的变轨数据块有效时，星上根据变轨时刻Torbit，确定卫星开始从偏航跟踪模式返回对地零姿态机动时刻T0；
步骤3，当t≥T0时，星上自主设置星上帆板故障诊断标志和模拟太阳故障诊断标志为禁止，同时设置卫星帆板跟踪采用转角控制方式，卫星开始偏航返回；其中，t表示卫星当前星时；
步骤4，星上根据当前卫星姿态和太阳矢量，计算得到帆板控制目标角αfr；
步骤5，星上根据帆板驱动线路返回的帆板转角αf和帆板控制目标角αfr之差，输出帆板控制指令；
步骤6，当卫星姿态趋近于0时，卫星自动保持正常对地零姿态；
步骤7，当t＝Torbit时，卫星自主开始变轨，星上开始累积变轨时间，累积的变轨时间满足变轨时长L1，卫星自主关闭轨控发动机，变轨结束；
步骤8，当t≥Torbit+L1+T1时，卫星自动开始从零姿态进行偏航跟踪；其中，T1表示变轨结束后姿控等待时间；
步骤9，当卫星跟踪的姿态误差满足连续多次小于阈值时，卫星自主将帆板控制方式从转角控制方式转换为模拟太阳控制方式，同时自主将帆板故障诊断允许标志和模拟太阳自主诊断标志设为允许。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，能源安全自主诊断标志记作PowerAuto；其中，PowerAuto＝1，表示允许星上自主进行能源安全模式诊断；PowerAuto＝0，表示禁止星上自主进行能源安全模式诊断；
所述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法，还包括：
在步骤1之前，地面设置星上能源安全自主诊断标志为禁止；
在步骤9之后，地面注入星上能源安全自主诊断允许标志为允许。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，当如下三个条件同时成立时，确定地面注入的变轨数据块有效：
条件1：
条件2：
条件3：Torbit-t>TLmit；
其中，θr,ψr分别表示卫星相对目标姿态的滚动姿态角误差、俯仰姿态角误差和偏航姿态角误差，分别表示卫星相对目标姿态的滚动姿态角速度误差、俯仰姿态角速度误差和偏航姿态角速度误差，αLmit表示姿态角误差限幅值，表示姿态角速度误差限幅值，TLmit表示最大的偏航机动时长，fabs()为绝对值函数，max()为最大值函数，T0＝Torbit-detaT1，detaT1为卫星从最大偏航姿态机动回对地零姿态时间的1.5倍。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，
星上帆板故障诊断标志记作BaptaAuto；其中，BaptaAuto＝1，表示允许星上自主进行帆板故障诊断；BaptaAuto＝0，表示禁止星上自主进行帆板故障诊断；
模拟太阳故障诊断标志记作AssAuto；其中，AssAuto＝1，表示允许星上自主进行模拟太敏故障诊断；AssAuto＝0，表示禁止星上自主进行模拟太敏故障诊断；
卫星帆板跟踪方式字记作BabtaCtr；其中，BabtaCtr＝1，表示采用帆板输出转角进行帆板控制；AssAuto＝0，表示采用模拟太阳进行帆板控制；
当t≥T0时，自主设置BaptaAuto＝1，AssAuto＝0，BabtaCtr＝1。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，帆板控制目标角αfr的计算流程如下：
根据太阳矢量[Sox,Soy,Soz]T，计算得到太阳矢量在本体坐标系下的投影Sbφ：
Sbφ＝Rz(ψz)·[Sox,Soy,Soz]T
其中，Rz(ψz)绕Z轴旋转ψz的方向余弦阵，ψz表示定姿的偏航角；
计算得到帆板控制目标角αfr：
αfr＝arctan2(-Sbφx,-Sbφz)
其中，Sbφx和Sbφz分别为Sbφ在x方向和z方向的分量。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，星上根据帆板驱动线路返回的帆板转角αf和帆板控制目标角αfr之差，输出帆板控制指令，包括：
根据αf和αfr之差，计算帆板机构转动方向BabtaCMDD：
BabtaCMDD＝sgn(αfr-αf)
获取帆板线路执行步距BabtaCMDF；
根据帆板线路执行步距BabtaCMDF，计算得到帆板转角计数BabtaCMDN：
其中，sgn()为符号函数，fabs()为绝对值函数，floor()为去整函数。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，当卫星姿态趋近于0时，卫星自动保持正常对地零姿态，包括：
当和满足连续N1次小于和时，卫星自动保持正常对地零姿态；其中，θ,ψ分别表示卫星相对对地零姿态的动姿态角误差、俯仰姿态角误差和偏航姿态角误差，分别表示卫星相对对地零姿态的滚动姿态角速度误差、俯仰姿态角速度误差和偏航姿态角速度误差，θ0,ψ0分别表示卫星相对对地零姿态的滚动姿态角误差阈值、俯仰姿态角误差阈值和偏航姿态角误差阈值，分别表示卫星相对对地零姿态的滚动姿态角速度误差阈值、俯仰姿态角速度误差阈值和偏航姿态角速度误差阈值，N1为设定的任一常数。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，当t＝Torbit时，星上时间t＝变轨时刻Torbit，卫星自主开始接通轨控推力器，进行卫星轨道控制，同时星上开始累积变轨时间，当累积的变轨时间满足变轨时长L1时，卫星自主关闭轨控发动机，变轨结束。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，当t≥Torbit+L1+T1时，卫星采用动量轮控制卫星自动开始从零姿态进行偏航跟踪；其中，100s≤T1≤600s。
在上述倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法中，当卫星跟踪的姿态误差满足连续多次小于阈值时，卫星自主将帆板控制方式从转角控制方式转换为模拟太阳控制方式，同时自主将帆板故障诊断允许标志和模拟太阳自主诊断标志设为允许，包括：
当和满足连续N2次小于和时，卫星自主将帆板控制方式从转角控制方式转换为模拟太阳控制方式，同时自主将帆板故障诊断允许标志和模拟太阳自主诊断标志设为允许，保持正常对地零姿态；其中，θr0,ψr0分别表示卫星相对目标姿态的滚动姿态角误差阈值、俯仰姿态角误差阈值和偏航姿态角误差阈值，分别表示卫星相对目标姿态的滚动姿态角速度误差阈值、俯仰姿态角速度误差阈值和偏航姿态角速度误差阈值，N2为设定的任一常数。
本发明具有以下优点：
(1)本发明针对倾斜轨道海洋动力环境观测卫星，在能源、偏航机动控制、轨道等多方面约束下，实现卫星高精度轨道控制的难题，提出了一种倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法，在保证整星能源安全前提下，很好的实现卫星的高精度轨道控制。
(2)本发明在倾斜轨道海洋卫星轨控过程中，利用星体实时偏航姿态+帆板转角控的能源控制策略，有效解决了采用传统ASS控制帆板策略不适用于倾斜轨道卫星机动过程对日能源安全隐患，实现了卫星的高精度轨道控制，同时确保轨控过程中整星能源安全，该方法已经成功应用于HY-2C卫星飞行验证，取得了良好的效果，也可应用于后续需要实现高精度轨道控制的倾斜轨道卫星。
附图说明
图1是本发明实施例中一种倾斜轨道海洋卫星运行示意图；
图2是本发明实施例中一种轨道面进动情况示意图；
图3是本发明实施例中一种轨道太阳入射角β变化情况示意图；
图4是本发明实施例中一种卫星地影时间示意图；
图5是本发明实施例中一种倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法的步骤流程图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明公开的实施方式作进一步详细描述。
如图1，为了使海洋动力环境卫星具有高精度高分辨率海洋大地水准面测量数据，对卫星轨道保持精度提出了很高的要求，一般要求地面轨迹的最大漂移范围优于1km，则卫星控制系统要求实现下列要求：
轨道半长轴误差小于1m；
轨道倾角误差小于0.007°；
偏心率不大于0.00007；
近地点幅角误差小于3.5°。
以66°的非太阳同步回归冻结轨道位例，在J2000惯性坐标系升交点赤经每天西退2.492°，大约145天卫星轨道面转动一圈，轨道面进动情况如图2所示，轨道太阳入射角β变化情况如图3所示，最大约±89.5°。
长期运行期间卫星地影情况如图4所示，卫星有全日照情况出现，最大地影时间约为35min(即1/3轨道周期)，最小地影时间为0min，地影时间大约以145天为周期。为保证卫星供电安全，能源系统一般要求蓄电池组放电深度不超过30％，因此一个轨道圈卫星光照时间不少于1/3个轨道圈。
本发明针对倾斜轨道海洋动力环境观测卫星，在能源、偏航机动控制、轨道等多方面约束下，实现卫星高精度轨道控制的难题，提出了一种倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法。
如图5，该倾斜轨道海洋动力卫星高精度轨控过程中的能源控制方法，包括：
步骤501，地面设置星上能源安全自主诊断标志为禁止。
在本实施例中，可以将能源安全自主诊断标志记作PowerAuto。其中，PowerAuto＝1，表示允许星上自主进行能源安全模式诊断；PowerAuto＝0，表示禁止星上自主进行能源安全模式诊断。
步骤502，地面注入变轨数据块，确定变轨时刻Torbit和变轨时长L1。
步骤503，当星上确定地面注入的变轨数据块有效时，星上根据变轨时刻Torbit，确定卫星开始从偏航跟踪模式返回对地零姿态机动时刻T0。
在本实施例中，当如下三个条件同时成立时，确定地面注入的变轨数据块有效：
条件1：
条件2：
条件3：Torbit-t>TLmit。
其中，θr,ψr分别表示卫星相对目标姿态的滚动姿态角误差、俯仰姿态角误差和偏航姿态角误差，分别表示卫星相对目标姿态的滚动姿态角速度误差、俯仰姿态角速度误差和偏航姿态角速度误差，αLmit表示姿态角误差限幅值，表示姿态角速度误差限幅值，TLmit表示最大的偏航机动时长，fabs()为绝对值函数，max()为最大值函数，T0＝Torbit-detaT1，detaT1为卫星从最大偏航姿态机动回对地零姿态时间的1.5倍，t表示卫星当前星时。。
步骤504，当t≥T0时，星上自主设置星上帆板故障诊断标志和模拟太阳故障诊断标志为禁止，同时设置卫星帆板跟踪采用转角控制方式，卫星开始偏航返回。
在本实施例中，将星上帆板故障诊断标志记作BaptaAuto，模拟太阳故障诊断标志记作AssAuto，卫星帆板跟踪方式字记作BabtaCtr。其中，BaptaAuto＝1，表示允许星上自主进行帆板故障诊断；BaptaAuto＝0，表示禁止星上自主进行帆板故障诊断；AssAuto＝1，表示允许星上自主进行模拟太敏故障诊断；AssAuto＝0，表示禁止星上自主进行模拟太敏故障诊断；BabtaCtr＝1，表示采用帆板输出转角进行帆板控制；AssAuto＝0，表示采用模拟太阳进行帆板控制。也即，当t≥T0时，自主设置BaptaAuto＝1，AssAuto＝0，BabtaCtr＝1。
步骤505，星上根据当前卫星姿态和太阳矢量，计算得到帆板控制目标角αfr。
在本实施例中，帆板控制目标角αfr的计算流程如下：
根据太阳矢量[Sox,Soy,Soz]T，计算得到太阳矢量在本体坐标系下的投影Sbφ：
Sbφ＝Rz(ψz)·[Sox,Soy,Soz]T
根据Sbφ，计算得到帆板控制目标角αfr：
αfr＝arctan2(-Sbφx,-Sbφz)
其中，Rz(ψz)绕Z轴旋转ψz的方向余弦阵，ψz表示定姿的偏航角，Sbφx和Sbφz分别为Sbφ在x方向和z方向的分量。
步骤506，星上根据帆板驱动线路返回的帆板转角αf和帆板控制目标角αfr之差，输出帆板控制指令。
在本实施例中，首先，根据αf和αfr之差，计算帆板机构转动方向BabtaCMDD：
BabtaCMDD＝sgn(αfr-αf)
进一步的，获取帆板线路执行步距BabtaCMDF，并根据帆板线路执行步距BabtaCMDF，计算得到帆板转角计数BabtaCMDN：
其中，sgn()为符号函数，fabs()为绝对值函数，floor()为去整函数。
步骤507，当卫星姿态趋近于0时，卫星自动保持正常对地零姿态。
在本实施例中，当和满足连续N1次小于和时，认为卫星姿态趋近于0，卫星自动保持正常对地零姿态。其中，θ,ψ分别表示卫星相对对地零姿态的动姿态角误差、俯仰姿态角误差和偏航姿态角误差，分别表示卫星相对对地零姿态的滚动姿态角速度误差、俯仰姿态角速度误差和偏航姿态角速度误差，θ0,ψ0分别表示卫星相对对地零姿态的滚动姿态角误差阈值、俯仰姿态角误差阈值和偏航姿态角误差阈值，分别表示卫星相对对地零姿态的滚动姿态角速度误差阈值、俯仰姿态角速度误差阈值和偏航姿态角速度误差阈值，N1为设定的任一常数。
步骤508，当t＝Torbit时，卫星自主开始变轨，星上开始累积变轨时间，累积的变轨时间满足变轨时长L1，卫星自主关闭轨控发动机，变轨结束。
在本实施例中，当t＝Torbit时，星上时间t＝变轨时刻Torbit，卫星自主开始接通轨控推力器，进行卫星轨道控制，同时星上开始累积变轨时间，当累积的变轨时间满足变轨时长L1时，卫星自主关闭轨控发动机，变轨结束。
步骤509，当t≥Torbit+L1+T1时，卫星自动开始从零姿态进行偏航跟踪。
在本实施例中，当t≥Torbit+L1+T1时，卫星采用动量轮控制卫星自动开始从零姿态进行偏航跟踪。其中，T1表示变轨结束后姿控等待时间，取值范围可以如下：100s≤T1≤600s。
步骤510，当卫星跟踪的姿态误差满足连续多次小于阈值时，卫星自主将帆板控制方式从转角控制方式转换为模拟太阳控制方式，同时自主将帆板故障诊断允许标志和模拟太阳自主诊断标志设为允许。
在本实施例中，当和满足连续N2次小于和时，卫星自主将帆板控制方式从转角控制方式转换为模拟太阳控制方式，同时自主将帆板故障诊断允许标志和模拟太阳自主诊断标志设为允许(即置：BaptaAuto＝1、AssAuto＝1、BabtaCtr＝0。)，保持正常对地零姿态。其中，θr0,ψr0分别表示卫星相对目标姿态的滚动姿态角误差阈值、俯仰姿态角误差阈值和偏航姿态角误差阈值，分别表示卫星相对目标姿态的滚动姿态角速度误差阈值、俯仰姿态角速度误差阈值和偏航姿态角速度误差阈值，N2为设定的任一常数。
步骤511，地面注入星上能源安全自主诊断允许标志为允许。
在本实施例中，卫星过境时，地面注入星上能源安全自主诊断允许标志为允许，即PowerAuto＝1，允许星上自主进行能源安全模式诊断。
本发明虽然已以较佳实施例公开如上，但其并不是用来限定本发明，任何本领域技术人员在不脱离本发明的精神和范围内，都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改，因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰，均属于本发明技术方案的保护范围。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
