主权项 |
一种飞行器突变过程的应急稳定控制方法,其特征在于步骤如下:步骤1:在给定高度、马赫数条件下通过风洞或飞行试验得到突变前和突变后的系统矩阵A<sub>1</sub>和A<sub>2</sub>、突变前和突变后的控制矩阵B<sub>1</sub>和B<sub>2</sub>,系统线性化状态方程为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mover><mi>x</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>A</mi><mn>1</mn></msub><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>B</mi><mn>1</mn></msub><msub><mi>u</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mrow><mo>(</mo><mi>t</mi><mo>≤</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mover><mi>x</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>A</mi><mn>2</mn></msub><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>B</mi><mn>2</mn></msub><msub><mi>u</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mrow><mo>(</mo><mi>t</mi><mo>></mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000708632200000011.GIF" wi="665" he="164" /></maths>其中,x(t)为飞行器飞行状态变量,A<sub>1</sub>和A<sub>2</sub>分别为突变前和突变后系统矩阵,B<sub>1</sub>和B<sub>2</sub>分别为突变前和突变后控制矩阵,u<sub>1</sub>(t)和u<sub>2</sub>(t)为待求解的突变前和突变后控制器;步骤2:设定突变前和突变后控制器表达式为:u<sub>1</sub>(t)=v<sub>1</sub>‑K<sub>1</sub>x(t)u<sub>2</sub>(t)=v<sub>2</sub>‑K<sub>2</sub>x(t)其中,v<sub>1</sub>、v<sub>2</sub>为驾驶员指令输入,K<sub>1</sub>、K<sub>2</sub>为常数反馈增益矩阵;所述的K<sub>1</sub>、K<sub>2</sub>求解过程如下:基于线性二次最优理论建立约束方程:P<sub>1</sub>A<sub>1</sub>+A<sub>1</sub><sup>T</sup>P<sub>1</sub>‑P<sub>1</sub>B<sub>1</sub>R<sub>1</sub><sup>‑1</sup>B<sub>1</sub>P<sub>1</sub>+Q<sub>1</sub>=0P<sub>2</sub>A<sub>2</sub>+A<sub>2</sub><sup>T</sup>P<sub>2</sub>‑P<sub>2</sub>B<sub>2</sub>R<sub>2</sub><sup>‑1</sup>B<sub>2</sub>P<sub>2</sub>+Q<sub>2</sub>=0其中Q<sub>1</sub>、R<sub>1</sub>、Q<sub>2</sub>、R<sub>2</sub>分别为可以调节的状态和输入向量加权矩阵;P<sub>1</sub>和P<sub>2</sub>为待求解的未知正定对称矩阵;则突变前反馈增益矩阵<img file="FDA0000708632200000012.GIF" wi="337" he="85" />突变后反馈增益矩阵<img file="FDA0000708632200000013.GIF" wi="355" he="84" />由控制器u<sub>1</sub>(t)和u<sub>2</sub>(t)切换超前和滞后所构成闭环系统<maths num="0002" id="cmaths0002"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mover><mi>x</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>-</mo><msub><mi>B</mi><mn>1</mn></msub><msubsup><mi>R</mi><mn>2</mn><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msubsup><mi>B</mi><mn>2</mn><mi>T</mi></msubsup><msub><mi>P</mi><mn>2</mn></msub><mo>)</mo></mrow><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mrow><mo>(</mo><mi>t</mi><mo>≤</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mover><mi>x</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mrow><mo>(</mo><msub><mi>A</mi><mn>2</mn></msub><mo>-</mo><msub><mi>B</mi><mn>2</mn></msub><msubsup><mi>R</mi><mn>1</mn><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msubsup><mi>B</mi><mn>1</mn><mi>T</mi></msubsup><msub><mi>P</mi><mn>1</mn></msub><mo>)</mo></mrow><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mrow><mo>(</mo><mi>t</mi><mo>></mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000708632200000014.GIF" wi="768" he="180" /></maths>应满足闭环系统特征值在复平面左侧,即系统稳定:Re[eig(A<sub>1</sub>‑B<sub>1</sub>R<sub>2</sub><sup>‑1</sup>B<sub>2</sub><sup>T</sup>P<sub>2</sub>)]<0Re[eig(A<sub>2</sub>‑B<sub>2</sub>R<sub>1</sub><sup>‑1</sup>B<sub>1</sub><sup>T</sup>P<sub>1</sub>)]<0其中,eig(*)表示矩阵的特征值,Re(*)表示复数的实部,由此求得满足上述约束的待求正定对称矩阵P<sub>1</sub>和P<sub>2</sub>,计算<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>K</mi><mn>1</mn></msub><mo>=</mo><mo>-</mo><msubsup><mi>R</mi><mn>1</mn><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msubsup><mi>B</mi><mn>1</mn><mi>T</mi></msubsup><msub><mi>P</mi><mn>1</mn></msub><mo>,</mo></mrow>]]></math><img file="FDA0000708632200000015.GIF" wi="339" he="84" /></maths><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mi>K</mi><mn>2</mn></msub><mo>=</mo><mo>-</mo><msubsup><mi>R</mi><mn>2</mn><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msubsup><mi>B</mi><mn>2</mn><mi>T</mi></msubsup><msub><mi>P</mi><mn>2</mn></msub><mo>;</mo></mrow>]]></math><img file="FDA0000708632200000016.GIF" wi="354" he="84" /></maths>将计算得到的K<sub>1</sub>、K<sub>2</sub>代入突变前和突变后控制器,将代入后的控制器作为飞行器突变过程的应急稳定控制。 |