CN110555398A - 一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 - Google Patents
一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 Download PDFInfo
- Publication number
- CN110555398A CN110555398A CN201910776604.8A CN201910776604A CN110555398A CN 110555398 A CN110555398 A CN 110555398A CN 201910776604 A CN201910776604 A CN 201910776604A CN 110555398 A CN110555398 A CN 110555398A
- Authority
- CN
- China
- Prior art keywords
- state
- fault
- equation
- value
- moment
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/35—Constructional details or hardware or software details of the signal processing chain
- G01S19/37—Hardware or software details of the signal processing chain
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2218/00—Aspects of pattern recognition specially adapted for signal processing
- G06F2218/02—Preprocessing
- G06F2218/04—Denoising
Landscapes
- Engineering & Computer Science (AREA)
- Signal Processing (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于滤波最优平滑确定故障首达时刻的故障诊断方法。本发明中历史数据首先要通过Kalman滤波迭代获得,迭代步数的上限为总的采样次数,下限为滤波过程中发现状态产生故障或漂移的时刻。对历史数据中的观测值和状态估计值的误差求取平均范数,设定故障或漂移的阈值为3倍误差平均2‑范数。通过对历史数据的最优平滑估计使得估计精度得到提升,从而更加精确的判断故障或漂移产生的首达时刻,并可将该方法应用在船舶航行发生漂移后GPS导航定位系统中。
Description
技术领域
本发明属于故障诊断领域,具体涉及一种基于Kalman滤波最优平滑确定故障首达时刻的故障诊断方法。
背景技术
故障诊断领域中,由于系统某些状态故障和漂移是缓变的,在故障首达时刻附近变化量较少,又由于实际工况下系统的噪声和观测噪声影响,故障或漂移可能被其掩盖,难以被察觉,并且对于系统可观性来讲,状态的重构在理论上又具有延迟性,而从工程应用观点来看,确定系统故障的首达时刻尤其重要,寻求一种确定故障首达时刻的方法具有较大价值。传统的Kalman滤波是建立在模型精确和随机干扰信号统计特性已知的基础上的,然而随机干扰信号过大可能会使传统的Kalman滤波算法失去最优性,估计精度大大降低。而Kalman滤波最优平滑可以提高估计精度,从而更早的发现系统故障的首达时刻。
发明内容
本发明针对现有技术的不足,设计一种基于Kalman滤波最优平滑确定故障首达时刻的故障诊断方法。首先,本发明通过Kalman滤波算法对系统状态进行估计,在估计过程中状态某一分量发生故障或参数漂移,经历一定时刻的迭代后,发生故障的状态分量超过故障报警阈值,开始报警。然后,滤波过程中获得的历史数据开始对系统状态进行平滑估计,当状态分量超过平滑故障报警阈值后获得系统的故障首达时刻,并将此方法应用在船舶GPS导航系统对船舶航行的精确定位中。
本发明包括以下各步骤:
步骤(1)通过系统的状态方程和观测方程使用Kalman滤波算法对系统状态进行估计,并持续迭代:
步骤(1-1)Kalman滤波过程:
给定如下离散线性系统:
其中,k为离散时间,系统在时刻k的状态为Xk∈Rn;Yk∈Rn为对应观测信号;Wk∈Rr为输入的白噪声;Vk∈Rm为观测噪声;称式(1)为状态方程和观测方程。称A为状态转移矩阵,C为观测矩阵。
递推Kalman滤波器如下:
式(2)为状态一步预测式。
式(3)为新息表达式;式(4)为状态更新式。
Kk+1=Pk+1|kAT[APk+1|kAT+R]-1 (5)
式(5)为滤波增益矩阵求取式。
Pk+1|k=APk|kAT+Q (6)
式(6)为一步预测协方差阵。
Pk+1|k+1=[In-Kk+1A]Pk+1|k (7)
式(7)为协方差更新式。
其中状态估计值的初始值和初始协方差阵为:
步骤(1-2)某一状态分量发生故障:
系统状态某一分量f开始发生故障,由于故障首达时刻未知,将其设为r。此时系统的状态方程中状态转移部分加入缓变矩阵Xfault:
Xk+1=AXk-Xfault+Wk (9)
其中X1到Xf-1和Xf+1到Xn为正常的状态分量,Xf为发生故障的状态分量。
此时系统的观测方程不变。
步骤(2)滤波过程发现状态发生故障或漂移:
在迭代过程中,状态真实值无法直接获取,只能通过传感器的观测获得状态的观测值,对历史估计值和观测值之间的误差求取2-范数均值,设定报警阈值为3倍2-范数均值。
其中N为迭代当前时刻。若N时刻状态估计值和观测值的误差大于报警阈值,则认为系统状态已经发生了故障或漂移。
步骤(3)对系统状态进行平滑(Smooth):
平滑过程如下:
Jk=Pk|kAT[Pk|k+1]-1 (12)
式(12)为最优平滑增益矩阵求取式。式(12)的边界条件为:k=N-1时,Pk+1|N=PN|N。
式(13)为最优平滑状态更新式。式(13)的边界条件为:k=N-1时,
式(14)为最优平滑协方差阵更新式。
步骤(4)确定故障的首达时刻:
在后验分析中,等待获得更多的观测数据,这时对状态的估计可以通过最优平滑进一步提高精度。在最优平滑过程中,判断平滑后当前时刻状态是否超过(11)报警阈值,如果超出则可确定故障首达时间。
本发明的有益效果:在Kalman滤波可以有效地跟踪线性系统的基础上,在滤波过程中初步发现状态故障或漂移并获得历史数据后,用该历史数据反向估计,利用平滑可以进一步提高系统的估计精度,从而更早的发现超出阈值的故障状态。最终将其应用到船舶的匀速直线航行的跟踪中,相较于传统检测手段,本发明有效提高了故障首达时刻的检测精度。
附图说明
图1是本发明的算法实现流程图;
图2是Kalman滤波和最优平滑示意图;
图3是船舶的跟踪轨迹图;
图4是观测值和滤波估计值和滤波+平滑估计值与真实值之间的误差对比;
图5是滤波估计值和滤波+平滑估计值与观测值之间的误差对比。
具体实施方式
以下结合附图对本发明作进一步说明。
如图1所示,本发明提出基于Kalman滤波加平滑提高估计精度的故障诊断方法,包括以下各步骤:
1、通过系统的状态方程和观测方程使用Kalman滤波算法对系统状态进行估计,并持续迭代:
步骤(1-1)Kalman滤波过程:
给定如下离散线性系统:
其中,k为离散时间,系统在k时刻的状态为Xk∈Rn;Yk∈Rn为对应观测信号;Wk∈Rr为输入的白噪声;Vk∈Rm为观测噪声;称式(1)为状态方程和观测方程。称A为状态转移矩阵,C为观测矩阵。
假定船舶驶出码头沿直线方向航行。以码头的出发处为坐标原点,设采样时间T0,用lk表示传播在采样时刻kT0处的真实位置,用yk表示在时刻kT0处GPS定位的观测值,则有观测模型:
yk=lk+vk (2)
式中,vk表示GPS定位误差(观测噪声),可假设它是零均值、方差为的白噪声,方差是通过大量GPS观测试验数据用统计方法获取。记在时刻kT0处船舶速度为加速度为ak,由匀加速运动公式有:
其中加速度ak由机动加速度计uk和随机加速度wk两部分合成,即:
ak=uk+wk (5)
式中,uk为船舶动力系统的控制信号,它是人为输出的已知机动控制信号;wk是由海风和洋流等外界扰动因素造成的随机加速度,假设它的均值为零、方差为的独立于vk的白噪声。定义在采样时刻kT0处系统的状态xk为船舶的位置和速度,即:
可得到传播运动的状态方程:
观测方程为:
在不考虑机动目标自身的动力因素时,匀速直线运动的船舶系统为四维系统。状态包含水平方向的位置和速度和纵向的位置和速度,则该船舶系统方程可以用下式表示。
假定传播在二维水平面上运动,初始位置为(-100m,200m),水平运动速度为2m/s,垂直方向的运动速度为20m/s,GPS接收机的扫描周期为T=1s,总的采样次数为100次,观测噪声的均值为0,方差为100。
递推Kalman滤波器如下:
式(11)为状态一步预测式。
式(12)为新息表达式;式(13)为状态更新式。
Kk+1=Pk+1|kAT[APk+1|kAT+R]-1 (14)
式(14)为滤波增益矩阵求取式。
Pk+1|k=APk|kAT+Q (15)
式(15)为一步预测协方差阵。
Pk+1|k+1=[In-Kk+1A]Pk+1|k (16)
式(16)为协方差更新式。
其中状态估计值的初始值和初始协方差阵为:
步骤(1-2)某一状态分量发生故障:
系统状态某一分量f开始发生故障,由于故障首达时刻未知,将其设为r。此时系统的状态方程中状态转移部分加入缓变矩阵Xfault:
Xk+1=AXk-Xfault+Wk (18)
其中X1到Xf-1和Xf+1到Xn为正常的状态分量,Xf为发生故障的状态分量。此时观测方程不变。
对系统只进行Kalman滤波估计的跟踪轨迹在图2和图3中有体现。
2、滤波过程发现状态发生故障或漂移:
在迭代过程中,状态真实值是无法直接获取的,只能通过传感器的观测获得状态的观测值,对历史估计值和观测值之间的误差求取2-范数均值,设定报警阈值为3倍2-范数均值。
其中N为当前迭代时刻。若N时刻状态估计值和观测值的误差大于报警阈值,则认为系统状态已经发生了故障或漂移。
3、对系统状态进行平滑(Smooth):
平滑过程如下:
Jk=Pk|kAT[Pk|k+1]-1 (21)
式(21)为最优平滑增益矩阵求取式。式(21)的边界条件为:k=N-1时,Pk+1|N=PN|N。
式(22)为最优平滑状态更新式。式(22)的边界条件为:k=N-1时,
式(23)为最优平滑协方差阵更新式。
图3所表示的内容即为对系统进行Kalman滤波估计并再此基础进行最优平滑估计的跟踪轨迹,可以看出由于观测噪声较大Kalman滤波对状态估计的精度不高,但在此基础上的最优平滑过程可以进一步提高估计精度。
4、确定故障的首达时刻:
在后验分析中,等待获得更多的观测数据,这时对状态的估计可以通过最优平滑进一步提高精度。在最优平滑过程中,判断平滑后当前时刻状态是否超过(20)报警阈值,如果超出则可确定故障首达时间。
图4和图5分别为测值和滤波估计值和滤波+平滑估计值与真实值之间的误差对比。图5为滤波估计值和滤波+平滑估计值与观测值之间的误差对比。可以看出与仅进行Kalman滤波的误差对比,滤波加最优平滑后的误差更小。
表1 仅Kalman滤波和Kalman滤波+最优平滑的误差均值和均方差对比(1)
误差均值 | 均方差 | |
仅Kalman滤波 | 14.459 | 29.177 |
Kalman滤波+最优平滑 | 11.571 | 23.111 |
在该仿真试验中,真实故障首达时刻r=79,仅滤波发现故障首达时刻rf=96,而经过Kalman滤波+最优平滑后发现故障首达时刻rf+s=81。结合上表可以进一步证明Kalman滤波+最优平滑可以有效提高估计精度从而更精确的发现状态故障或漂移的首达时刻。
为进一步确定方法的正确性,再进行蒙特卡洛仿真,以下为实验结果:
表2 仅Kalman滤波和Kalman滤波+最优平滑的误差均值和均方差对比(2)
误差均值 | 均方差 | |
仅Kalman滤波 | 17.616 | 35.469 |
Kalman滤波+最优平滑 | 14.029 | 29.313 |
在该仿真试验中,真实故障首达时刻r=77,仅滤波发现故障首达时刻rf=84,而经过Kalman滤波+最优平滑后发现故障首达时刻rf+s=78。
表3 仅Kalman滤波和Kalman滤波+最优平滑的误差均值和均方差对比(3)
误差均值 | 均方差 | |
仅Kalman滤波 | 7.929 | 10.868 |
Kalman滤波+最优平滑 | 8.567 | 16.115 |
在该仿真试验中,真实故障首达时刻r=87,仅滤波发现故障首达时刻rf=92,而经过Kalman滤波+最优平滑后发现故障首达时刻rf+s=88。
表4 仅Kalman滤波和Kalman滤波+最优平滑的误差均值和均方差对比(4)
误差均值 | 均方差 | |
仅Kalman滤波 | 6.678 | 11.383 |
Kalman滤波+最优平滑 | 5.912 | 10.092 |
在该仿真试验中,真实故障首达时刻r=51,仅滤波发现故障首达时刻rf=68,而经过Kalman滤波+最优平滑后发现故障首达时刻rf+s=56。
Claims (1)
1.一种基于滤波最优平滑确定故障首达时刻的故障诊断方法,其特征在于该方法具体包括以下各步骤:
步骤(1)通过系统的状态方程和观测方程使用Kalman滤波算法对系统状态进行估计,并持续迭代:
步骤(1-1)Kalman滤波过程:
给定如下离散线性系统:
其中,k为离散时间,系统在时刻k的状态为Xk∈Rn;Yk∈Rn为对应观测信号;Wk∈Rr为输入的白噪声;Vk∈Rm为观测噪声;称式(1)为状态方程和观测方程;A为状态转移矩阵,C为观测矩阵;
递推Kalman滤波器如下:
式(2)为状态一步预测式;
式(3)为新息表达式;式(4)为状态更新式;
Kk+1=Pk+1|kAT[APk+1|kAT+R]-1 (5)
式(5)为滤波增益矩阵求取式;
Pk+1|k=APk|kAT+Q (6)
式(6)为一步预测协方差阵;
Pk+1|k+1=[In-Kk+1A]Pk+1|k (7)
式(7)为协方差更新式;
其中状态估计值的初始值和初始协方差阵为:
步骤(1-2)某一状态分量发生故障:
系统状态某一分量f开始发生故障,由于故障首达时刻未知,将其设为r;此时系统的状态方程中状态转移部分加入缓变矩阵Xfault:
Xk+1=AXk-Xfault+Wk (9)
其中X1到Xf-1和Xf+1到Xn为正常的状态分量,Xf为发生故障的状态分量;此时观测方程不变;
步骤(2)滤波过程发现状态发生故障或漂移:
在迭代过程中,状态真实值无法直接获取,只能通过传感器的观测获得状态的观测值,对历史估计值和观测值之间的误差求取2-范数均值,设定报警阈值为3倍2-范数均值;
其中N为迭代当前时刻;若N时刻状态估计值和观测值的误差大于报警阈值,则认为系统状态已经发生了故障或漂移;
步骤(3)对系统状态进行平滑:
平滑过程如下:
Jk=Pk|kAT[Pk|k+1]-1 (12)
式(12)为最优平滑增益矩阵求取式;式(12)的边界条件为:k=N-1时,Pk+1|N=PN|N;
式(13)为最优平滑状态更新式;式(13)的边界条件为:k=N-1时,
式(14)为最优平滑协方差阵更新式;
步骤(4)确定故障的首达时刻:
在后验分析中,等待获得更多的观测数据,这时对状态的估计可以通过最优平滑进一步提高精度;在最优平滑过程中,判断平滑后当前时刻状态是否超过(11)报警阈值,如果超出则可确定故障首达时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910776604.8A CN110555398B (zh) | 2019-08-22 | 2019-08-22 | 一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910776604.8A CN110555398B (zh) | 2019-08-22 | 2019-08-22 | 一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110555398A true CN110555398A (zh) | 2019-12-10 |
CN110555398B CN110555398B (zh) | 2021-11-30 |
Family
ID=68738040
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910776604.8A Active CN110555398B (zh) | 2019-08-22 | 2019-08-22 | 一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110555398B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111090945A (zh) * | 2019-12-20 | 2020-05-01 | 淮阴工学院 | 一种针对切换系统的执行器和传感器故障估计设计方法 |
CN111399000A (zh) * | 2020-04-08 | 2020-07-10 | 广州通达汽车电气股份有限公司 | Gps漂移过滤方法、gps终端的状态切换方法及切换设备 |
CN111830829A (zh) * | 2020-07-08 | 2020-10-27 | 南京林业大学 | 激励型过阻尼rlc电路修复可靠时间的最优控制方法 |
CN112099065A (zh) * | 2020-08-11 | 2020-12-18 | 智慧航海(青岛)科技有限公司 | 一种面向船舶动力定位系统状态估计器的冗余容错系统 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130185020A1 (en) * | 2009-12-21 | 2013-07-18 | Converteam Technology Ltd. | Fault detection methods |
CN104536292A (zh) * | 2014-12-05 | 2015-04-22 | 北京航空航天大学 | 一种基于stf和mb的飞机环境控制系统换热器故障诊断方法 |
-
2019
- 2019-08-22 CN CN201910776604.8A patent/CN110555398B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130185020A1 (en) * | 2009-12-21 | 2013-07-18 | Converteam Technology Ltd. | Fault detection methods |
CN104536292A (zh) * | 2014-12-05 | 2015-04-22 | 北京航空航天大学 | 一种基于stf和mb的飞机环境控制系统换热器故障诊断方法 |
Non-Patent Citations (2)
Title |
---|
WEI YU等: "Minor Fault Detection for Permanent Magnet Synchronous Motor Based on Fractional Order Model and Relative Rate of Change", 《IEEE》 * |
文成林等: "基于信息增量矩阵的故障诊断方法", 《自动化学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111090945A (zh) * | 2019-12-20 | 2020-05-01 | 淮阴工学院 | 一种针对切换系统的执行器和传感器故障估计设计方法 |
CN111399000A (zh) * | 2020-04-08 | 2020-07-10 | 广州通达汽车电气股份有限公司 | Gps漂移过滤方法、gps终端的状态切换方法及切换设备 |
CN111830829A (zh) * | 2020-07-08 | 2020-10-27 | 南京林业大学 | 激励型过阻尼rlc电路修复可靠时间的最优控制方法 |
CN111830829B (zh) * | 2020-07-08 | 2022-05-03 | 南京林业大学 | 激励型过阻尼rlc电路修复可靠时间的最优控制方法 |
CN112099065A (zh) * | 2020-08-11 | 2020-12-18 | 智慧航海(青岛)科技有限公司 | 一种面向船舶动力定位系统状态估计器的冗余容错系统 |
Also Published As
Publication number | Publication date |
---|---|
CN110555398B (zh) | 2021-11-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110555398B (zh) | 一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 | |
CN109100714B (zh) | 一种基于极坐标系的低慢小目标跟踪方法 | |
CN110061716B (zh) | 一种基于最小二乘和多重渐消因子的改进kalman滤波方法 | |
CN110501696B (zh) | 一种基于多普勒量测自适应处理的雷达目标跟踪方法 | |
CN107045125A (zh) | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 | |
CN103389094B (zh) | 一种改进的粒子滤波方法 | |
CN110231620B (zh) | 一种噪声相关系统跟踪滤波方法 | |
CN108460210B (zh) | 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 | |
CN112432644A (zh) | 基于鲁棒自适应无迹卡尔曼滤波的无人艇组合导航方法 | |
CN103605886A (zh) | 一种船舶动力定位系统多模型自适应融合滤波方法 | |
CN110673148A (zh) | 一种主动声纳目标实时航迹解算方法 | |
CN106896363A (zh) | 一种水下目标主动跟踪航迹起始方法 | |
CN102706345A (zh) | 一种基于衰减记忆序贯检测器的机动目标跟踪方法 | |
CN108226887B (zh) | 一种观测量短暂丢失情况下的水面目标救援状态估计方法 | |
CN113532439A (zh) | 输电线路巡检机器人同步定位与地图构建方法及装置 | |
Qian et al. | An INS/DVL integrated navigation filtering method against complex underwater environment | |
CN113534164A (zh) | 一种基于主被动联合声纳阵列的目标路径跟踪方法 | |
CN116680500B (zh) | 水下航行器在非高斯噪声干扰下的位置估计方法及系统 | |
CN115469314A (zh) | 一种均匀圆环阵稳健水下目标方位跟踪方法及系统 | |
CN112198504B (zh) | 一种主被动观测特征交织的融合滤波方法 | |
CN110767322B (zh) | 一种基于响应面模型的海洋浮式平台热点应力推算方法 | |
CN113124871A (zh) | 一种基于数据质量评估的自适应航迹关联方法 | |
CN113640780B (zh) | 基于改进的联邦滤波的水下auv传感器时间配准方法 | |
Yan et al. | Multi-beam Data Automatic Filtering Technology | |
CN116702479B (zh) | 一种水下航行器未知输入与位置估计方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |