CN103019252B - 一种火星探测器自主对地定向控制方法 - Google Patents
一种火星探测器自主对地定向控制方法 Download PDFInfo
- Publication number
- CN103019252B CN103019252B CN201110289865.0A CN201110289865A CN103019252B CN 103019252 B CN103019252 B CN 103019252B CN 201110289865 A CN201110289865 A CN 201110289865A CN 103019252 B CN103019252 B CN 103019252B
- Authority
- CN
- China
- Prior art keywords
- earth
- absolute orientation
- flywheel
- axis
- mars
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种火星探测器自主对地定向控制方法,使用于火星探测器任意姿态情况下完成全姿态捕获地球和对地定向,仅仅使用星敏感器作测量,反作用飞轮作为执行部件提供控制力矩。直接使用星敏感器的测量值,无须通过滤波算法确定姿态,实现了不依赖陀螺的安全模式。与现有技术相比,该方法不依赖地球敏感器和陀螺,能够自主完成全姿态捕获地球和对地定向,有较强的实用推广价值。
Description
技术领域
本发明涉及火星探测器对地球定向姿态控制技术,尤其是用于火星探测器任意姿态情况下完成对地定向,仅仅使用星敏感器作测量部件,反作用飞轮作为执行部件提供控制力矩。直接使用星敏感器的测量值,不须通过滤波算法确定姿态,符合最小硬件配置原则。
背景技术
国内研制火星探测器,在执行火星探测任务时,首先要数传天线对地定向,确保科学探测数据能够下传,在深空探测中,没有直接的地球敏感器可以测量对地姿态信息,需要星上自主进行火星、地球公转轨道及星历递推来确定对地定向基准,另外,由于火星与地球距离遥远无法进行实时遥控,火星探测器必须能够在任意姿态情况下自主完成捕获地球和对地定向,因此,需要研制一种火星探测器自主对地定向技术。
发明内容
针对现有技术不足,本发明要解决的技术问题是提供一种火星探测器自主对地定向控制方法,无需陀螺的角速度数据作为反馈,采用星敏感器和飞轮的最小配置,能够在任意姿态情况下自主完成捕获地球和对地定向。
为解决上述技术问题,本发明是通过以下的技术方案实现的,一种火星探测器自主对地定向控制方法,其具体包括如下步骤:
1.通过计算地球、火星的星历得到火星对地球指向矢量,根据对地坐标系的定义,计算惯性坐标系到对地定向基准坐标系的转换四元数;
2.采用前馈+反馈策略的解耦控制律计算飞轮转速指令,通过飞轮转速控 制实现对地定向机动;
3.对地机动完成后,利用星敏感器测量值计算的姿态角作为P项反馈,姿态角积分作为I项反馈,利用飞轮PI控制律进行对地稳态控制;
4.设置对地定向时间限制,进行计时或者整星蓄电池电量判断,当发生超时或者能源危机时自主转回对日定向模式;
本发明采用的方法与现有技术相比,其优点和有益效果是:
该发明方法,解决了火星探测任意姿态情况下捕获地球和对地定向问题,火星探测器长期运行时不需要陀螺测量信息,也可以降低火星探测器对陀螺的配置要求,从而增加系统长期运行的可靠性。
附图说明
以下将结合附图和实施例对本发明作进一步说明。
图1是本发明方法对地定向关系示意图。
具体实施方式
当火星探测器进入全姿态捕获地球时,首先根据星上系统时钟值计算对地定向基准,进行对地定向机动,完成对地机动后,进入对地定向稳态控制以完成对地数传。各模式下的具体实施方式如下所述。
如图1所示,对地定向姿态基准由火星指向地球的矢量rem和地球公转轨道的法线矢量he确定。火星与地球连线并指向地球为+Zre向,火星指向地球矢量rem和地球公转面法线矢量he所在平面的法线为+Xre,Yre轴根据右手坐标系法则得到,对地定向基准计算过程如下:
地球平根数计算
式中:
为地球公转轨道半长轴;
为地球公转轨道偏心率;
为地球公转轨道倾角;
为地球公转轨道升交点赤经;
为地球公转轨道近日点幅角;
为地球公转轨道平近点角。
地球位置计算
式中:
fe为地球公转轨道真近点角;
re为地球太阳之间的距离;
ue为地球公转轨道升交点幅角。
地球绕太阳运动的位置在日心黄道坐标系中的分量为
火星平根数计算
式中:
为火星公转轨道半长轴;
为火星公转轨道偏心率;
为火星公转轨道倾角;
为火星公转轨道升交点赤经;
为火星公转轨道近日点幅角;
为火星公转轨道平近点角。
火星位置计算
式中:
fM为火星公转轨道真近点角;
rM为火星太阳之间的距离;
uM为火星公转轨道升交点幅角。
火星绕太阳运动的位置在日心黄道坐标系中的分量为
通过星历递推,可以得到日心黄道坐标系下的地球绕太阳的位置矢量 火星绕太阳的位置矢量 设火星指向地球球心的矢量为 对地定向基准 坐标系3个轴向的单位矢量分别为 则
日心黄道坐标系到对地定向基准坐标系的转换矩阵Cr_E为
转换为四元素形式得到qre
日心地球赤道惯性坐系到日心黄道坐标系的转换四元数 为
日心地球赤道惯性坐标系到对地定向基准坐标系的转换四元数qrEi为
根据星敏感器测量到的星体四元素qib和对地定向基准四元素qrEi,可以计算得到姿态机动四元素:
对地机动过程中飞轮指令计算如下:
式中:
是星体的角动量变化(星体初始角速度认为0);
φ为星体绕欧拉轴的欧拉转角;
A(q)是星体当前指向相对机动开始时刻星体指向的方向余弦阵;
I是包括飞轮在内的星体惯量矩阵;
Iw是飞轮的惯量阵;
B飞轮的指令分配矩阵(B-1则为飞轮安装矩阵);
Ω飞轮转速矢量。
对地机动到位后,星敏感器测量值与对地基准四元素计算偏差四元素为:
q0为标量;
滚动姿态角
俯仰姿态角θ=2*q2;
偏航姿态角ψ=2*q3
对地定向稳态模式下闭环控制律计算:
式中Rx——滚动轴飞轮转速指令;
Ry——俯仰轴飞轮转速指令;
Rz——偏航轴飞轮转速指令;
Kp1——滚动轴P项反馈系数;
Kp2——俯仰轴P项反馈系数;
Kp3——偏航轴P项反馈系数;
Ki1——滚动轴I项反馈系数;
Ki2——俯仰轴I项反馈系数;
Ki3——偏航轴I项反馈系数;
t0——进入对地定向的起始时刻;
t——当前时刻。
Claims (4)
1.火星探测器自主对地定向控制方法,其特征在于包括如下步骤:
1)根据地球、火星的星历计算火星对地球指向矢量,通过定义对地坐标系计算惯性坐标系到对地定向基准坐标系的转换四元数;
2)采用前馈+反馈策略的解耦控制律计算飞轮转速指令,以此进行对地定向机动控制;
3)对地机动完成后,利用星敏感器测量值计算的姿态角作为P项反馈,姿态角积分作为I项反馈,进行PI对地稳态控制;
4)设置对地定向时间限制,进行计时或者整星蓄电池电量判断,当发生超时或者能源危机时自主转回对日定向模式。
2.根据权利要求1所述的火星探测器自主对地定向控制方法,其特征在于:所述步骤1)中,
日心地球赤道惯性坐标系到对地定向基准坐标系的转换四元数qrEi计算公式为:
式中:
qrEi为对地基准四元素;
为日心惯性系到日心黄道系转换四元素;
qrE为日心黄道系到对地基准系转换四元素。
3.根据权利要求1或2所述的火星探测器自主对地定向控制方法,其特征在于:所述步骤2)中对地机动过程中飞轮指令计算公式为:
式中:
是星体的角动量变化,星体初始角速度认为0;
φ为星体绕欧拉轴的欧拉转角;
A(q)是星体当前指向相对机动开始时刻星体指向的方向余弦阵;
I是包括飞轮在内的星体惯量矩阵;
Iw是飞轮的惯量阵;
B飞轮的指令分配矩阵,B-1则为飞轮安装矩阵;
Ω飞轮转速矢量;
Ω0为机动开始时刻的飞轮转速矢量;
是飞轮惯量阵的逆矩阵。
4.根据权利要求3所述的火星探测器自主对地定向控制方法,其特征在于:所述步骤3)中,对地定向稳态模式下闭环控制律计算公式为:
式中Rx——滚动轴飞轮转速指令;
Ry——俯仰轴飞轮转速指令;
Rz——偏航轴飞轮转速指令;
Kp1——滚动轴P项反馈系数;
Kp2——俯仰轴P项反馈系数;
Kp3——偏航轴P项反馈系数;
Ki1——滚动轴I项反馈系数;
Ki2——俯仰轴I项反馈系数;
Ki3——偏航轴I项反馈系数;
t0——进入对地定向的起始时刻;
t——当前时刻;
φ为滚动姿态角;
θ为俯仰姿态角;
ψ为偏航姿态角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110289865.0A CN103019252B (zh) | 2011-09-27 | 2011-09-27 | 一种火星探测器自主对地定向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110289865.0A CN103019252B (zh) | 2011-09-27 | 2011-09-27 | 一种火星探测器自主对地定向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103019252A CN103019252A (zh) | 2013-04-03 |
CN103019252B true CN103019252B (zh) | 2016-12-07 |
Family
ID=47967959
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110289865.0A Active CN103019252B (zh) | 2011-09-27 | 2011-09-27 | 一种火星探测器自主对地定向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103019252B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111431589A (zh) * | 2020-05-07 | 2020-07-17 | 亚太卫星宽带通信(深圳)有限公司 | 一种基于火星静止轨道卫星的火星表面通信星座 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104354877B (zh) * | 2014-10-27 | 2016-08-24 | 中国运载火箭技术研究院 | 一种基于地球-火星循环轨道的载人火星探测系统及方法 |
CN105438499B (zh) * | 2015-11-17 | 2017-06-06 | 上海新跃仪表厂 | 绕空间轴的偏流角跟踪控制方法 |
CN106681175A (zh) * | 2017-02-24 | 2017-05-17 | 上海航天控制技术研究所 | 减小反作用飞轮接入半物理系统时延迟的离散化方法 |
CN106767846B (zh) * | 2017-03-13 | 2019-10-25 | 上海航天控制技术研究所 | 三轴稳定卫星不用陀螺的姿态获取方法和系统 |
CN107600464B (zh) * | 2017-09-18 | 2019-08-23 | 上海航天控制技术研究所 | 利用星敏感器信息的飞轮控制捕获太阳及对日定向方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2057731A1 (fr) * | 1990-12-21 | 1992-06-22 | Patrick Flament | Procede de reacquisition d'attitude par reconnaissance d'etoile pour satellite stabilise 3-axes |
DE19520410A1 (de) * | 1995-06-09 | 1996-12-12 | Daimler Benz Aerospace Ag | Erdorientierter Satellit und Verfahren zur Lage-, Nutations- und Raddrallregelung |
CN101082494A (zh) * | 2007-06-19 | 2007-12-05 | 北京航空航天大学 | 一种基于预测滤波和upf航天器自标定方法 |
CN101934863A (zh) * | 2010-09-29 | 2011-01-05 | 哈尔滨工业大学 | 基于磁力矩器和飞轮的卫星姿态全方位控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7546983B2 (en) * | 2003-12-03 | 2009-06-16 | The Boeing Company | Spacecraft power acquisition method for wing-stowed configuration |
KR100666160B1 (ko) * | 2004-12-29 | 2007-01-09 | 한국항공우주연구원 | 궤도기하학을 이용한 인공위성 자기센서의 바이어스보정방법 |
-
2011
- 2011-09-27 CN CN201110289865.0A patent/CN103019252B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2057731A1 (fr) * | 1990-12-21 | 1992-06-22 | Patrick Flament | Procede de reacquisition d'attitude par reconnaissance d'etoile pour satellite stabilise 3-axes |
DE19520410A1 (de) * | 1995-06-09 | 1996-12-12 | Daimler Benz Aerospace Ag | Erdorientierter Satellit und Verfahren zur Lage-, Nutations- und Raddrallregelung |
CN101082494A (zh) * | 2007-06-19 | 2007-12-05 | 北京航空航天大学 | 一种基于预测滤波和upf航天器自标定方法 |
CN101934863A (zh) * | 2010-09-29 | 2011-01-05 | 哈尔滨工业大学 | 基于磁力矩器和飞轮的卫星姿态全方位控制方法 |
Non-Patent Citations (5)
Title |
---|
基于四元数反馈线性化的飞行器姿态控制方法研究;程英容等;《航天控制》;20071031;第25卷(第5期);第13-16页 * |
基于陀螺和星敏感器的卫星姿态确定研究;周朝阳;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20120715;第C031-414页 * |
星间目标捕获与跟踪指向复合控制系统研究;张子龙;《全国第十二届空间及运动体控制技术学术年会论文》;20060801;第59-64页 * |
火星探测器全模式飞行的姿态控制技术研究;薛浩飞;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20111215;第C031-470页 * |
萤火一号探测器的关键技术与设计特点;陈昌亚等;《空间科学学报》;20091031;第29卷(第5期);第456-461页 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111431589A (zh) * | 2020-05-07 | 2020-07-17 | 亚太卫星宽带通信(深圳)有限公司 | 一种基于火星静止轨道卫星的火星表面通信星座 |
Also Published As
Publication number | Publication date |
---|---|
CN103019252A (zh) | 2013-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103019252B (zh) | 一种火星探测器自主对地定向控制方法 | |
CN105116910B (zh) | 一种对地面点凝视成像的卫星姿态控制方法 | |
CN104792340B (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
CN103033189B (zh) | 一种深空探测巡视器惯性/视觉组合导航方法 | |
CN104848860B (zh) | 一种敏捷卫星成像过程姿态机动规划方法 | |
CN104570742B (zh) | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 | |
CN104898642B (zh) | 一种用于航天器姿态控制算法的集成测试仿真系统 | |
CN103017760B (zh) | 一种大椭圆轨道火星探测器自主对火定向方法 | |
CN106125745B (zh) | 一种对空间合作目标跟踪成像的卫星姿态控制方法 | |
CN104332707A (zh) | 一种用于低轨星载天线跟踪地面站的方法 | |
CN105905317A (zh) | 一种卫星对日定向控制系统及其控制方法 | |
CN103019247A (zh) | 一种火星探测器无陀螺自主空间姿态机动控制方法 | |
CN104729457B (zh) | 太阳相对近地轨道微小卫星位置的确定方法 | |
CN106292677B (zh) | 基于恒星时角的姿态控制方法和系统 | |
CN106155074A (zh) | 一种保证星地链路的卫星三轴对日定向控制方法 | |
CN107655485A (zh) | 一种巡航段自主导航位置偏差修正方法 | |
CN108181916A (zh) | 小卫星相对姿态的控制方法及装置 | |
CN106197434A (zh) | 基于地面目标点位置的卫星姿态角的计算方法 | |
CN105160125A (zh) | 一种星敏感器四元数的仿真分析方法 | |
CN104123461B (zh) | 一种用于空间物体光度分析的光照可视关系计算方法 | |
CN102116633B (zh) | 深空光学导航图像处理算法仿真验证方法 | |
CN102735265B (zh) | 一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 | |
CN112014869A (zh) | 基于天文导航的星间链路自主导航方法及系统 | |
CN104567881A (zh) | 一种基于太阳、地心及月表重力矢量的巡视器位置姿态确定方法 | |
CN104714243B (zh) | 近地轨道微小卫星所在位置地磁场强度的确定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |