发明名称 |
一种火星探测器无陀螺自主空间姿态机动控制方法 |
摘要 |
本发明公开一种火星探测器无陀螺自主空间姿态机动控制方法,适用于探测器不同定向目标间的姿态机动控制,不依靠陀螺数据而仅依靠星敏感器数据完成任意指向的姿态机动。探测器姿态机动前确定目标姿态四元素,使用飞轮闭环控制星体绕欧拉轴以最短路径完成姿态机动。与现有技术相比,该方法以最小硬件配置,即星敏感器和飞轮,可以最短路径完成任意指向的姿态机动,具有实用性。 |
申请公布号 |
CN103019247B |
申请公布日期 |
2016.12.07 |
申请号 |
CN201110289817.1 |
申请日期 |
2011.09.27 |
申请人 |
上海航天控制工程研究所 |
发明人 |
尹海宁;周连文;聂章海;杜宁;李芳华;蔡陈生;袁彦红 |
分类号 |
G05D1/08(2006.01)I |
主分类号 |
G05D1/08(2006.01)I |
代理机构 |
上海航天局专利中心 31107 |
代理人 |
冯和纯 |
主权项 |
一种火星探测器无陀螺自主空间姿态机动控制方法,其特征在于包括如下步骤:1)探测器进入姿态机动模式前,首先使用推力器将飞轮转速卸载,使飞轮角动量达到姿态机动前的需要;2)探测器进入姿态机动模式后,根据目标姿态四元素和当前星体姿态四元素计算姿态机动欧拉轴和欧拉角;3)根据飞轮转动动量和星体惯量计算姿态机动角速度,确定星体机动加速时间t<sub>on</sub>与星体机动时间t<sub>s</sub>,这两个时间取值的确定必须保证反作用飞轮的转速不超过其最大转速;确定星体机动加速时间t<sub>on</sub>与星体机动时间t<sub>s</sub>的计算公式为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>t</mi><mrow><mi>o</mi><mi>n</mi></mrow></msub><mo>=</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><mo>[</mo><msub><mi>t</mi><mi>s</mi></msub><mo>-</mo><msqrt><mrow><msubsup><mi>t</mi><mi>s</mi><mn>2</mn></msubsup><mo>-</mo><mfrac><mrow><mn>4</mn><msub><mi>φ</mi><mi>f</mi></msub></mrow><mi>α</mi></mfrac></mrow></msqrt><mo>]</mo></mrow>]]></math><img file="FSB0000155191380000011.GIF" wi="496" he="176" /></maths>对于迭代求解,最好的t<sub>s</sub>初始迭代值为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>t</mi><mi>s</mi></msub><mo>=</mo><mn>2</mn><msqrt><mfrac><msub><mi>φ</mi><mi>f</mi></msub><mi>α</mi></mfrac></msqrt></mrow>]]></math><img file="FSB0000155191380000012.GIF" wi="229" he="148" /></maths>式中:t<sub>on</sub>为星体机动加速时间;t<sub>s</sub>为星体机动时间;φ<sub>f</sub>为姿态机动欧拉角;α为机动角加速度;4)采用前馈+反馈策略的解耦控制律,探测器姿态准确跟踪机动规划的角速度和控制力矩。 |
地址 |
200233 上海市徐汇区田林路130号 |