[发明专利]飞行器纵向运动故障诊断和容错控制方法

权利要求书

1.一种飞行器纵向运动故障诊断和容错控制方法，其特点是包括以下步骤：(a)飞行器无故障时纵向运动的非线性模型为：

h·=VTsin(θ-α)V·T=QSm[Cx(α,δ)cosα+Cz(α,δ)sinα]-gsin(θ-α)α·=q+QSmVT[Cz(α,δ)cosα-Cx(α,δ)sinα]+gcos(θ-α)/VTθ·=qq·=QSclIyCm(α,δ)---(1)]]>式中：状态变量h，V_T，α，θ，q分别表示飞行高度、飞行速度、气流迎角、俯仰角、俯仰角速度；g为重力加速度；Q，S，m，c_l，I_y分别表示动压、机翼面积、飞行器质量、平均气动弦长、绕机体轴系Y轴的转动惯量；C_x(α，δ)，C_z(α，δ)，C_m(α，δ)分别表示纵向力、法向力和俯仰力矩；δ为控制量；

(b)故障检出方法为：当状态组合指标J≥1，则判定飞行器有故障；其中：

J=sign[Σi=kk+N|hpre(i)-hout(i)|-Δht]+sign[Σi=kk+N|VTpre(i)-VTout(i)|-ΔVTt]+]]>

sign[Σi=kk+N|αpre(i)-αout(i)|-Δαt]+sign[Σi=kk+N|θpre(i)-θout(i)|-Δθt]+---(2)]]>

sign[Σi=kk+N|qpre(i)-qout(i)|-Δqt]]]>h_pre(i)，V_Tpre(i)，α_pre(j)，θ_pre(j)，q_pre(i)分别为根据(1)式在时间t=iT(i=k，k+1，…，N)计算得到的h，V_T，α，θ，q值；h_out(j)，V_Tout(i)，α_out，(i)，θ_out(i)，q_out(i)为在时间t=iT(i=k，k+1，…，N)实际测量得到的h，V_T，α，θ，q值，Δh_t，ΔV_Tt，Δα_t，Δθ_t，Δq_t为设定的检测阈值；sign(x)=1x>00x≤0]]>为符号函数；k表示第k个采样点，对应采样时间为t=kT；N+1为设定误差累计个数，T为采样周期；

(c)飞行器出现故障时首先对故障分类，再针对确定的故障类别分析飞行器全机参数和飞行动力学特性的影响，然后重新对故障发生后突变系统建模，得到飞行器出现故障时纵向运动新的非线性模型描述为：

h·=VTsin(θ-α)V·T=QSfmf[Cxf(α,δf)cosα+Czf(α,δf)sinα]-gsin(θ-α)α·=q+QSfmfVT[Czf(α,δf)cosα-Cxf(α,δf)sinα]+gcos(θ-α)/VTθ·=qq·=QSfclfIyfCmf(α,δf)---(3)]]>式中：S_f，m_f，c_lf，I_yf分别表示飞行器出现故障时的机翼面积、飞行器质量、平均气动弦长、绕机体轴系Y轴的转动惯量；C_xf(α，δf)，C_zf(α，δ_f)，C_mf(α，δ_f)分别表示飞行器出现故障时的纵向力、法向力和俯仰力矩；δf=δδapf]]>飞行器出现故障时的控制输入，飞行器故障引起的非人为附加控制量δ_apf；

(d)容错控制器的设计方法为：设计出的控制量δ使得非线性模型(1)式稳定裕度达到军标要求，且该控制量δ和飞行器故障引起的非人为附加控制量δ_apf共同组成的飞行器出现故障时的控制输入δf=δδapf]]>吏得非线性模型(3)式输出稳定。