发明名称 一种航天器在惯性系内的角动量控制方法
摘要 本发明公开了一种航天器在惯性系内的角动量控制方法,该方法采用在惯性系内进行三轴稳定控制,通过将执行机构的角动量、三轴姿态角信息进行反馈设计得到反馈控制器,该方法不需要重力梯度力矩大于气动力矩,保证长期稳定飞行而执行机构不饱和,可应用于无法配置磁力矩器或磁力矩器出现故障,而又无法或不希望采用喷气方式进行卸载的航天器姿态控制中。
申请公布号 CN104290925B 申请公布日期 2016.06.29
申请号 CN201410514465.9 申请日期 2014.09.29
申请人 北京控制工程研究所 发明人 张军;何英姿;张锦江
分类号 B64G1/28(2006.01)I 主分类号 B64G1/28(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 臧春喜
主权项 一种航天器在惯性系内的角动量控制方法,其特征在于包括以下步骤:(1)在惯性坐标系内建立航天器俯仰轴、滚动轴、偏航轴上的控制器,形式如下:<maths num="0001"><math><![CDATA[<mrow><msub><mi>T</mi><mi>x</mi></msub><mo>=</mo><mo>-</mo><msub><mi>k</mi><mrow><mi>x</mi><mi>i</mi></mrow></msub><mrow><mo>&Integral;</mo><mrow><msub><mi>&theta;</mi><mi>x</mi></msub><mi>d</mi><mi>t</mi></mrow></mrow><mo>-</mo><msub><mi>k</mi><mrow><mi>k</mi><mi>p</mi></mrow></msub><msub><mi>&theta;</mi><mi>x</mi></msub><mo>-</mo><msub><mi>k</mi><mrow><mi>x</mi><mi>d</mi></mrow></msub><msub><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mi>x</mi></msub><mo>-</mo><msub><mi>k</mi><mrow><mi>x</mi><mi>h</mi><mi>i</mi></mrow></msub><mrow><mo>&Integral;</mo><mrow><msub><mi>H</mi><mrow><mi>c</mi><mi>m</mi><mi>g</mi><mi>x</mi></mrow></msub><mi>d</mi><mi>t</mi></mrow></mrow><mo>-</mo><msub><mi>k</mi><mrow><mi>x</mi><mi>h</mi></mrow></msub><msub><mi>H</mi><mrow><mi>c</mi><mi>m</mi><mi>g</mi><mi>x</mi></mrow></msub></mrow>]]></math><img file="FDA0000892766520000011.GIF" wi="1125" he="94" /></maths><maths num="0002"><math><![CDATA[<mrow><msub><mi>T</mi><mi>y</mi></msub><mo>=</mo><mo>-</mo><msub><mi>k</mi><mrow><mi>y</mi><mi>i</mi></mrow></msub><mrow><mo>&Integral;</mo><mrow><msub><mi>&theta;</mi><mi>y</mi></msub><mi>d</mi><mi>t</mi></mrow></mrow><mo>-</mo><msub><mi>k</mi><mrow><mi>y</mi><mi>p</mi></mrow></msub><msub><mi>&theta;</mi><mi>y</mi></msub><mo>-</mo><msub><mi>k</mi><mrow><mi>y</mi><mi>d</mi></mrow></msub><msub><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mi>y</mi></msub></mrow>]]></math><img file="FDA0000892766520000012.GIF" wi="614" he="86" /></maths><maths num="0003"><math><![CDATA[<mrow><msub><mi>T</mi><mi>z</mi></msub><mo>=</mo><mo>-</mo><msub><mi>k</mi><mrow><mi>z</mi><mi>i</mi></mrow></msub><mrow><mo>&Integral;</mo><mrow><msub><mi>&theta;</mi><mi>z</mi></msub><mi>d</mi><mi>t</mi></mrow></mrow><mo>-</mo><msub><mi>k</mi><mrow><mi>z</mi><mi>p</mi></mrow></msub><msub><mi>&theta;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>k</mi><mrow><mi>z</mi><mi>d</mi></mrow></msub><msub><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>-</mo><msub><mi>k</mi><mrow><mi>z</mi><mi>h</mi><mi>i</mi></mrow></msub><mrow><mo>&Integral;</mo><mrow><msub><mi>H</mi><mrow><mi>c</mi><mi>m</mi><mi>g</mi><mi>z</mi></mrow></msub><mi>d</mi><mi>t</mi></mrow></mrow><mo>-</mo><msub><mi>k</mi><mrow><mi>z</mi><mi>h</mi></mrow></msub><msub><mi>H</mi><mrow><mi>c</mi><mi>m</mi><mi>g</mi><mi>z</mi></mrow></msub></mrow>]]></math><img file="FDA0000892766520000013.GIF" wi="1102" he="95" /></maths>其中,[T<sub>x</sub> T<sub>y</sub> T<sub>z</sub>]<sup>T</sup>为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的控制力矩;[θ<sub>x</sub> θ<sub>y</sub> θ<sub>z</sub>]<sup>T</sup>为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的姿态角;<img file="FDA0000892766520000014.GIF" wi="306" he="103" />为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的角速度;[H<sub>cmgx</sub> H<sub>cmgy</sub> H<sub>cmgz</sub>]<sup>T</sup>为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上控制力矩陀螺的角动量;<maths num="0004"><math><![CDATA[<mrow><msub><mi>k</mi><mi>x</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>k</mi><mrow><mi>x</mi><mi>h</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>x</mi><mi>p</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>x</mi><mi>d</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>x</mi><mi>i</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>x</mi><mi>h</mi><mi>i</mi></mrow></msub></mtd></mtr></mtable></mfenced><mo>=</mo><msubsup><mi>B</mi><mi>x</mi><mi>T</mi></msubsup><msub><mi>S</mi><mi>x</mi></msub><mo>,</mo><msub><mi>k</mi><mi>z</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>k</mi><mrow><mi>z</mi><mi>h</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>z</mi><mi>p</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>z</mi><mi>d</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>z</mi><mi>i</mi></mrow></msub></mtd><mtd><msub><mi>k</mi><mrow><mi>z</mi><mi>h</mi><mi>i</mi></mrow></msub></mtd></mtr></mtable></mfenced><mo>=</mo><msubsup><mi>B</mi><mi>z</mi><mi>T</mi></msubsup><msub><mi>S</mi><mi>z</mi></msub><mo>,</mo></mrow>]]></math><img file="FDA0000892766520000015.GIF" wi="1645" he="92" /></maths>k<sub>yi</sub>、k<sub>yp</sub>、k<sub>yd</sub>为正的常值,k<sub>yp</sub>=J<sub>2</sub>(nω<sub>0</sub>)<sup>2</sup>,k<sub>yd</sub>=1.4J<sub>2</sub>nω<sub>0</sub>,k<sub>yi</sub>=0.01k<sub>yp</sub>,n=40~100;其中B<sub>x</sub>、S<sub>x</sub>满足方程<maths num="0005"><math><![CDATA[<mrow><msubsup><mi>A</mi><mi>x</mi><mi>T</mi></msubsup><msub><mi>S</mi><mi>x</mi></msub><mo>+</mo><msub><mi>S</mi><mi>x</mi></msub><msub><mi>A</mi><mi>x</mi></msub><mo>-</mo><msub><mi>S</mi><mi>x</mi></msub><msub><mi>B</mi><mi>x</mi></msub><msubsup><mi>B</mi><mi>x</mi><mi>T</mi></msubsup><msub><mi>S</mi><mi>x</mi></msub><mo>+</mo><msub><mi>Q</mi><mi>x</mi></msub><mo>=</mo><mn>0</mn></mrow>]]></math><img file="FDA0000892766520000016.GIF" wi="716" he="79" /></maths><maths num="0006"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msub><mi>A</mi><mi>x</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mfrac><mn>1</mn><msub><mi>J</mi><mn>1</mn></msub></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mfrac><mrow><mn>3</mn><msubsup><mi>&omega;</mi><mn>0</mn><mn>2</mn></msubsup><mrow><mo>(</mo><msub><mi>J</mi><mn>2</mn></msub><mo>-</mo><msub><mi>J</mi><mn>3</mn></msub><mo>)</mo></mrow></mrow><mn>2</mn></mfrac></mrow></mtd><mtd><mn>0</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><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></mtd><mtd><mrow><msub><mi>B</mi><mi>X</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mo>-</mo><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow></mtd></mtr></mtable><mo>,</mo></mrow>]]></math><img file="FDA0000892766520000017.GIF" wi="1051" he="455" /></maths>Q<sub>x</sub>为五行五列的正矩阵,根据选取的Q<sub>x</sub>计算得到S<sub>x</sub>;其中B<sub>z</sub>、S<sub>z</sub>满足方程<maths num="0007"><math><![CDATA[<mrow><msubsup><mi>A</mi><mi>z</mi><mi>T</mi></msubsup><msub><mi>S</mi><mi>z</mi></msub><mo>+</mo><msub><mi>S</mi><mi>z</mi></msub><msub><mi>A</mi><mi>z</mi></msub><mo>-</mo><msub><mi>S</mi><mi>z</mi></msub><msub><mi>B</mi><mi>z</mi></msub><msubsup><mi>B</mi><mi>z</mi><mi>T</mi></msubsup><msub><mi>S</mi><mi>z</mi></msub><mo>+</mo><msub><mi>Q</mi><mi>z</mi></msub><mo>=</mo><mn>0</mn></mrow>]]></math><img file="FDA0000892766520000018.GIF" wi="685" he="71" /></maths><maths num="0008"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msub><mi>A</mi><mi>z</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mfrac><mn>1</mn><msub><mi>J</mi><mn>3</mn></msub></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mfrac><mrow><mn>3</mn><msubsup><mi>&omega;</mi><mn>0</mn><mn>2</mn></msubsup><mrow><mo>(</mo><msub><mi>J</mi><mn>2</mn></msub><mo>-</mo><msub><mi>J</mi><mn>1</mn></msub><mo>)</mo></mrow></mrow><mn>2</mn></mfrac></mrow></mtd><mtd><mn>0</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><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></mtd><mtd><mrow><msub><mi>B</mi><mi>z</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mo>-</mo><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow></mtd></mtr></mtable><mo>,</mo></mrow>]]></math><img file="FDA0000892766520000021.GIF" wi="1038" he="461" /></maths>Q<sub>z</sub>为五行五列的正矩阵,根据选取的Q<sub>z</sub>计算得到S<sub>z</sub>;J<sub>1</sub>、J<sub>2</sub>、J<sub>3</sub>为航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的主转动惯量,ω<sub>0</sub>为轨道角速度;(2)星敏感器实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角θ<sub>x</sub>、θ<sub>y</sub>、θ<sub>z</sub>,并将测得的姿态角传送给地面控制计算机;(3)角速率陀螺实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的角速度<img file="FDA0000892766520000022.GIF" wi="262" he="85" />并将测得的角速度传送给地面控制计算机;(4)航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的控制力矩陀螺分别将自身实时角动量H<sub>cmgx</sub>、H<sub>cmgy</sub>、H<sub>cmgz</sub>传送给地面控制计算机;(5)地面控制计算机根据步骤(2)、(3)和(4)得到的航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角,角速度和角动量,以及步骤(1)中建立的控制器,得到航天器滚动轴、俯仰轴以及偏航轴上的控制力矩T<sub>x</sub>、T<sub>y</sub>、T<sub>z</sub>,并将该控制力矩以指令的形式上传给控制力矩陀螺,控制力矩陀螺对接收到的控制力矩指令进行解算后以该控制力矩控制航天器的在轨飞行;(6)重复执行步骤(2)—(5),在步骤(1)建立的控制器的作用下使航天器处于稳定飞行状态,控制力矩陀螺的角动量H<sub>cmgx</sub>、H<sub>cmgy</sub>、H<sub>cmgz</sub>维持一个固定值,从而实现角动量控制。
地址 100080 北京市海淀区北京2729信箱