CN111891402B - 一种基于自主机动的火星探测对地天线指向恢复方法 - Google Patents
一种基于自主机动的火星探测对地天线指向恢复方法 Download PDFInfo
- Publication number
- CN111891402B CN111891402B CN202010623256.3A CN202010623256A CN111891402B CN 111891402 B CN111891402 B CN 111891402B CN 202010623256 A CN202010623256 A CN 202010623256A CN 111891402 B CN111891402 B CN 111891402B
- Authority
- CN
- China
- Prior art keywords
- attitude
- pointing
- antenna
- ground
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000011084 recovery Methods 0.000 title claims abstract description 18
- 238000001514 detection method Methods 0.000 title claims abstract description 12
- 238000004891 communication Methods 0.000 claims abstract description 37
- 230000007774 longterm Effects 0.000 claims abstract description 15
- 230000008569 process Effects 0.000 claims abstract description 7
- 238000009434 installation Methods 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 27
- 230000001133 acceleration Effects 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 8
- 230000002159 abnormal effect Effects 0.000 claims description 7
- 239000000523 sample Substances 0.000 claims description 4
- 230000007246 mechanism Effects 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 claims description 2
- 238000004804 winding Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000007726 management method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种基于自主机动的火星探测对地天线指向恢复方法,该方法的步骤包括:S1、在长期稳态飞行基准下,若高增益天线驱动异常,GNC根据最后一拍高增益天线驱动角,计算高增益天线对地指向目标姿态,自主规划机动路径机动至高增益天线对地指向目标姿态;S2、根据S1中的目标姿态计算,GNC根据器上飞轮力矩及角动量约束,自主进行路径规划,并计算机动路径过程中的控制四元数及控制用角速度;S3、若仍然无通信建立,则进入绕对日轴慢旋状态。本发明可根据在轨天线安装特性,自主进行无通信情况下的物理通信链路恢复,保障通信天线的对地姿态指向,保障该姿态下太阳翼具备驱动跟踪对日的能力。
Description
技术领域
本发明涉及火星探测姿态控制技术,具体涉及一种基于自主机动的火星探测对地天线指向恢复方法。
背景技术
我国计划于2020年发射火星探测器,一次实现“绕”、“落”、“巡”的三步走流程。随着探测器的飞行,探测器距离火星越来越近,器地距离随之增加,相比于近地卫星,直接带来的影响就是通信延迟增大,无法实施实时的星地大回路控制,因此要求器上具备自主恢复通信功能的处置能力。
根据火星探测器对测控数传能力的需求不同,火星探测器配置高增益、低增益天线组合方式进行器地链路保障。由于天线波束限制,器上必须依靠GNC姿态的配合,才能保障对地通信。在故障情况下,GNC分系统需自主进行多次姿态机动及安全姿态的建立实现快速及最终姿态的保障。
国外深空探测过程中一般采用喷气慢旋姿态,该姿态可保持固定轴对地稳定,在对地稳定轴上安装通信天线,可保障通信链路的持续稳定。
一旦失去对地通信,则探测器与地面失联,目前国内外没有好的解决办法。
发明内容
本发明解决的技术问题是:为克服现有技术的不足,本发明提供了一种基于自主机动的火星探测对地天线指向恢复方法,在测控异常情况下,基于GNC姿态快速转动实现备份天线的对地指向,配合测控分系统完成主备功能切换。
本发明解决技术的方案是:
一种基于自主机动的火星探测对地天线指向恢复方法,用于器地通信异常情况下,配合综合电子实现天线波束指向,建立几何通信链路,该方法的步骤包括:
S1、在长期稳态飞行基准下,若高增益天线驱动异常,GNC根据最后一拍高增益天线驱动角,计算高增益天线对地指向目标姿态,自主规划机动路径机动至高增益天线对地指向目标姿态;
若中增益及低增益天线1通信异常,GNC计算低增益天线2对地指向目标姿态;
若增益天线无通信链路且中低增益天线切换后仍无通信,GNC自主进入绕X轴慢旋姿态实现由星敏感器到太阳敏感器切换;
S2、根据S1中的目标姿态计算,GNC根据器上飞轮力矩及角动量约束,自主进行路径规划,并计算机动路径过程中的控制四元数及控制用角速度;
根据当前对日姿态四元数与目标姿态四元数,计算误差四元数;
确定机动路径参数;
确定姿态机动的路径规划的路径;
确定闭环控制误差四元数及前馈控制力矩;
S3、若仍然无通信建立,则进入绕对日轴慢旋状态,其中俯仰和偏航轴依据模拟太阳角计直接测量带入控制器,进行解耦的闭环跟踪控制,滚动轴以陀螺测量角速度为测量值,以飞轮转速为输出量进行单比例闭环控制。
进一步的,长期稳态飞行基准四元数qs计算方法为:
qs=C(Rs)
其中,为地球指向探测器的矢量,为探测器指向太阳的矢量,分别为探测器本体x,y,z轴在地球J2000惯性系下的表示;Rs为地球J2000惯性系到长期稳态飞行基准的姿态转换矩阵;C为姿态矩阵转四元数算法,qs为对日基准四元数。
进一步的,高增益天线对地指向目标姿态计算方法为:
本体系下的高增益天线电轴指向
其中,Rx(·),Ry(·)为绕x,y轴旋转矩阵计算方法,α为高增益天线二维驱动X轴当前角度,β为高增益天线二维驱动Y轴当前角度,Rg为高增益天线安装矩阵;
qg=C(Rg)
进一步的,低增益天线2对地指向目标姿态确定方法为:
本体系下低增益天线2的指向:
ql=C(Rl)
进一步的,根据当前对日姿态四元数与目标姿态四元数,计算误差四元数:
进一步的,计算机动路径参数方法为:
进一步的,计算姿态机动的路径规划的路径方法为:
其中:t为相对机动开始时刻的计时;Φtemp为相对机动开始时刻绕欧拉轴v1的旋转角度;ωtemp为相对机动开始时刻绕欧拉轴v1的旋转角速度;qtemp为相对机动开始时刻机动过四元数,amax1为最大角加速度,tjs1为上升时间,tjs2为匀速保持时间。
进一步的,计算闭环控制误差四元数及前馈控制力矩的方法为:
ωerr=C(qerr)ωtemp-ωb(18)
其中,qerr为闭环控制误差四元数,其中矢量部分带入控制器;ωerr为闭环控制误差角速度;Tc为控制器前馈控制力矩;I为探测器的惯量矩阵;qb为相对机动开始时刻测量四元数;ωb为陀螺敏感器测量的探测器角速度,amax1为最大角加速度,为欧拉轴。
进一步的,飞轮指令转速Ω=Kp(ωt-ωb)(20)
其中:Kp为比例系数,Ixx为探测器X轴主惯量,Iw为飞轮转动惯量,ωt为慢旋目标转速,ωb为陀螺敏感器测量的探测器角速度。
进一步的,火星探测器采用高中低增益组合测控方案配置,高增益天线安装在探测器-Z面,具备XY轴二维驱动能力;中增益天线安装在XOZ平面,电轴指向+X偏-Z30°;低增益天线1安装在XOZ平面,电轴指向+X偏-Z45°;低增益天线2安装在XOZ平面,电轴指向-X偏+Z45°。
进一步的,在长期稳态飞行基准为:探测器+X指向太阳,-Z轴约束在器-日-地平面内且指向地球一侧。
本发明与现有技术相比的有益效果是:
(1)本发明可根据在轨天线安装特性,自主进行无通信情况下的物理通信链路恢复,保障通信天线的对地姿态指向;
(2)本发明可对具有二维驱动能力天线的故障进行自主建立天线电轴指向地球,同时保障该姿态下太阳翼具备驱动跟踪对日的能力;
(3)本发明适用于深空探测多天线组合应用任务,能够通过姿态机动进行不同天线自主跟踪指向地球;
(4)本发明可以满足深空探测任务的自主管理需求,结合姿态和通信两个重要约束进行在轨自主的隔离天线及姿态敏感器故障。
附图说明
图1为本发明基于自主机动的火星探测对地天线指向恢复流程图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
一种基于自主机动的火星探测对地天线指向恢复方法,用于器地通信异常情况下,配合综合电子实现天线波束指向,建立几何通信链路,该方法的步骤包括:
S1.在长期稳态飞行基准(探测器+X指向太阳,-Z轴约束在器-日-地平面内且指向地球一侧)下,若高增益天线驱动异常,GNC根据最后一拍高增益天线驱动角,计算高增益天线对地指向目标姿态,自主规划机动路径机动至高增益天线对地指向目标姿态;
若中增益及低增益天线1通信异常,GNC计算低增益天线2对地指向目标姿态;
若增益天线无通信链路且中低增益天线切换后仍无通信,GNC自主进入绕X轴慢旋姿态实现由星敏感器到太阳敏感器切换;
S1.1计算当前对日基准四元数
qs=C(Rs)
S1.2计算高增益天线对地指向目标姿态
α为高增益天线二维驱动X轴当前角度;β为高增益天线二维驱动Y轴当前角度;Rg为高增益天线安装矩阵;则本体系下的高增益天线电轴指向。
其中,Rx(·),Ry(·)为绕x,y轴旋转矩阵计算方法。
qg=C(Rg)
S1.3计算低增益天线2对地指向目标姿态
本体系下低增益天线2的指向:
ql=C(Rl)
S2.根据S1中的目标姿态计算,GNC根据器上飞轮力矩及角动量约束,自主进行路径规划,并计算机动路径过程中的控制四元数及控制用角速度。
S2.1根据当前对日姿态四元数与目标姿态四元数,计算误差四元数。
S2.1计算机动路径关键参数
其中:TJw为执行机构反作用飞轮的最大作用力矩;HJw为反作用飞轮的最大角动量;C为器上配置飞轮的安装矩阵,默认为单位阵;amax1为绕空间欧拉轴的最大角加速度;ωmax1为绕空间欧拉轴的最大角速度;tjs1为机动加速度时间;tys2为机动匀速时间与减速时间的和。
S2.2计算姿态机动的路径规划的路径。
其中:t为相对机动开始时刻的计时;Φtemp为相对机动开始时刻绕欧拉轴v1的旋转角度;ωtemp为相对机动开始时刻绕欧拉轴v1的旋转角速度;qtemp为相对机动开始时刻机动过四元数。
S2.3计算闭环控制误差四元数及前馈控制力矩。
ωerr=C(qerr)ωtemp-ωb (18)
Tc=I*amax1v1 (19)
其中,qerr为闭环控制误差四元数,其中矢量部分带入控制器;ωerr为闭环控制误差角速度;Tc为控制器前馈控制力矩;I为探测器的惯量矩阵;qb为相对机动开始时刻测量四元数;ωb为陀螺敏感器测量的探测器角速度。
S3通过上述机动后,仍然无通信建立(综合电子发送无通信标志),则进入绕对日轴慢旋状态(本体X轴指向太阳,同时绕X轴以固定角速度旋转)。其中俯仰和偏航轴依据模拟太阳角计直接测量带入控制器,进行解耦的闭环跟踪控制。滚动轴以陀螺测量角速度为测量值,以飞轮转速为输出量进行单比例闭环控制。
Ω=Kp(ωt-ωb) (20)
其中:Ω为飞轮指令转速,Kp为比例系数,Ixx为探测器X轴主惯量,Iw为飞轮转动惯量,ωt为慢旋目标转速,ωb为陀螺敏感器测量的探测器角速度。
火星探测器采用高中低增益组合测控方案配置,高增益天线安装在探测器-Z面,具备XY轴二维驱动能力;中增益天线安装在XOZ平面,电轴指向+X偏-Z30°;低增益天线1安装在XOZ平面,电轴指向+X偏-Z45°;低增益天线2安装在XOZ平面,电轴指向-X偏+Z45°。在长期稳态飞行基准(探测器+X指向太阳,-Z轴约束在器-日-地平面内且指向地球一侧)下,高增益天线基于二维驱动可实现对地指向,实现长期稳态过程的测控数传需求。
实施例1
针对我国首次火星探测任务,火星探测器采用高中低增益组合测控方案配置。高增益天线安装在探测器-Z面,具备XY轴二维驱动能力;中增益天线安装在XOZ平面,电轴指向+X偏-Z30°;低增益天线1安装在XOZ平面,电轴指向+X偏-Z45°;低增益天线2安装在XOZ平面,电轴指向-X偏+Z45°。
巡航阶段长期稳态姿态基准四元数:【1,0,0,0】
(1)高增益天线驱动故障,高增益天线故障角度为:【20°,0】,高增益天线指向地球姿态目标四元数:【0.9848 0 0.1736 0】;
(2)高增益天线链路故障,低增益2指向地球姿态四元数:【0.3827 0 0.9239 0】;
(3)进入慢选状态,控制用角速度0.06°/s。
本发明可根据在轨天线安装特性,自主进行无通信情况下的物理通信链路恢复,保障通信天线的对地姿态指向;可对具有二维驱动能力天线的故障进行自主建立天线电轴指向地球,同时保障该姿态下太阳翼具备驱动跟踪对日的能力;
本发明适用于深空探测多天线组合应用任务,能够通过姿态机动进行不同天线自主跟踪指向地球;可以满足深空探测任务的自主管理需求,结合姿态和通信两个重要约束进行在轨自主的隔离天线及姿态敏感器故障。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (11)
1.一种基于自主机动的火星探测对地天线指向恢复方法,用于器地通信异常情况下,配合综合电子实现天线波束指向,建立几何通信链路,其特征在于,该方法的步骤包括:
S1、在长期稳态飞行基准下,若高增益天线驱动异常,GNC根据最后一拍高增益天线驱动角,计算高增益天线对地指向目标姿态,自主规划机动路径机动至高增益天线对地指向目标姿态;
若中增益及低增益天线1通信异常,GNC计算低增益天线2对地指向目标姿态;
若增益天线无通信链路且中低增益天线切换后仍无通信,GNC自主进入绕X轴慢旋姿态实现由星敏感器到太阳敏感器切换;
S2、根据S1中的目标姿态计算,GNC根据器上飞轮力矩及角动量约束,自主进行路径规划,并计算机动路径过程中的控制四元数及控制用角速度;
根据当前对日姿态四元数与目标姿态四元数,计算误差四元数;
确定机动路径参数;
确定姿态机动的路径规划的路径;
确定闭环控制误差四元数及前馈控制力矩;
S3、若仍然无通信建立,则进入绕对日轴慢旋状态,其中俯仰和偏航轴依据模拟太阳角计直接测量带入控制器,进行解耦的闭环跟踪控制,滚动轴以陀螺测量角速度为测量值,以飞轮转速为输出量进行单比例闭环控制。
10.如权利要求1所述的一种基于自主机动的火星探测对地天线指向恢复方法,其特征在于,火星探测器采用高中低增益组合测控方案配置,高增益天线安装在探测器-Z面,具备XY轴二维驱动能力;中增益天线安装在XOZ平面,电轴指向+X偏-Z30°;低增益天线1安装在XOZ平面,电轴指向+X偏-Z45°;低增益天线2安装在XOZ平面,电轴指向-X偏+Z45°。
11.如权利要求1所述的一种基于自主机动的火星探测对地天线指向恢复方法,其特征在于,在长期稳态飞行基准为:探测器+X指向太阳,-Z轴约束在器-日-地平面内且指向地球一侧。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010623256.3A CN111891402B (zh) | 2020-06-30 | 2020-06-30 | 一种基于自主机动的火星探测对地天线指向恢复方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010623256.3A CN111891402B (zh) | 2020-06-30 | 2020-06-30 | 一种基于自主机动的火星探测对地天线指向恢复方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111891402A CN111891402A (zh) | 2020-11-06 |
CN111891402B true CN111891402B (zh) | 2022-03-04 |
Family
ID=73191562
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010623256.3A Active CN111891402B (zh) | 2020-06-30 | 2020-06-30 | 一种基于自主机动的火星探测对地天线指向恢复方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111891402B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113467492B (zh) * | 2021-06-25 | 2022-11-29 | 上海卫星工程研究所 | 深空探测器星敏感器自主切换方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968542A (zh) * | 2010-09-29 | 2011-02-09 | 中国科学院国家天文台 | 一种利用地球站对月球探测器进行跟踪的方法 |
CN103412569A (zh) * | 2013-07-11 | 2013-11-27 | 上海卫星工程研究所 | 一种火星捕获过程自主管理方法 |
CN107168347A (zh) * | 2017-05-09 | 2017-09-15 | 上海航天控制技术研究所 | 火星探测器中继通讯可见弧段自主判别及驱动控制方法 |
CN110901956A (zh) * | 2019-12-10 | 2020-03-24 | 中国人民解放军国防科技大学 | 以对地指向偏差为约束的卫星平稳对日定向方法 |
CN111130740A (zh) * | 2019-12-20 | 2020-05-08 | 成都川美新技术股份有限公司 | 一种缺失信令引导时的bgan上行信号接收方法及设备 |
CN111319791A (zh) * | 2020-02-28 | 2020-06-23 | 上海航天控制技术研究所 | 一种适用于火星探测的姿态控制模式管理方法 |
-
2020
- 2020-06-30 CN CN202010623256.3A patent/CN111891402B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968542A (zh) * | 2010-09-29 | 2011-02-09 | 中国科学院国家天文台 | 一种利用地球站对月球探测器进行跟踪的方法 |
CN103412569A (zh) * | 2013-07-11 | 2013-11-27 | 上海卫星工程研究所 | 一种火星捕获过程自主管理方法 |
CN107168347A (zh) * | 2017-05-09 | 2017-09-15 | 上海航天控制技术研究所 | 火星探测器中继通讯可见弧段自主判别及驱动控制方法 |
CN110901956A (zh) * | 2019-12-10 | 2020-03-24 | 中国人民解放军国防科技大学 | 以对地指向偏差为约束的卫星平稳对日定向方法 |
CN111130740A (zh) * | 2019-12-20 | 2020-05-08 | 成都川美新技术股份有限公司 | 一种缺失信令引导时的bgan上行信号接收方法及设备 |
CN111319791A (zh) * | 2020-02-28 | 2020-06-23 | 上海航天控制技术研究所 | 一种适用于火星探测的姿态控制模式管理方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111891402A (zh) | 2020-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0769736B1 (en) | Method for inclined orbit attitude control for momentum bias spacecraft | |
JP3667817B2 (ja) | 太陽センサと地球センサと宇宙対地上リンクを使用した宇宙船姿勢決定システム | |
CN107487458B (zh) | 一种全电推进卫星平台姿轨控执行机构的系统 | |
US7874519B2 (en) | Spacecraft three-axis attitude acquisition from sun direction measurement | |
JP2844090B2 (ja) | 静止衛星のための姿勢制御システム | |
US10046869B2 (en) | Inertial sensing augmentation for navigation of spacecraft | |
EP1772742B1 (en) | Correction of the distance between phase centres of two directional antenneas of a navigational satellite | |
US8620496B2 (en) | Systems and method of controlling a spacecraft using attitude sensors | |
US20140231589A1 (en) | Gyroless Three-Axis Sun Acquisition Using Sun Sensor and Unscented Kalman Filter | |
CN107380485B (zh) | 一种微小卫星大面阵广域多模凝视成像控制方法 | |
US7062363B2 (en) | Refinement of spacecraft angular velocity and attitude estimates using star data | |
CN112550767B (zh) | 一种卫星偏航导引下的飞轮组动量管理方法 | |
CN108423195B (zh) | 火星环绕器及环绕器全姿态无陀螺对地通信链路建立方法 | |
US6441776B1 (en) | Method and apparatus for spacecraft payload pointing registration | |
CN111891402B (zh) | 一种基于自主机动的火星探测对地天线指向恢复方法 | |
US6089508A (en) | Autonomous spacecraft safing with reaction wheels | |
Liang et al. | A Chinese small intelligent space robotic system for on-orbit servicing | |
Fritz et al. | Attitude determination and control system design for the CYGNSS microsatellite | |
JP2625337B2 (ja) | 日食中に人工衛星上の太陽トルク過渡現象を補償する方法および装置 | |
CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
Mukhayadi et al. | Attitude control of bias momentum micro satellite using magnetic and gravity gradient torque | |
CN111483617A (zh) | 一种适用于火星探测的光照最优姿态机动路径规划方法 | |
CN114063645B (zh) | 基于偏心率倾角矢量的倾斜绕飞保持控制效果评估方法 | |
JP2009190506A (ja) | 人工衛星用姿勢制御装置および人工衛星の姿勢制御方法 | |
CN114756039A (zh) | 基于零力控制的多体耦合姿态控制方法与系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |