技术摘要：
本发明涉及一种信息融合下的飞行器抗干扰控制方法，属于信息融合控制方法领域，用于解决飞行器部分状态不可测以及存在模型不确定性和外界干扰时的跟踪控制问题。考虑系统部分状态不可测且存在未知噪声的情况，利用自适应Kalman滤波融合飞控信息和惯导信息来实现状态估  全部
背景技术：
飞行控制系统设计是保证飞机安全飞行的重要基础。反步法被广泛应用于飞控系 统设计中，但是要求系统模型准确、外界环境无干扰，而且存在“复杂度爆炸”问题，为了解 决这个问题，动态面设计以及指令滤波设计被应用于降低设计复杂度。目前，很多应用在飞 控系统设计中的智能控制都是基于状态完全可测的，但在实际系统中，部分系统状态不易 直接测量，或由于测量设备在经济上和使用性能上的限制，使得不可能获得系统的全部状 态向量，从而影响飞行器的控制性能。 《Hypersonic  Vehicle  Longitudinal  Control  Based  on  Sliding  Mode  Observer  and  Dynamic  Surface  Control》(Yuyan  Guo，Shixing  Wang，Bin  Xu，et  al， 《IEEE  Chinese  Control  Conference》，2016年)采用滑模观测器来估计系统的迎角和航迹 角，并基于反步法设计控制器，将滑模观测器得到的估计值作为控制器输入，该方法可以有 效估计未知状态并实现跟踪控制。但是，当系统存在测量噪声以及模型不确定性和外界干 扰时，噪声会导致系统状态估计不准确，而扰动会影响系统的控制性能，因而该方法可能达 不到期望的控制效果。
技术实现要素：
要解决的技术问题 本发明的目的在于提供一种信息融合下的飞行器抗干扰控制方法，以解决飞行器 部分状态不可测以及存在模型不确定性和外界干扰时的跟踪控制问题。 技术方案 一种信息融合下的飞行器抗干扰控制方法，其特征在于步骤如下： 步骤1：考虑含有未知时变干扰的飞行器纵向动力学模型为 其中，V、h、γ、α和q分别表示速度、高度、航迹角、迎角和俯仰角角速度；D、L和MA分 6 CN 111736468 A 说　明　书 2/9 页 别表示阻力、升力和俯仰力矩；m、Iy和g分别表示飞行器质量、y轴的转动惯量和重力加速 度；T表示推力；di，i＝V,h,γ,α,q表示模型不确定性和外界扰动构成的集合干扰； 步骤2：选择X＝[V  h  γ α  q]T为滤波状态量，根据动力学模型(1)-(5)建立系统 状态方程 其中，噪声w(t)＝[dV(t)  dh(t)  dγ(t)  dα(t)  dq(t)]T的统计特性是未知的；f(X, t)∈R5是根据(1)-(5)得到的非线性函数； 考虑状态α和γ不可测，引入惯导信息作为量测信息，建立量测方程 ZINS(t)＝HX(t) v(t)  (7)其中， 表示惯导量测速度、高度和俯 仰角速度； 表示量测阵；v(t)∈R3表示由惯性测量器件引起的量测噪 声，是均值为零的高斯白噪声； 状态方程(6)和观测方程(7)线性化离散化 其中，Xk表示k时刻的状态；Φk/k-1＝I F(tk-1)σT表示tk-1时刻至tk时刻的一步转移 阵，其中σT为滤波采样时间， E (wk)＝qk， qk∈R5和Qk∈R5×5≥0表示未知的噪声均值和协方差，其中 E(vk)＝0， Rv,k∈R3×3＞0表示量测噪声协方差； 根据离散型线性干扰方程(8)构建自适应Kalman滤波器 其中， 表示k时刻的状态估计值； 表示状态一步 预测；Pk-1∈R5×5表示k-1时刻的状态估计协方差；P ∈R5×5k/k-1 表示一步预测协方差； 表 示k时刻惯导量测值；K 5×3k∈R 表示滤波增益； 和 为噪声估计值。 定义 噪声统计估计器为 7 CN 111736468 A 说　明　书 3/9 页 步骤3：定义Xh＝[x1  x T2  x3  x4] ，其中x1＝h，x2＝γ，x3＝θ，x4＝q，θ＝α γ；因为γ 很小，取sinγ＝γ；考虑到Tsinα远小于L，在控制器设计过程中忽略； 根据动力学模型(2)-(5)，高度子系统转换成以下严格反馈形式 根据动力学模型(1)，速度子系统写成以下形式 其中， i＝2,3,4；XV＝[x1  x2  x3  x4  V]T；dθ＝dα dγ，di，i＝h,γ,θ, q ,V满足 其中， 表示扰动以及扰动变化率上界；f1＝f3＝0， g1＝V， g3＝1， 步骤4：定义跟踪误差 其中 表示高度测量值，yr表示高度参考信 号，设计虚拟控制量 为 其中， 表示d1(t)的估计值；参数k1＞0； 设计一阶滤波器为 其中，τ2＞0表示滤波器参数； 表示滤波后的值； 设计扰动观测器为 其中， L1＞0表示扰动观测器参数； 8 CN 111736468 A 说　明　书 4/9 页 定义跟踪误差 设计虚拟控制量 为 其中， 表示d2(t)的估计值；参数k2＞0； 设计一阶滤波器为 其中，τ3＞0表示滤波器参数，由设计者给出； 表示滤波后的值；设计扰动观测器 为 其中， L2＞0表示扰动观测器参数； 定义跟踪误差 设计虚拟控制量 为 其中， 表示d3(t)的估计值；参数k3＞0； 设计一阶滤波器为 其中，τ4＞0表示滤波器参数，由设计者给出； 表示滤波后的值；设计扰动观测器 为 其中， 表示角速度测量值，L3＞0表示扰动观测器参数； 定义跟踪误差 设计控制输入u为 其中， 表示d4(t)的估计值；参数k4＞0；设计扰动观测 器为 其中，L4＞0表示扰动观测器参数； 根据动力学模型(8)，定义跟踪误差 其中 表示速度测量值，Vd为速度 参考信号，设计控制输入uV为 9 CN 111736468 A 说　明　书 5/9 页 其中， 表示dV(t)的估计值；参数kV＞0； 设计扰动观测器为 其中，LV＞0表示扰动观测器参数； 步骤5：根据得到控制信号u(t)和uV(t)，返回到飞行器的动力学模型(1)-(5)中， 对高度和速度进行跟踪控制。 步骤4中所述的Vd＝40m/s。 有益效果 本发明提出的一种信息融合下的飞行器抗干扰控制方法，该方法考虑飞行器部分 状态不可测且存在未知系统噪声，通过设计自适应Kalman滤波器融合飞控和惯导信息来实 现状态估计；基于反步法框架，将自适应Kalman滤波器得到的状态估计值用于设计控制器； 利用扰动观测器来估计由飞行器模型不确定性和外界干扰形成的复合干扰；按照上述步骤 得到飞行器的控制输入以实现高度和速度的跟踪控制。 与现有技术相比有益效果为： (1)本发明考虑了飞行器存在模型不确定性和外界干扰，通过设计扰动观测器来 实现对系统未知部分的估计，将飞行器控制器设计与惯导/飞控系统信息融合有机结合。 (2)本发明考虑了系统部分状态不可测，并通过设计自适应Kalman滤波器融合惯 导与飞控信息来实现状态估计，从而保证控制系统的控制性能。 (3)本发明考虑了系统噪声统计特性未知，并通过设计自适应Kalman滤波器实现 噪声统计特性的估计，并减小噪声对系统的影响。 附图说明 图1是本发明一种信息融合下的飞行器抗干扰控制方法流程图。 图2是本发明一种信息融合下的飞行器抗干扰控制方法原理图。