发明名称 一种非最小相位高超声速飞行器控制方法
摘要 一种非最小相位高超声速飞行器控制方法,步骤如下:(1)选择航迹角γ和俯仰角速度Q作为被控输出,设计被控输出高度h,速度V,俯仰角速度Q的参考轨迹;(2)设计航迹角γ的参考轨迹;(3)在当前控制周期的初始时刻,通过量测得到高超声速飞行器的状态量:速度V,航迹角γ,俯仰角速度Q,攻角α,高度h;(4)得到状态偏差<img file="DDA0000663230990000011.GIF" wi="288" he="64" />所述的状态偏差满足动态方程<img file="DDA0000663230990000012.GIF" wi="248" he="80" />(5)估计步骤(4)的未知矩阵<img file="DDA0000663230990000014.GIF" wi="60" he="58" />;(6)设计控制律<img file="DDA0000663230990000013.GIF" wi="376" he="86" />k&lt;0,为常数;利用该控制律得到当前控制周期的控制指令;根据上述控制指令对飞行器进行控制,进入下一控制周期转步骤(2)循环执行。
申请公布号 CN104571100A 申请公布日期 2015.04.29
申请号 CN201510044114.0 申请日期 2015.01.28
申请人 北京控制工程研究所 发明人 孟斌;李公军;姜甜甜
分类号 G05D1/00(2006.01)I 主分类号 G05D1/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 庞静
主权项 一种非最小相位高超声速飞行器控制方法,其特征在于步骤如下:(1)选择航迹角γ和俯仰角速度Q作为被控输出,根据高超声速飞行器在巡航飞行阶段航迹角γ和俯仰角速度Q最终状态为0,设计被控输出高度h,速度V,俯仰角速度Q的参考轨迹;(2)根据步骤(1)设计的参考轨迹,设计航迹角γ的参考轨迹;(3)在当前控制周期的初始时刻,通过量测得到高超声速飞行器的状态量:速度V,航迹角γ,俯仰角速度Q,攻角α,高度h;(4)以步骤(3)给出量测得到的状态量速度V,航迹角γ,俯仰角速度Q分别对应减去步骤(1)(2)设计的参考轨迹,得到状态偏差<img file="FDA0000663230960000011.GIF" wi="294" he="85" />所述的状态偏差满足动态方程<img file="FDA0000663230960000012.GIF" wi="252" he="86" />其中,<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>G</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>g</mi><mi>V</mi><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>g</mi><mi>V</mi><mn>2</mn></msubsup></mtd><mtd><msubsup><mi>g</mi><mi>V</mi><mn>3</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>g</mi><mi>&gamma;</mi><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>g</mi><mi>&gamma;</mi><mn>2</mn></msubsup></mtd><mtd><msubsup><mi>g</mi><mi>&gamma;</mi><mn>3</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>g</mi><mi>Q</mi><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>g</mi><mi>Q</mi><mn>2</mn></msubsup></mtd><mtd><msubsup><mi>g</mi><mi>Q</mi><mn>3</mn></msubsup></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000663230960000013.GIF" wi="439" he="260" /></maths>u=[Φ δ<sub>e</sub> δ<sub>c</sub>]<sup>T</sup>;<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msubsup><mi>g</mi><mi>V</mi><mn>1</mn></msubsup><mo>=</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mrow><mo>(</mo><msub><mi>&beta;</mi><mn>1</mn></msub><msup><mi>&alpha;</mi><mn>3</mn></msup><mo>+</mo><msub><mi>&beta;</mi><mn>3</mn></msub><msup><mi>&alpha;</mi><mn>2</mn></msup><mo>+</mo><msub><mi>&beta;</mi><mn>5</mn></msub><mi>&alpha;</mi><mo>+</mo><msub><mi>&beta;</mi><mn>7</mn></msub><mo>)</mo></mrow><mi>cos</mi><mi>&alpha;</mi><mo>,</mo><msubsup><mi>g</mi><mi>V</mi><mn>2</mn></msubsup><mo>=</mo><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mover><mi>q</mi><mo>&OverBar;</mo></mover><msubsup><mi>SC</mi><mi>D</mi><msub><mi>&delta;</mi><mi>e</mi></msub></msubsup><mo>,</mo><msubsup><mi>g</mi><mi>V</mi><mn>3</mn></msubsup><mo>=</mo><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mover><mi>q</mi><mo>&OverBar;</mo></mover><msubsup><mi>SC</mi><mi>D</mi><msub><mi>&delta;</mi><mi>c</mi></msub></msubsup></mrow>]]></math><img file="FDA0000663230960000014.GIF" wi="1515" he="126" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msubsup><mi>g</mi><mi>&gamma;</mi><mn>1</mn></msubsup><mo>=</mo><mfrac><mn>1</mn><mi>mV</mi></mfrac><mrow><mo>(</mo><msub><mi>&beta;</mi><mn>1</mn></msub><msup><mi>&alpha;</mi><mn>3</mn></msup><mo>+</mo><msub><mi>&beta;</mi><mn>3</mn></msub><msup><mi>&alpha;</mi><mn>2</mn></msup><mo>+</mo><msub><mi>&beta;</mi><mn>5</mn></msub><mi>&alpha;</mi><mo>+</mo><msub><mi>&beta;</mi><mn>7</mn></msub><mo>)</mo></mrow><mi>sin</mi><mi>&alpha;</mi><mo>,</mo><msubsup><mi>g</mi><mi>&gamma;</mi><mn>2</mn></msubsup><mo>=</mo><mfrac><mn>1</mn><mi>mV</mi></mfrac><mover><mi>q</mi><mo>&OverBar;</mo></mover><msubsup><mi>SC</mi><mi>L</mi><msub><mi>&delta;</mi><mi>e</mi></msub></msubsup><mo>,</mo><msubsup><mi>g</mi><mi>&gamma;</mi><mn>3</mn></msubsup><mo>=</mo><mfrac><mn>1</mn><mi>mV</mi></mfrac><mover><mi>q</mi><mo>&OverBar;</mo></mover><msubsup><mi>SC</mi><mi>L</mi><msub><mi>&delta;</mi><mi>c</mi></msub></msubsup></mrow>]]></math><img file="FDA0000663230960000015.GIF" wi="1539" he="129" /></maths><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msubsup><mi>g</mi><mi>Q</mi><mn>1</mn></msubsup><mo>=</mo><mfrac><msub><mi>z</mi><mi>T</mi></msub><msub><mi>I</mi><mi>yy</mi></msub></mfrac><mrow><mo>(</mo><msub><mi>&beta;</mi><mn>1</mn></msub><msup><mi>&alpha;</mi><mn>3</mn></msup><mo>+</mo><msub><mi>&beta;</mi><mn>3</mn></msub><msup><mi>&alpha;</mi><mn>2</mn></msup><mo>+</mo><msub><mi>&beta;</mi><mn>5</mn></msub><mi>&alpha;</mi><mo>+</mo><msub><mi>&beta;</mi><mn>7</mn></msub><mo>)</mo></mrow><mo>,</mo><msubsup><mi>g</mi><mi>Q</mi><mn>2</mn></msubsup><mo>=</mo><mfrac><mn>1</mn><msub><mi>I</mi><mi>yy</mi></msub></mfrac><mover><mi>q</mi><mo>&OverBar;</mo></mover><mi>S</mi><mover><mi>c</mi><mo>&OverBar;</mo></mover><msub><mi>C</mi><mi>e</mi></msub><mo>,</mo><msubsup><mi>g</mi><mi>Q</mi><mn>3</mn></msubsup><mo>=</mo><mfrac><mn>1</mn><msub><mi>I</mi><mi>yy</mi></msub></mfrac><mover><mi>q</mi><mo>&OverBar;</mo></mover><mi>S</mi><mover><mi>c</mi><mo>&OverBar;</mo></mover><msub><mi>C</mi><mi>c</mi></msub></mrow>]]></math><img file="FDA0000663230960000016.GIF" wi="1407" he="146" /></maths>α表示攻角,<img file="FDA0000663230960000017.GIF" wi="48" he="79" />为动压,S,<img file="FDA0000663230960000018.GIF" wi="54" he="75" />z<sub>T</sub>分别表示飞行器的参考面积,弦长和推力力臂,β<sub>i</sub>,i=1,2,…,8,<img file="FDA0000663230960000019.GIF" wi="72" he="77" />j=L、D、M,α,k=0,α,α<sup>2</sup>,δ<sub>e</sub>,<img file="FDA00006632309600000110.GIF" wi="62" he="75" />δ<sub>c</sub>,<img file="FDA00006632309600000111.GIF" wi="67" he="74" />C<sub>e</sub>,C<sub>c</sub>表示气动系数。m,I<sub>yy</sub>分别为飞行器的质量和飞行器沿纵轴的转动惯量;<img file="FDA00006632309600000112.GIF" wi="64" he="70" />为G中的不确定参数取标称值时的矩阵,所述的不确定参数包括气动系数和空气密度;Φ,δ<sub>e</sub>,δ<sub>c</sub>分别表示燃气比,升降舵偏角和鸭翼偏角,为系统输入,为控制量,初值为0;(5)以步骤(3)量测的状态量和上一控制周期求取的系统输入为输入,估计步骤(4)的未知矩阵<img file="FDA0000663230960000021.GIF" wi="70" he="82" />将<img file="FDA0000663230960000022.GIF" wi="46" he="71" />记为<img file="FDA0000663230960000023.GIF" wi="56" he="66" />的估计值;(6)设计控制律<img file="FDA0000663230960000024.GIF" wi="372" he="96" />k&lt;0,为常数;利用该控制律得到当前控制周期的控制指令:燃气比,升降舵偏角和鸭翼偏角;根据上述控制指令对飞行器进行控制,进入下一控制周期转步骤(2)循环执行。
地址 100080 北京市海淀区北京2729信箱