发明名称 一种基于弹道阻尼控制和热流解析预测的引入段制导方法
摘要 本发明一种基于弹道阻尼控制和热流解析预测的引入段制导方法,包括以下步骤:(1)引入段制导问题建模,包括动力学方程建模、过程约束和终端约束建模;(2)热流密度约束转换关系求解;通过对给定纵向升力系数下的引入段弹道进行积分,获得最大热流密度约束与最小纵向升力系数之间的显式关系;(3)定阻尼微分反馈控制方案,保证引入段的终端高度、弹道倾角的收敛;(4)升力系数和倾侧角分配,保证引入段终端攻角和倾侧角与滑翔段的期望攻角和倾侧角无缝衔接。本发明提出的引入段制导方法能够闭环解析的考虑包括热流密度过程约束和多个终端约束,具有计算简单,鲁棒性好的特点。
申请公布号 CN104965418A 申请公布日期 2015.10.07
申请号 CN201510292067.1 申请日期 2015.06.01
申请人 北京航空航天大学 发明人 陈万春;胡锦川;粟剑文
分类号 G05B17/02(2006.01)I 主分类号 G05B17/02(2006.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种基于弹道阻尼控制和热流解析预测的引入段制导方法,其特征在于:它包括以下几个步骤:<u>步骤1</u>:引入段制导问题建模,包括动力学方程建模、过程约束和终端约束建模:(1)动力学方程如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open='' close=''><mtable><mtr><mtd><mover><mi>h</mi><mo>.</mo></mover><mo>=</mo><mi>V </mi><mi>sin</mi><mi>&gamma;</mi></mtd><mtd><mover><mi>s</mi><mo>.</mo></mover><mo>=</mo><mi>rV </mi><mi>cos</mi><mi>&gamma;</mi><mo>/</mo><msub><mi>R</mi><mn>0</mn></msub></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000728799430000011.GIF" wi="584" he="81" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mover><mi>&gamma;</mi><mo>.</mo></mover><mo>=</mo><mfrac><mn>1</mn><mi>V</mi></mfrac><mo>[</mo><msub><mi>L</mi><mn>1</mn></msub><mo>+</mo><mrow><mo>(</mo><msup><mi>V</mi><mn>2</mn></msup><mo>/</mo><mi>r</mi><mo>-</mo><mi>g</mi><mo>)</mo></mrow><mi>cos</mi><mi>&gamma;</mi><mo>]</mo></mrow>]]></math><img file="FDA0000728799430000012.GIF" wi="594" he="120" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mover><mi>V</mi><mo>.</mo></mover><mo>=</mo><mo>-</mo><mi>D</mi><mo>-</mo><mi>g </mi><mi>sin</mi><mi>&gamma;</mi></mrow>]]></math><img file="FDA0000728799430000013.GIF" wi="346" he="78" /></maths>式中,h、V、γ、s分别为再入飞行器的高度、速度、弹道倾角和飞行距离;<img file="FDA0000728799430000014.GIF" wi="72" he="73" /><img file="FDA0000728799430000015.GIF" wi="214" he="80" />分别为再入飞行器的高度、速度、弹道倾角和飞行距离对时间的导数;r为从地心至飞行器的径向距离,与高度的关系为h=r‑R<sub>0</sub>,其中R<sub>0</sub>为地球半径;g为重力加速度;L<sub>1</sub>和D分别为升力加速度纵向分量和阻力加速度;(2)过程约束如下:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mover><mi>Q</mi><mo>.</mo></mover><mo>=</mo><mi>k</mi><msqrt><mi>&rho;</mi></msqrt><msup><mi>V</mi><mrow><mn>3</mn><mo>.</mo></mrow></msup><mo>&le;</mo><msub><mover><mi>Q</mi><mo>.</mo></mover><mi>max</mi></msub></mrow>]]></math><img file="FDA0000728799430000016.GIF" wi="549" he="117" /></maths>α<sub>min</sub>≤α≤α<sub>max</sub> |σ|≤σ<sub>max</sub>式中,<img file="FDA0000728799430000017.GIF" wi="56" he="82" />为热流密度;<img file="FDA0000728799430000018.GIF" wi="111" he="85" />为最大热流密度;k为常数,取值为k=5.188×10<sup>‑8</sup>;α和σ分别为攻角和倾侧角,是引入段制导问题的控制变量;α<sub>min</sub>和α<sub>max</sub>分别为最小攻角和最大攻角;σ<sub>max</sub>为最大倾侧角;(3)终点约束如下:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>h</mi><mi>f</mi></msub><mo>=</mo><mo>-</mo><mi>ln</mi><mo>[</mo><mrow><mo>(</mo><mi>g</mi><mo>/</mo><msubsup><mi>V</mi><mi>f</mi><mn>2</mn></msubsup><mo>-</mo><mn>1</mn><mo>/</mo><mi>r</mi><mo>)</mo></mrow><mo>/</mo><mrow><mo>(</mo><msub><mi>k</mi><mi>c</mi></msub><msubsup><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow><mo>*</mo></msubsup><mo>)</mo></mrow><mo>]</mo><mo>/</mo><msub><mi>&beta;</mi><mi>r</mi></msub></mrow>]]></math><img file="FDA0000728799430000019.GIF" wi="913" he="128" /></maths><maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>&gamma;</mi><mi>f</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>[</mo><msub><mi>f</mi><mi>a</mi></msub><mrow><mo>(</mo><msub><mi>V</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>f</mi><mi>V</mi></msub><mrow><mo>(</mo><msub><mi>V</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>]</mo><mrow><mo>(</mo><mi>g</mi><mo>-</mo><msup><mi>V</mi><mn>2</mn></msup><mo>/</mo><mi>r</mi><mo>)</mo></mrow></mrow><mrow><msub><mi>&beta;</mi><mi>r</mi></msub><msubsup><mi>VK</mi><mn>1</mn><mo>*</mo></msubsup><mo>+</mo><msubsup><mi>gK</mi><mn>1</mn><mo>*</mo></msubsup><mo>[</mo><msub><mi>f</mi><mi>a</mi></msub><mrow><mo>(</mo><msub><mi>V</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>f</mi><mi>V</mi></msub><mrow><mo>(</mo><msub><mi>V</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>]</mo></mrow></mfrac></mrow>]]></math><img file="FDA00007287994300000110.GIF" wi="981" he="220" /></maths>式中,V<sub>f</sub>为终端速度;<img file="FDA00007287994300000111.GIF" wi="80" he="82" />和<img file="FDA00007287994300000112.GIF" wi="71" he="94" />分别为期望纵向升力系数和纵向升阻比;k<sub>c</sub>为组合常数;β<sub>r</sub>为指数大气模型常数;f<sub>a</sub>和f<sub>V</sub>分别为速度相关的函数,如下所示,<maths num="0007" id="cmaths0007"><math><![CDATA[<mfenced open='' close=''><mtable><mtr><mtd><msub><mi>f</mi><mi>a</mi></msub><mo>=</mo><mrow><mo>(</mo><msubsup><mrow><mo>&PartialD;</mo><mi>C</mi></mrow><mrow><mi>L</mi><mn>1</mn></mrow><mo>*</mo></msubsup><mo>/</mo><mo>&PartialD;</mo><mi>V</mi><mo>)</mo></mrow><mo>/</mo><msubsup><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow><mo>*</mo></msubsup></mtd><mtd><msub><mi>f</mi><mi>V</mi></msub><mo>=</mo><mn>2</mn><mi>g</mi><mo>/</mo><mrow><mo>(</mo><mi>gV</mi><mo>-</mo><msup><mi>V</mi><mn>3</mn></msup><mo>/</mo><mi>r</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000728799430000021.GIF" wi="924" he="110" /></maths>上式中,<img file="FDA0000728799430000022.GIF" wi="196" he="88" />为<img file="FDA0000728799430000023.GIF" wi="76" he="82" />对V的偏导数,f<sub>a</sub>(V<sub>f</sub>)和f<sub>V</sub>(V<sub>f</sub>)是终端速度V<sub>f</sub>对应的f<sub>a</sub>和f<sub>V</sub>;<u>步骤2</u>:热流密度约束转换关系求解;通过对给定纵向升力系数下的引入段弹道进行积分,获得最大热流密度约束与最小纵向升力系数之间的显式关系,包含如下内容:(1)高度与弹道倾角关系<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mi>cos</mi><msub><mi>&gamma;</mi><mi>ter</mi></msub><mo>-</mo><mi>cos</mi><mi>&gamma;</mi><mo>=</mo><mfrac><msub><mi>K</mi><mn>1</mn></msub><msub><mi>&beta;</mi><mi>r</mi></msub></mfrac><mrow><mo>(</mo><msup><mi>e</mi><mrow><mo>-</mo><msub><mi>&beta;</mi><mi>r</mi></msub><msub><mi>h</mi><mi>ter</mi></msub></mrow></msup><mo>-</mo><msup><mi>e</mi><mrow><mo>-</mo><msub><mi>&beta;</mi><mi>r</mi></msub><mi>h</mi></mrow></msup><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mn>2</mn></msub><mrow><mo>(</mo><msub><mi>h</mi><mi>ter</mi></msub><mo>-</mo><mi>h</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000728799430000024.GIF" wi="1569" he="209" /></maths>上式中,γ和h为当前的弹道倾角和高度,而γ<sub>ter</sub>和h<sub>ter</sub>为预测的引入段弹道倾角和高度;K<sub>1</sub>和K<sub>2</sub>均为与当前状态相关的常数,它们的表达式如下所示,K<sub>1</sub>=ρ<sub>sea</sub>SC<sub>L1</sub>/2m K<sub>2</sub>=(g/V<sup>2</sup>‑1/r)cosγ上式中,ρ<sub>sea</sub>为海平面大气密度;C<sub>L1</sub>为纵向升力系数;(2)纵向升力系数与最大热流密度关系<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>min</mi></mrow></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mfrac><mrow><mn>2</mn><mi>m</mi><msub><mi>&beta;</mi><mi>r</mi></msub><mo>[</mo><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>cos</mi><mi>&gamma;</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>K</mi><mn>2</mn></msub><mrow><mo>(</mo><msub><mi>h</mi><mi>min</mi></msub><mo>-</mo><mi>h</mi><mo>)</mo></mrow><mo>]</mo></mrow><mrow><msub><mi>S&rho;</mi><mi>sea</mi></msub><mrow><mo>(</mo><msup><mi>e</mi><mrow><mo>-</mo><msub><mi>&beta;</mi><mi>r</mi></msub><msub><mi>h</mi><mi>min</mi></msub></mrow></msup><mo>-</mo><msup><mi>e</mi><mrow><mo>-</mo><msub><mi>&beta;</mi><mi>r</mi></msub><mi>h</mi></mrow></msup><mo>)</mo></mrow></mrow></mfrac></mtd><mtd><mover><mi>h</mi><mo>.</mo></mover><mo>&lt;</mo><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>C</mi><mrow><mi>L</mi><mi>min</mi></mrow></msub><mi>cos</mi><msub><mi>&sigma;</mi><mi>max</mi></msub></mtd><mtd><mover><mi>h</mi><mo>.</mo></mover><mo>&GreaterEqual;</mo><mn>0</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000728799430000025.GIF" wi="1369" he="349" /></maths>上式中,h<sub>min</sub>为当前速度下最大热流密度对应的最小高度;C<sub>L1min</sub>为满足过程约束的最小纵向升力系数;C<sub>Lmin</sub>为最小攻角对应的升力系数;<u>步骤3</u>:定阻尼微分反馈控制方案;引入段满足终端约束制导所需的纵向升力系数为,<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><msub><mi>C</mi><mi>Llg</mi></msub><mo>=</mo><msubsup><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow><mo>*</mo></msubsup><mo>-</mo><mo>[</mo><mfrac><mrow><mn>4</mn><mi>m</mi><msub><mi>&zeta;</mi><mi>c</mi></msub></mrow><mrow><mrow><mi>&rho;</mi><mi>VS</mi><mi>cos</mi></mrow><msup><mi>&sigma;</mi><mo>*</mo></msup></mrow></mfrac><msqrt><mrow><mo>(</mo><mi>g</mi><mo>-</mo><msup><mi>V</mi><mn>2</mn></msup><mo>/</mo><mi>r</mi><mo>)</mo></mrow><msub><mi>&beta;</mi><mi>r</mi></msub></msqrt><mo>-</mo><mfrac><mrow><mn>2</mn><mi>m</mi><mrow><mo>(</mo><mi>g</mi><mo>-</mo><msup><mi>V</mi><mn>2</mn></msup><mo>/</mo><mi>r</mi><mo>)</mo></mrow></mrow><mrow><msup><mi>&rho;V</mi><mn>2</mn></msup><msubsup><mi>SK</mi><mn>1</mn><mo>*</mo></msubsup><mi>cos</mi><msup><mi>&sigma;</mi><mo>*</mo></msup></mrow></mfrac><mo>]</mo><msubsup><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow><mo>*</mo></msubsup><mi>&Delta;&gamma;</mi></mrow>]]></math><img file="FDA0000728799430000031.GIF" wi="1805" he="297" /></maths>上式中,C<sub>L1g</sub>为制导所需的纵向升力系数;<img file="FDA0000728799430000032.GIF" wi="83" he="77" />为滑翔段的期望纵向升力系数;σ<sup>*</sup>为滑翔段的期望倾侧角;ζ<sub>c</sub>为期望阻尼,通常取ζ<sub>c</sub>=0.7;<img file="FDA0000728799430000036.GIF" wi="75" he="75" />为期望纵向升阻比;Δγ为当前弹道倾角与平稳滑翔弹道倾角的差,如下所示,Δγ=γ‑γ<sub>sg</sub>上式中,γ<sub>sg</sub>为平稳滑翔弹道倾角,如下所示,<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><msub><mi>&gamma;</mi><mi>sg</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>[</mo><msub><mi>f</mi><mi>a</mi></msub><mrow><mo>(</mo><mi>V</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>f</mi><mi>V</mi></msub><mrow><mo>(</mo><mi>V</mi><mo>)</mo></mrow><mo>]</mo><mrow><mo>(</mo><mi>g</mi><mo>-</mo><msup><mi>V</mi><mn>2</mn></msup><mo>/</mo><mi>r</mi><mo>)</mo></mrow></mrow><mrow><msub><mi>&beta;</mi><mi>r</mi></msub><msubsup><mi>VK</mi><mn>1</mn><mo>*</mo></msubsup><mo>+</mo><msubsup><mi>gK</mi><mn>1</mn><mo>*</mo></msubsup><mo>[</mo><msub><mi>f</mi><mi>a</mi></msub><mrow><mo>(</mo><mi>V</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>f</mi><mi>V</mi></msub><mrow><mo>(</mo><mi>V</mi><mo>)</mo></mrow><mo>]</mo></mrow></mfrac></mrow>]]></math><img file="FDA0000728799430000033.GIF" wi="973" he="230" /></maths>上式中,f<sub>a</sub>(V)和f<sub>V</sub>(V)为当前速度V对应的f<sub>a</sub>和f<sub>V</sub>的值;<u>步骤4</u>:升力系数和倾侧角分配策略;引入段制导所需的升力系数如下,<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>C</mi><mrow><mi>L</mi><mi>max</mi></mrow></msub></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>g</mi></mrow></msub><mo>></mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>max</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>g</mi></mrow></msub></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>min</mi></mrow></msub><mo>&le;</mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>g</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>min</mi></mrow></msub></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>g</mi></mrow></msub><mo>&lt;</mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>min</mi></mrow></msub></mtd></mtr></mtable><mrow><mo>&le;</mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn><mi>max</mi></mrow></msub></mrow></mfenced></mrow>]]></math><img file="FDA0000728799430000034.GIF" wi="1087" he="362" /></maths>上式中,C<sub>L1</sub>为实际制导的纵向升力系数,C<sub>L1max</sub>最大纵向升力系数,由最大攻角决定;C<sub>L1min</sub>为最小纵向升力系数;升力系数和倾侧角分配如下,<maths num="0013" id="cmaths0013"><math><![CDATA[<mrow><msub><mi>C</mi><mi>Lg</mi></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>></mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup></mtd><mtd><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup><mi>cos</mi><msub><mi>&sigma;</mi><mi>max</mi></msub><mo>&le;</mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>&le;</mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup></mtd></mtr><mtr><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>/</mo><mi>cos</mi><msub><mi>&sigma;</mi><mi>max</mi></msub></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>&lt;</mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup><mi>cos</mi><msub><mi>&sigma;</mi><mi>max</mi></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000728799430000035.GIF" wi="1265" he="365" /></maths><maths num="0014" id="cmaths0014"><math><![CDATA[<mrow><msub><mi>&sigma;</mi><mi>g</mi></msub><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>></mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup></mtd></mtr><mtr><mtd><mi>arccos</mi><mrow><mo>(</mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>/</mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup><mo>)</mo></mrow></mtd><mtd><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup><mi>cos</mi><msub><mi>&sigma;</mi><mi>max</mi></msub><mo>&le;</mo><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>&le;</mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mi>max</mi></msub></mtd><mtd><msub><mi>C</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>&lt;</mo><msubsup><mi>C</mi><mi>L</mi><mo>*</mo></msubsup><msub><mrow><mi>cos</mi><mi>&sigma;</mi></mrow><mi>max</mi></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000728799430000041.GIF" wi="1138" he="332" /></maths>上式中,C<sub>Lg</sub>和σ<sub>g</sub>分别为实际制导所需的升力系数和倾侧角;<img file="FDA0000728799430000042.GIF" wi="74" he="56" />为滑翔段期望攻角对应的升力系数;通过上述4个步骤,即通过预测给定升力系数下引入段弹道的最低点,得到满足最大热流密度约束的纵向升力系数边界,并结合定阻尼微分反馈控制方法,最终获得了满足引入段制导任务需求的解析制导方法。
地址 100191 北京市海淀区学院路37号