发明名称 一种飞行器突变过程的应急稳定控制方法
摘要 本发明涉及一种飞行器突变过程的应急稳定控制方法,通过控制器匹配情况下闭环系统控制律求解,并引入控制器超前或滞后情况闭环对象稳定性约束,保证控制器超前或滞后情况下闭环系统的应急稳定,从而避免了控制器与飞行器被控模型不匹配所导致的飞行不稳定和不安全。
申请公布号 CN104765274A 申请公布日期 2015.07.08
申请号 CN201510212767.5 申请日期 2015.04.29
申请人 西北工业大学 发明人 陈杰;张惠媛;马存宝;宋东;和麟;张天伟
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 西北工业大学专利中心 61204 代理人 王鲜凯
主权项 一种飞行器突变过程的应急稳定控制方法,其特征在于步骤如下:步骤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>&le;</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>&le;</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>代入突变前和突变后控制器,将代入后的控制器作为飞行器突变过程的应急稳定控制。
地址 710072 陕西省西安市友谊西路127号