[发明专利]一种基于增量式偏流角的动中成像卫星姿态控制方法有效

专利信息
申请号: 201410151609.9 申请日: 2014-04-15
公开(公告)号: CN103955138A 公开(公告)日: 2014-07-30
发明(设计)人: 田科丰;雷拥军;宗红;姚宁;何海锋;朱琦;吕高见;傅秀涛;綦艳霞;潘立鑫;李晶心 申请(专利权)人: 北京控制工程研究所
主分类号: G05B17/00 分类号: G05B17/00
代理公司: 中国航天科技专利中心 11009 代理人: 陈鹏
地址: 100080 *** 国省代码: 北京;11
权利要求书: 查看更多 说明书: 查看更多
摘要: 一种基于增量式偏流角的动中成像卫星姿态控制方法,适用于卫星在成像过程中三轴均具有主动旋转角速度时的姿态控制过程。传统的成像卫星姿态控制方法均只适用于卫星滚动和俯仰姿态接近于零的情况。而本发明方法在获取偏流角时,选取卫星当前目标姿态为参考基准,在偏流角的求解过程中首先求解了偏流角的增量,该增量相对于卫星当前时刻的偏航角而言,并将更新后的参考姿态矩阵作为姿态控制时的目标姿态矩阵,使得卫星姿态能够跟踪上目标姿态。本发明方法既能够满足动中成像对卫星姿态控制的需求,也可以用于传统卫星的成像过程姿态控制,使得卫星的姿态控制更加灵活。
搜索关键词: 一种 基于 增量 偏流 成像 卫星 姿态 控制 方法
【主权项】:
一种基于增量式偏流角的动中成像卫星姿态控制方法,其特征在于包括如下步骤:(1)获取卫星当前时刻的目标滚动角φr、目标俯仰角θr和目标偏航角ψr,建立参考姿态坐标系;所述的参考姿态坐标系与轨道坐标系之间的转换矩阵用CRO来表示,<mrow><msub><mi>C</mi><mi>RO</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&theta;</mi><mi>r</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&theta;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>r</mi></msub><mo>+</mo><mi>sin</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>r</mi></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&theta;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>r</mi></msub><mo>+</mo><msub><mrow><mi>sin</mi><mi>&psi;</mi></mrow><mi>r</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&theta;</mi><mi>r</mi></msub></mtd><mtd><mo>-</mo><mi>sin</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&theta;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>r</mi></msub><mo>+</mo><mi>cos</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>r</mi></msub></mtd><mtd><mi>sin</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&theta;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>r</mi></msub><mo>+</mo><mi>cos</mi><msub><mi>&psi;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><mi>sin</mi><msub><mi>&theta;</mi><mi>r</mi></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mi>r</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>r</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mi>r</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>r</mi></msub></mtd></mtr></mtable></mfenced></mrow>其中,轨道坐标系OOXOYOZO的原点OO在卫星质心,卫星的轨道平面是坐标平面,由卫星质心指向地心的坐标轴是ZO轴,XO轴在轨道平面上与ZO轴垂直并指向卫星速度方向,YO轴与XO轴、ZO轴组成右手正交坐标系;(2)根据卫星的轨道根数,获取轨道坐标系下卫星运行速度的前向分量径向分量由此得到参考姿态坐标系下卫星的运行速度<mrow><mmultiscripts><mi>v</mi><mi>s</mi><none/><mprescripts/><none/><mi>R</mi></mmultiscripts><mo>=</mo><msub><mi>C</mi><mi>RO</mi></msub><mo>&CenterDot;</mo><mfenced open='(' close=')'><mtable><mtr><mtd><mmultiscripts><mi>v</mi><mi>u</mi><none/><mprescripts/><none/><mi>o</mi></mmultiscripts></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mmultiscripts><mi>v</mi><mi>r</mi><none/><mprescripts/><none/><mi>o</mi></mmultiscripts></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>其中μ为地球引力常数,a为卫星轨道半长轴,r为卫星的地心距,e为卫星轨道偏心率,f为真近点角;(3)定义新的惯性坐标系I',所述I'中的坐标(X',Y',Z')与J2000惯性坐标系I中的坐标(X,Y,Z)满足关系式<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>X</mi><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><msup><mi>Y</mi><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><msup><mi>Z</mi><mo>&prime;</mo></msup></mtd></mtr></mtable></mfenced><mo>=</mo><msub><mi>C</mi><mrow><msup><mi>I</mi><mo>&prime;</mo></msup><mi>I</mi></mrow></msub><mfenced open='[' close=']'><mtable><mtr><mtd><mi>X</mi></mtd></mtr><mtr><mtd><mi>Y</mi></mtd></mtr><mtr><mtd><mi>Z</mi></mtd></mtr></mtable></mfenced></mrow>其中,<mrow><msub><mi>C</mi><mrow><msup><mi>I</mi><mo>&prime;</mo></msup><mi>I</mi></mrow></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>K</mi></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>K=1.0033633486;(4)计算获得在新的惯性坐标系I'下,卫星上搭载的有效载荷光学系统的光轴矢量在J2000惯性坐标系I下的表达形式其中为J2000惯性坐标系到轨道坐标系的姿态转换矩阵的转置,<mrow><mi>s</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>C</mi><mi>RO</mi></msub><mrow><mo>(</mo><mn>3,1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>C</mi><mi>RO</mi></msub><mrow><mo>(</mo><mn>3,2</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>C</mi><mi>RO</mi></msub><mrow><mo>(</mo><mn>3,3</mn><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow>为参考姿态坐标系下的光轴指向单位矢量;Re为地球半径,<mrow><mmultiscripts><mi>r</mi><mi>s</mi><none/><mprescripts/><none/><mi>I</mi></mmultiscripts><mo>=</mo><mi>r</mi><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><mi>&Omega;</mi><mo>)</mo></mrow><mi>cos</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>-</mo><mi>sin</mi><mrow><mo>(</mo><mi>&Omega;</mi><mo>)</mo></mrow><mi>cos</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><mi>&Omega;</mi><mo>)</mo></mrow><mi>cos</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>+</mo><mi>cos</mi><mrow><mo>(</mo><mi>&Omega;</mi><mo>)</mo></mrow><mi>cos</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>Ω为卫星轨道的升交点赤经,u为卫星轨道幅角,i为卫星轨道倾角,|·|表示取模,sin2γ'm=1‑cos2γ'm;CRO(3,1)、CRO(3,2)、CRO(3,3)分别表示矩阵CRO的第3行第1个元素、第3行第2个元素、第3行第3个元素;(5)根据步骤(4)的结果,计算得到由卫星惯性姿态参考角速度ωRI引起的地面目标点相对于卫星的运行速度在参考姿态坐标系下的分量R=ωRI×00|rZbI|;]]>R=CROCOIverI,]]>其中<mrow><mmultiscripts><mi>v</mi><mi>er</mi><none/><mprescripts/><none/><mi>I</mi></mmultiscripts><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>&omega;</mi><mi>e</mi></msub></mtd></mtr></mtable></mfenced><mo>&times;</mo><mmultiscripts><mi>R</mi><mi>e</mi><none/><mprescripts/><none/><mi>I</mi></mmultiscripts><mo>,</mo></mrow><mrow><mmultiscripts><mi>R</mi><mi>e</mi><none/><mprescripts/><none/><mi>I</mi></mmultiscripts><mo>=</mo><mmultiscripts><mi>r</mi><mi>s</mi><none/><mprescripts/><none/><mi>I</mi></mmultiscripts><mo>+</mo><mo>|</mo><mmultiscripts><mi>r</mi><mi>Zb</mi><none/><mprescripts/><none/><msup><mi>I</mi><mo>&prime;</mo></msup><none/><none/></mmultiscripts><mo>|</mo><mo>&CenterDot;</mo><mfrac><mrow><msup><msub><mi>C</mi><mi>OI</mi></msub><mi>T</mi></msup><mo>&CenterDot;</mo><mi>s</mi></mrow><mrow><mo>|</mo><msub><mi>C</mi><mrow><msup><mi>I</mi><mo>&prime;</mo></msup><mi>I</mi></mrow></msub><mo>&CenterDot;</mo><msup><msub><mi>C</mi><mi>OI</mi></msub><mi>T</mi></msup><mo>&CenterDot;</mo><mi>s</mi><mo>|</mo></mrow></mfrac><mo>,</mo></mrow>ωe表示地球自转角速度的大小;(7)根据步骤(2)、步骤(5)、步骤(6)的结果,计算得到卫星光轴指向地面目标点相对于卫星的线速度在参考姿态坐标系下的表达式为RvesRverRvsRvre;(8)根据步骤(7)的结果,计算得到所述有效载荷成像时的偏流角增量式中括号中的数字表示选取矢量Rves中的第几个元素参与计算;(9)取ψrr+△ψp得到更新后的目标偏航角,并进一步得到更新后的参考姿态坐标系与轨道坐标系之间的转换矩阵CRO新;(10)利用CRO新作为卫星姿态矩阵的目标值对卫星的三轴进行姿态控制。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京控制工程研究所,未经北京控制工程研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/patent/201410151609.9/,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top