一种针对运载火箭的在线单发推力故障诊断方法技术

本发明专利技术公开了一种针对运载火箭的在线单发推力故障诊断方法，包括以下步骤：S100基于运载火箭的姿态运动学和动力学方程建立运载火箭状态方程，并将带辨识量增广至状态量中，根据运载火箭实际单发推力数量建立相应数量的运载火箭单发推力故障诊断的系统状态方程和量测方程；S200在运载火箭\导弹实时飞行过程中，利用无迹卡尔曼滤波实现对运载火箭单发推力的估计，并获取估计误差和协方差阵；S300利用误差和协方差阵进行概率匹配计算，实现推力故障定位，取故障发动机的输出推力。本发明专利技术具有结构简单、设计过程简洁的特点且收敛速度快，辨识精度高，因此在运载火箭单发推力故障诊断中具有广阔的应用前景。

An On-line Single Thrust Fault Diagnosis Method for Launch Vehicle

【技术实现步骤摘要】
一种针对运载火箭的在线单发推力故障诊断方法
本专利技术属于飞行器控制
，特别是涉及一种针对运载火箭的单发推力故障诊断方法。
技术介绍
运载火箭飞行环境十分复杂且对动力系统有较高要求，动力系统出现故障直接影响运载火箭打击能力、控制性能，严重影响运载火箭可靠性。因此开展运载火箭在线单发推力故障诊断设计，可大幅提高运载火箭可靠性。飞行过程中运载火箭\导弹因涡轮泵故障、推力室故障和管路阀门故障等情况直接影响发动机正常工作，造成某个单发发动机出现推力损失或直接关机。一方面运载火箭动力系统故障直接影响运载火箭打击能力，导致运载火箭不能飞行至预计的轨道，从而引发发射任务失败等情况发生；另一方面动力系统故障会造成动力系统分布不均匀，从而产生极大的干扰力矩，影响运载火箭姿态稳定性，严重可能引发导弹失稳情况发生，因此亟需研究一种辨识速度快、结果准确的运载火箭单发推力故障诊断方法，对增强运载火箭\可靠性，提高发射、打击任务成功率有重要的研究意义。通过对已有技术文献进行检索分析，目前没有直接利用运载火箭\导弹动力学特性开展发动机单发推力辨识的研究，对动力系统研究主要集中在发动机故障诊断和总推力估计两个方面。在发动机故障诊断方面，主要有“基于动态云BP网络的液体火箭发动机故障诊断方法”，刘垠杰，《航空动力学报》，第27卷第12期，2012年，将云模型与BP神经网络以串联方式有机结合，首先利用云变换方法进行网络的结构辨识和云模型的特征提取，同时通过在输出层引入单位延时环节描述发动机工作过程动态特性，研究提出了基于动态云BP网络的液体火箭发动机故障诊断方法，实现对发动机故障模式诊断然而该方法的辨识速度较慢且无法精确获得运载火箭\导弹单发推力，不具有工程实践意义。在导弹总推力估计方面，主要有“参数估计法在运载火箭动力系统故障诊断中的应用”，符文星，《弹箭与制导学报》，第27卷第1期，2007年，通过建立运载火箭的数学模型，成功应用基于强跟踪滤波器的状态和参数联合估计方法，实现对运载火箭推力参数的正确估计，但该方法只能实现对发动机总推力估计，无法应对单发发动机故障模式的迅速诊断与定位需求。
技术实现思路
本专利技术目的是为了解决飞行过程中运载火箭在线推力故障诊断问题，提供一种基于无迹卡尔曼滤波和概率匹配的单发推力故障诊断方法。本专利技术通过以下技术方案实现：一种针对运载火箭的在线单发推力故障诊断方法，所述故障诊断方法包括以下步骤：S100基于运载火箭的姿态运动学和动力学方程建立运载火箭状态方程，并将带辨识量增广至状态量中，根据运载火箭实际单发推力数量建立相应数量的运载火箭单发推力故障诊断的系统状态方程和量测方程，为故障诊断提供基础；S200在运载火箭\导弹实时飞行过程中，利用无迹卡尔曼滤波实现对运载火箭单发推力的估计，并获取估计误差和协方差阵；S300利用误差和协方差阵进行概率匹配计算，实现对运载火箭推力故障定位，并利用无迹卡尔曼滤波的辨识结果直接获取故障发动机的输出推力。进一步的，在步骤S100中，具体的，采用扩展卡尔曼滤波器对发动机推力进行估计，发动机产生控制力矩可表示为：即控制力矩可表示为其中：系统姿态动力学模型可表示为如下形式：其中，z为状态向量，f(z)为状态向量的非线性函数向量，B为系统的控制矩阵，T作为发动机喷管推力向量，是系统的输入向量，T＝[T1T2T3T4]T；w为系统的状态扰动向量，y为系统的测量向量，是导弹滚转角速度、偏航角速度、俯仰角速度、俯仰角、偏航角和滚转角的测量量，v为系统的测量噪声向量，当第i(i＝1,2,3,4)个发动机喷管出现推力损失后，设其推力变为式(6)变为如下形式其中，G(i)(k)为矩阵G(k)的第i列，G(0,i)(k)为矩阵G(k)的第i列设置为零后的矩阵，Ti(k)表示除故障发动机以外的其它发动机推力组成的向量，式也可写为其中，将发动机单发推力量估计值增广至系统状态向量中可得到新的状态方程，基于无迹卡尔曼滤波算法可对系统状态向量进行更新，最终实现发动机单发推力辨识，液体火箭共有四个发动机喷管参与动力推进和姿态调整，即1号单发发动机，2号单发发动机，3号单发发动机和4号单发发动机，因此采用以上方法建立四个推力估计滤波器，分别将1号单发发动机推力估计值、2号单发发动机推力估计值、3号单发发动机推力估计值和4号单发发动机推力估计值增广到系统状态向量中，每个推力估计滤波器的状态向量均包含系统状态量z(k)和相应的单发发动机推力估计值，推力估计滤波器包含系统状态方程、量测方程和无迹卡尔曼滤波器，无迹卡尔曼滤波器基于系统方程(状态方程和量测方程)和运载火箭惯导系统输出量对状态方程中的状态量进行不断更新，即可对相应的单发发动机推力估计值进行不断更新，即可利用四个推力估计滤波器实现对运载火箭单发推力值的估计更新。第i个推力估计滤波器的状态向量为其中zi(k)表示系统的状态向量，为运载火箭的姿态角和姿态角速度，表示第i个火箭单发推力值的估计值，对于第i个推力估计滤波器，增广的状态向量满足如下状态方程也可以写成如下形式：其中T＝[T1T2T3T4]T，表示发动机单发推力值，基于以上过程建立了针对运载火箭四个单发发动机的四个系统状态方程和观测方程。其中状态量分别为运载火箭姿态角速度和姿态角和相应的单发发动机，观测量为运载火箭系统姿态角速度和姿态角，均可直接从运载火箭惯导系统中直接获得。进一步的，步骤S200中包括以下步骤：S210Sigma点采样，根据UT变换计算状态向量矩阵:采用采样策略，得到k时刻状态估计的Sigma点集{χk/k(i)i＝1,...,2n+1}，和相应的权值Wlm和Wlc，其中2n+1为所用的采样策略的采样Sigma点个数，S220用状态方程传递采样点：χk+1/k(i)＝f(χk/k(i))(13)S230用预测采样点χk+1/k(i)，权值Wlm和Wlc计算预测均值和协方差矩阵Pk+1/k，S240用式(13)预测量测采样点zk+1/k(i)＝χk+1/k(i)(16)S250测量测值和协方差这里，Pzz是量测向量协方差矩阵；Pχz是状态向量与量测向量的协方差矩阵。S260算UKF增益，更新状态向量和方差如上式可知，系统方程包含状态方程和量测方程，量测量包含运载火箭姿态角和姿态角速度，可直接通过惯航系统输出获得，无迹卡尔曼滤波器通过系统量测量实时对系统状态量进行迭代更新，即对包含运载火箭姿态角、姿态角速度和单发推力估计值的状态量进行更新估计，即可初步实现对运载火箭单发推力值估计，四个推力估计滤波器可分别输出四个单发推力值的估计值，当发动机出现故障后，与故障发动机对应的滤波器仍可以对实际运载火箭单发推力进行准确估计，而其它滤波器估计模型与实际模型出现偏差，即其它滤波器系统方程与实际运载火箭系统出现偏差，因此无法进行准确估计，可利用概率匹配的方法对故障进行定位，从而实现动力系统故障诊断研究。进一步的，通过对四个无迹卡尔曼滤波输出残差进行比较分析，即可实现故障定位，第i个扩展卡尔曼滤波器的残差为ri(k)，可表示为ri(k)＝y(k)-xi(k|k-1)(23)第i个扩展卡尔曼滤波器的残差协方差阵∑i(k)表示为根据概率论与数理统计定义，结合系统残差和协方差阵可给出该条件下的故障概本文档来自技高网...

【技术保护点】
1.一种针对运载火箭的在线单发推力故障诊断方法，其特征在于，所述故障诊断方法包括以下步骤：S100基于运载火箭的姿态运动学和动力学方程建立运载火箭状态方程，并将带辨识量增广至状态量中，根据运载火箭实际单发推力数量建立相应数量的运载火箭单发推力故障诊断的系统状态方程和量测方程，为故障诊断提供基础；S200在运载火箭\导弹实时飞行过程中，利用无迹卡尔曼滤波实现对运载火箭单发推力的估计，并获取估计误差和协方差阵；S300利用误差和协方差阵进行概率匹配计算，实现对运载火箭推力故障定位，并利用无迹卡尔曼滤波的辨识结果直接获取故障发动机的输出推力。

【技术特征摘要】
1.一种针对运载火箭的在线单发推力故障诊断方法，其特征在于，所述故障诊断方法包括以下步骤：S100基于运载火箭的姿态运动学和动力学方程建立运载火箭状态方程，并将带辨识量增广至状态量中，根据运载火箭实际单发推力数量建立相应数量的运载火箭单发推力故障诊断的系统状态方程和量测方程，为故障诊断提供基础；S200在运载火箭\导弹实时飞行过程中，利用无迹卡尔曼滤波实现对运载火箭单发推力的估计，并获取估计误差和协方差阵；S300利用误差和协方差阵进行概率匹配计算，实现对运载火箭推力故障定位，并利用无迹卡尔曼滤波的辨识结果直接获取故障发动机的输出推力。2.根据权利要求1所述的一种针对运载火箭的在线单发推力故障诊断方法，其特征在于，在步骤S100中，具体的，采用扩展卡尔曼滤波器对发动机推力进行估计，发动机产生控制力矩可表示为：即控制力矩可表示为其中：系统姿态动力学模型可表示为如下形式：其中，z为状态向量，f(z)为状态向量的非线性函数向量，B为系统的控制矩阵，T作为发动机喷管推力向量，是系统的输入向量，T＝[T1T2T3T4]T；w为系统的状态扰动向量，y为系统的测量向量，是导弹滚转角速度、偏航角速度、俯仰角速度、俯仰角、偏航角和滚转角的测量量，v为系统的测量噪声向量，当第i(i＝1,2,3,4)个发动机喷管出现推力损失后，设其推力变为式(6)变为如下形式其中，G(i)(k)为矩阵G(k)的第i列，G(0,i)(k)为矩阵G(k)的第i列设置为零后的矩阵，Ti(k)表示除故障发动机以外的其它发动机推力组成的向量，式也可写为其中，将发动机单发推力量估计值增广至系统状态向量中可得到新的状态方程，基于无迹卡尔曼滤波算法可对系统状态向量进行更新，最终实现发动机单发推力辨识，液体火箭共有四个发动机喷管参与动力推进和姿态调整，即1号单发发动机，2号单发发动机，3号单发发动机和4号单发发动机，因此采用以上方法建立四个推力估计滤波器，分别将1号单发发动机推力估计值、2号单发发动机推力估计值、3号单发发动机推力估计值和4号单发发动机推力估计值增广到系统状态向量中，每个推力估计滤波器的状态向量均包含系统状态量z(k)和相应的单发发动机推力估计值，推力估计滤波器包含系统状态方程、量测方程和无迹卡尔曼滤波器，无迹卡尔曼滤波器基于系统方程(状态方程和量测方程)和运载火箭惯导系统输出量对状态方程中的状态量进行不断更新，即可对相应的单发发动机推力估计值进行不断更新，即可利用四个推力估计滤波器实现对运载火箭单发推力值的估计更新。第i个推力估计滤波器的状态向量为其中zi(k)表示系统的状态向量，为运载火箭的姿态角和姿态角速度，表示第i个火箭单发推力值的估计值，对于第i个推力估计滤波器，增广的状态向量满足如下状态方程也可以写成如下形式：其中T＝[...

【专利技术属性】
技术研发人员：韦常柱，崔乃刚，陈嘉凯，李源，关英姿，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：黑龙江,23