发明名称 基于非线性轨道计算的航天器制导控制方法及系统
摘要 基于非线性轨道计算的航天器制导控制方法及系统,首先获取航天器当前轨道计算的系统状态方程并降维得到控制变量的低阶方程,然后通过计算降维后得到的中间量而得到控制变量,最后根据控制变量控制航天器飞行轨道,并以用户指定的周期检查跟航天器轨道计算有关的参数变化,如果检查到变化重新计算控制变量来调整航天器飞行轨道,如果没有检查到变化,航天器按照原计算轨道运行。本发明填补了传统航天器领域的空白,使航天器具有了实时的最优轨道跟踪能力,提高了航天器在障碍规避、突破拦截等方面的表现。
申请公布号 CN104369875B 申请公布日期 2016.05.04
申请号 CN201410602696.5 申请日期 2014.10.31
申请人 中国运载火箭技术研究院 发明人 崔毅楠;张恒;解洪文;何漫;刘佳;王晓路;董伟;宁学;毕经元;张冶;陆小兵;王立伟;王长庆
分类号 B64G1/24(2006.01)I 主分类号 B64G1/24(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 陈鹏
主权项 基于非线性轨道计算的航天器制导控制方法,其特征在于包括如下步骤:(1)从外界获取航天器轨道计算的边界条件、航天器控制变量的上下边界、节点间隔数、多项式最高次数、平滑度、约束条件和成本函数,然后调用NPSOL计算得样条参数<img file="FDA0000856353310000012.GIF" wi="93" he="69" />所述约束条件包括航天器发射时间、发射地点、目标位置、最大过载、最大速度、射面、燃料消耗速度、距离障碍物的最小距离、攻角范围、姿态角变化速度;所述成本函数是轨道计算优化目标与约束条件的函数关系;(2)获取航天器当前轨道计算的系统状态方程并记为x<sup>(1)</sup>=f(x,u),其中x为航天器状态变量,u为航天器控制变量,将系统状态方程x<sup>(1)</sup>=f(x,u)降维得到z=g(x,u,u<sup>(1)</sup>,u<sup>(2)</sup>,u<sup>(3)</sup>,……,u<sup>(r)</sup>)其中x<sup>(1)</sup>为状态变量x的一阶导数,u<sup>(i)</sup>为u的i阶导数,i=1,2…r,z为向量,向量中的元素记为z<sub>j</sub>,j为正整数;所述控制变量u为发动机推力姿态控制喷管推力;(3)获取样条基函数<img file="FDA0000856353310000013.GIF" wi="117" he="78" />使用步骤(1)计算得到的样条参数<img file="FDA0000856353310000014.GIF" wi="63" he="71" />计算z向量中的元素z<sub>j</sub>为<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>z</mi><mi>j</mi></msub><mo>=</mo><munderover><mo>&Sigma;</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><msub><mi>q</mi><mi>j</mi></msub></munderover><msub><mi>B</mi><mrow><mi>i</mi><mo>,</mo><msub><mi>k</mi><mi>j</mi></msub></mrow></msub><msubsup><mi>C</mi><mi>i</mi><mi>j</mi></msubsup></mrow>]]></math><img file="FDA0000856353310000011.GIF" wi="302" he="143" /></maths>将得到的z<sub>j</sub>带入z=g(x,u,u<sup>(1)</sup>,u<sup>(2)</sup>,u<sup>(3)</sup>,……,u<sup>(r)</sup>)后计算得到控制变量u,其中:q<sub>j</sub>=l<sub>j</sub>(k<sub>j</sub>‑m<sub>j</sub>)+m<sub>j</sub>,l<sub>j</sub>是节点间隔数,k<sub>j</sub>是多项式最高次数,m<sub>j</sub>是平滑度;(4)航天器在飞行过程中根据控制变量u控制飞行轨道,并周期性检查航天器轨道计算的边界条件、航天器控制变量的上下边界、节点间隔数、多项式最高次数、平滑度、约束条件或者成本函数是否发生变化,如果检查到变化返回步骤(1)计算得到新的样条参数<img file="FDA0000856353310000015.GIF" wi="86" he="71" />并将新的样条参数<img file="FDA0000856353310000016.GIF" wi="62" he="71" />依次代入步骤(3)计算得到新的控制变量u,并用新的控制变量u控制航天器飞行轨道;如果没有检查到变化,则不进行任何操作。
地址 100076 北京市丰台区北京9200信箱38分箱