发明名称 一种载人飞船姿态控制方法
摘要 一种载人飞船姿态控制方法,步骤为:(1)判断载人飞船是否进入手动交会对接控制模式,如果进入则进行下一步,否则退出;(2)判断手控交会对接允许标志,如果允许则进行下一步,否则退出;(3)从载人飞船姿轨控分系统获取有效的原始姿态角数据θ<sub>i</sub>和原始姿态角速度数据ω<sub>i</sub>;(4)预测载人飞船的目标姿态角θ<sub>i</sub>',θ<sub>i</sub>'=θ<sub>i</sub>+kω<sub>i</sub>,其中k为调整系数;(5)利用步骤(4)的结果,计算载人飞船姿态控制参数转移矩阵M<sub>xy,x′y′</sub>,将载人飞船的姿态角由飞船坐标系转换至显示屏坐标系;(6)根据显示屏坐标系下前后两个时刻载人飞船姿态的横、纵坐标变化,由航天员手动对载人飞船的姿态进行实时控制调整。
申请公布号 CN104216412A 申请公布日期 2014.12.17
申请号 CN201410418029.1 申请日期 2014.08.22
申请人 西安空间无线电技术研究所 发明人 赵宏科;张赤萍;钟兴旺;杨一;邢进;陶晓霞;吴刚;吴化军;高雷;范瑞俊
分类号 G05D1/08(2006.01)I;B64G1/24(2006.01)I 主分类号 G05D1/08(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 陈鹏
主权项 一种载人飞船姿态控制方法,其特征在于包括如下步骤:(1)首先判断载人飞船是否进入手动交会对接控制模式,如果进入手动交会对接控制模式则进行下一步,否则退出;(2)判断手控交会对接允许标志,如果允许手控交会对接,则进行下一步,否则退出;(3)从载人飞船姿轨控分系统获取有效的原始姿态角数据θ<sub>i</sub>和原始姿态角速度数据ω<sub>i</sub>,其中i的取值为1、2和3,分别对应载人飞船的偏航姿态、俯仰姿态、滚动姿态;(4)利用步骤(3)的结果,预测载人飞船的目标姿态角θ<sub>i</sub>',θ<sub>i</sub>'=θ<sub>i</sub>+kω<sub>i</sub>,其中k为调整系数,k=2f,f为载人飞船姿轨控分系统原始姿态角数据的更新频率;(5)利用步骤(4)的结果,计算载人飞船姿态控制参数转移矩阵M,<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open='' close=' '><mtable><mtr><mtd><mi>M</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd><mtd><mi>sin</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd><mtd><mi>cos</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>*</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><msub><mi>x</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mo>-</mo><msub><mi>y</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><msup><mrow><msub><mi>&theta;</mi><mi>i</mi></msub><mi></mi></mrow><mo>&prime;</mo></msup></mtd><mtd><mi>sin</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup><mi></mi></mtd><mtd><mo>-</mo><msub><mi>x</mi><mn>0</mn></msub><mi>cos</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup><mo>-</mo><msub><mi>y</mi><mrow><mn>0</mn><mi></mi></mrow></msub><mi>sin</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><mi>sin</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd><mtd><mi>cos</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd><mtd><mo>-</mo><msub><mi>x</mi><mn>0</mn></msub><mi>sin</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup><mo>-</mo><msub><mi>y</mi><mn>0</mn></msub><mi>cos</mi><msup><msub><mi>&theta;</mi><mi>i</mi></msub><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000558398590000011.GIF" wi="879" he="467" /></maths>将载人飞船的姿态角由飞船坐标系转换至显示屏坐标系,其中‑x<sub>0</sub>cosθ<sub>i</sub>'‑y<sub>0</sub>sinθ<sub>i</sub>'和‑x<sub>0</sub>sinθ<sub>i</sub>'‑y<sub>0</sub>cosθ<sub>i</sub>'分别为转换后显示屏坐标系下载人飞船姿态角的横坐标和纵坐标;所述的飞船坐标系的原点O为载人飞船的质心,OX指向飞行方向,OZ轴指向地球质心,OY与OX轴、OZ轴组成右手系;所述的显示屏坐标系的原点在载人飞船控制显示屏的中心,横轴沿水平方向,纵轴沿竖直方向;x<sub>0</sub>、y<sub>0</sub>表示载人飞船的姿态角映射到显示屏坐标系下的起始姿态横坐标和纵坐标;(6)利用步骤(5)的结果,根据显示屏坐标系下当前时刻和预测时刻载人飞船姿态角的横、纵坐标变化,由航天员手动对载人飞船的姿态进行实时控制调整。
地址 710100 陕西省西安市长安区西街150号