发明名称 飞行器协调转弯故障诊断和容错控制方法
摘要 本发明给出了一种飞行器协调转弯故障诊断和容错控制方法,该方法按照飞行器无故障时的模型和状态组合指标判别式进行故障诊断;飞行器出现故障时首先对故障分类,再针对确定的故障类别分析飞行器全机参数和飞行动力学特性的影响,然后重新对故障发生后突变系统建模,得到飞行器出现故障时新的模型描述;容错控制器的设计方法为设计出的控制量使得无故障模型输出达到军标要求,且该控制量和飞行器故障引起的非人为附加控制量共同组成的飞行器出现故障时的控制输入使得飞行器出现故障时新的模型输出稳定。
申请公布号 CN103135547A 申请公布日期 2013.06.05
申请号 CN201310095164.2 申请日期 2013.03.24
申请人 西安费斯达自动化工程有限公司 发明人 史忠科
分类号 G05D1/00(2006.01)I 主分类号 G05D1/00(2006.01)I
代理机构 代理人
主权项 1.一种飞行器协调转弯故障诊断和容错控制方法,其特点是包括以下步骤:(a)飞行器无故障时协调转弯非线性模型为:<img file="FDA00002957145400011.GIF" wi="1769" he="939" />式中:h,β,p,q,r分别表示飞行高度、飞行速度、气流迎角、侧滑角、滚转角速度、俯仰角速度、偏航角速度;<img file="FDA00002957145400012.GIF" wi="55" he="54" /><img file="FDA00002957145400013.GIF" wi="44" he="59" />ψ分别指滚转、俯仰角、偏航角;g为重力加速度;Q,S,m,I<sub>x</sub>,I<sub>y</sub>,I<sub>z</sub>,I<sub>zx</sub>分别表示动压、机翼面积、飞行器质量、绕机体轴系X轴的转动惯量、绕机体轴系Y轴的转动惯量、绕机体轴系Z轴的转动惯量、机体轴系XZ轴的转动惯量积;C<sub>x</sub>(α,β,δ),C<sub>y</sub>(α,β,δ),C<sub>z</sub>(α,β,δ),分别表示纵向力、侧向力和法向力;C<sub>L</sub>(α,β,δ),C<sub>N</sub>(α,β,δ)分别为滚转力矩、偏航力矩;δ为控制量;(b)故障检出方法为:当状态组合指标J≥1,则判定飞行器有故障;其中:<img file="FDA00002957145400014.GIF" wi="1767" he="417" />式中:h<sub>pre</sub>(i),β<sub>pre</sub>(i),ψ<sub>pre</sub>(i),<img file="FDA00002957145400015.GIF" wi="140" he="78" />p<sub>pre</sub>(i),r<sub>pre</sub>(i)分别为根据(1)式在时间t=iT(i=k,k+1,L,N)计算得到的h,β,ψ,<img file="FDA00002957145400016.GIF" wi="50" he="49" />p,r值;h<sub>out</sub>(i),β<sub>out</sub>(i),ψ<sub>out</sub>(i),<img file="FDA00002957145400017.GIF" wi="138" he="68" />p<sub>out</sub>(i),r<sub>out</sub>(i)分别为在时间t=iT(i=k,k+1,L,N)实际测量得到的h,β,ψ,<img file="FDA00002957145400018.GIF" wi="48" he="54" />p,r值,△h<sub>t</sub>,△β<sub>t</sub>,△ψ<sub>t</sub>,<img file="FDA00002957145400021.GIF" wi="92" he="66" />△p<sub>t</sub>,△r<sub>t</sub>为设定的检测阈值;<maths num="0001"><![CDATA[<math><mrow><mi>sign</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mi>x</mi><mo>></mo><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>x</mi><mo>&le;</mo><mn>0</mn></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>为符号函数;k表示第k个采样点,对应采样时间为t=kT;N+1为设定误差累计个数,T为采样周期;(c)飞行器出现故障时首先对故障分类,再针对确定的故障类别分析飞行器全机参数和飞行动力学特性的影响,然后重新对故障发生后突变系统建模,得到飞行器出现故障时协调转弯非线性模型描述为:<img file="FDA00002957145400023.GIF" wi="1999" he="982" />式中:;S<sub>f</sub>,m<sub>f</sub>,I<sub>xf</sub>,I<sub>yf</sub>,I<sub>zf</sub>,I<sub>zxf</sub>别表示飞行器出现故障时的机翼面积、飞行器质量、绕机体轴系X轴的转动惯量、绕机体轴系Y轴的转动惯量、绕机体轴系Z轴的转动惯量、机体轴系XZ轴的转动惯量积;C<sub>xf</sub>(α,β,δ<sub>f</sub>),C<sub>yf</sub>(α,β,δ<sub>f</sub>),C<sub>zf</sub>(α,β,δ<sub>f</sub>)分别表示飞行器出现故障时的纵向力、侧向力和法向力;C<sub>Lf</sub>(α,β,δ<sub>f</sub>)、C<sub>Nf</sub>(α,β,δ<sub>f</sub>)为飞行器出现故障时的滚转力矩、偏航力矩、俯仰力矩;<maths num="0002"><![CDATA[<math><mrow><msub><mi>&delta;</mi><mi>f</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;</mi></mtd></mtr><mtr><mtd><msub><mi>&delta;</mi><mi>apf</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>飞行器出现故障时的控制输入,飞行器故障引起的非人为附加控制量δ<sub>apf</sub>;(d)容错控制器的设计方法为:设计出的控制量δ使得非线性模型(1)式稳定裕度达到军标要求,且该控制量δ和飞行器故障引起的非人为附加控制量δ<sub>apf</sub>共同组成的飞行器出现故障时的控制输入<maths num="0003"><![CDATA[<math><mrow><msub><mi>&delta;</mi><mi>f</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;</mi></mtd></mtr><mtr><mtd><msub><mi>&delta;</mi><mi>apf</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>使得非线性模型(3)式输出稳定。
地址 710075 陕西省西安市高新区科技路金桥国际广场12101号