CN107169478A - 一种自适应在线滤波方法 - Google Patents
一种自适应在线滤波方法 Download PDFInfo
- Publication number
- CN107169478A CN107169478A CN201710492221.9A CN201710492221A CN107169478A CN 107169478 A CN107169478 A CN 107169478A CN 201710492221 A CN201710492221 A CN 201710492221A CN 107169478 A CN107169478 A CN 107169478A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mover
- moment
- msub
- mfrac
- 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.)
- Pending
Links
Classifications
-
- 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)
- Theoretical Computer Science (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Complex Calculations (AREA)
Abstract
本发明提供一种自适应在线滤波方法,该方法是一种基于自适应当前统计模型的改进的卡尔曼滤波器的方法。首先,为了到达在线去噪的目的,采用了递归卡尔曼滤波;其次,运用自适应当前统计模型来抓取数据的波动特性,同时也去除估计过程中的有色噪音;最后,引入滑动窗口,并且运用一种自适应平滑滤波的误差补偿方法,将测量噪音收敛于真值,并去除测量噪音,从而使结果更加精确。其利用多个自适应模型实时修正参数,解决了传感器测量数据的高精度在线去噪问题,具有普适性。
Description
技术领域
本发明涉及信号处理技术领域,尤其涉及一种自适应在线滤波方法。
背景技术
随着大数据时代的来临,各种各样的数据时时刻刻都会经由如手机、智能手环、共享单车等各式各样的传感器器件传输到数据中心中,与此同时,人们对数据的准确性和可靠性的要求也越来越高;但是,在实际系统中,错误的测量方式、传感器元件的老化、有缺陷的数据收集方式或外界的干扰等,都会造成测量数据中含有噪音,而任何噪音都有可能对数据的分析和使用造成严重的误差和错误的结果。因此如何实时的处理这些数据,实现在线去噪,提高数据精度具有重要的意义。
在实际系统中,常常需要实时在线的处理传感器的测量数据,以达到实时数据传输,比如对行人车辆轨迹测量、土木结构的形变监测等等,所以需要大量离线数据的方法如小波变换滤波,频率域滤波并不适用。其次,传感器测到的很多测量数据都是具有强机动性的,所以,SG滤波方法、BISE方法、平滑滤波法、指数平滑滤波法、经典的卡尔曼滤波等传统方法都无法保留数据迅速变化的特性,去噪效果不够精确。最后,由于测量过程中测量噪音的存在,会极大的影响数据精度,人们往往利用经验知识来给定测量噪音方差,这样的方法是不够准确的。
在现有的研究成果和技术方法中,还没有能够同时解决上述三类问题的高精度在线去噪方法,导致现有方法的通用性较弱,精度较低。
发明内容
基于此,本发明的目的在于提供一种自适应在线滤波的方法,利用多个自适应模型实时修正参数,解决了传感器测量数据的高精度在线去噪问题,其精度高,普适性强,具有良好的在线去噪效果。
该方法是一种基于自适应当前统计模型的改进的卡尔曼滤波器的方法。首先,为了到达在线去噪的目的,采用了递归卡尔曼滤波;其次,运用自适应当前统计模型来抓取数据的波动特性,同时也去除估计过程中的有色噪音;最后,引入滑动窗口,并且运用一种自适应平滑滤波的误差补偿方法,将测量噪音收敛于真值,并去除测量噪音,从而使结果更加精确。
具体实现步骤如下:
步骤1:数据波动状态和系统自适应参数初始化;
步骤2:建立具有系统自适应参数的自适应当前统计模型,求出符合数据波动特性的状态转移矩阵Φ(k+1,k),输入矩阵U(k)以及有色过程噪音方差Q(k);其中,系统自适应参数包括机动频率α和变化率方差
步骤3:根据自适应当前统计模型和数据初始状态对数据进行一步预测,得出下一时刻数据的状态预测值
步骤4:基于自适应当前统计模型和过程噪音计算向前一步估计方差P(k+1|k);
步骤5:通过测量数据y(k+1)和状态预测值计算出估计过程中的残差e(k);
步骤6:引入滑动窗口;
步骤7:通过滑动窗口和残差计算出窗口内残差均值
步骤8:通过残差均值和向前一步估计方差求出测量噪音R(k);
步骤9:根据向前一步估计方差和测量噪音求出卡尔曼滤波增益K(k+1);
步骤10:根据向前一步状态预测值,测量数据和卡尔曼滤波增益更新状态估计值
步骤11:通过卡尔曼滤波增益和向前一步估计方差,得到更新后的估计方差P(k+1|k+1);
步骤12:利用Yule-Walker方法,通过状态估计值更新系统自适应参数,进而更新自适应当前统计模型。
步骤13:重复步骤2至步骤12,直至所有测量数据全部执行完毕,则结束。
在上述技术方案的基础上,本发明还可以做如下改进。
进一步地,步骤1中数据波动状态和系统自适应参数初始化包括:
设置数据波动状态的初始值
设置估计方差初值P(0|0)=P0;
设置自适应当前统计模型参数初值:α(0)=α0、
设置过程噪音方差初值Q(0)=Q0;
设置测量噪音方差初值R(0)=R0。
进一步地,步骤2中建立具有系统自适应参数的自适应当前统计模型,包括:
将系统的状态向量设置成:x,分别表示位移、速度和加速度;
建立反应数据波动特性的离散时间方程:
式中,x(k+1)为k+1时刻数据的状态向量,k为采样时刻;Φ(k+1,k)表示状态转移矩阵;x(k)为k时刻数据的状态向量,U(k)表示输入矩阵,为0时刻开始至k时刻数据的加速度均值;w(k)表示过程噪音,其均值为0,方差为Q(k);Φ(k+1,k)、U(k)和Q(k)中含有机动频率α和变化率方差随着系统自适应参数的变化而变化。
进一步地,步骤5的计算公式如下:
式中,e(k+1)为估计过程中的残差,y(k+1)为测量数据,H(k)表示k时刻的测量矩阵,表示k时刻预测目标在k+1时刻的状态,k为采样时刻,|表示条件操作符。
进一步地,步骤7的计算公式如下:
其中,表示k+1时刻的残差均值,k为采样时刻,表示k时刻的残差均值,e(k+1)表示估计过程中的残差,N为残差的个数。
进一步地,步骤8的计算公式如下:
其中,e(k+1)表示估计过程中的残差,表示k+1时刻的残差均值,k为采样时刻;H(k+1)表示k+1时刻的测量矩阵,P(k+1|k)表示向前一步估计方差,|表示条件操作符;H(k+1)表示k+1时刻的测量矩阵,N为残差的个数。
进一步地,步骤9的计算公式如下:
K(k+1)=P(k+1|k)HT(k+1)[H(k+1)P(k+1|k)HT(k+1)+R]-1
式中,K(k+1)为k+1时刻的卡尔曼滤波增益,k为采样时刻,P(k+1|k)表示向前一步估计方差,|表示条件操作符;H(k+1)表示k+1时刻的测量矩阵,HT(k+1)表示k+1时刻的测量矩阵的装置,R为高斯测量白噪音的方差。
进一步地,步骤10的计算公式如下:
其中,表示状态估计值,y(k+1)为测量数据,表示k时刻预测目标在k+1时刻的状态,k为采样时刻,|表示条件操作符;K(k+1)表示k+1时刻的卡尔曼滤波增益,H(k+1)表示k+1时刻的测量矩阵。
进一步地,步骤11的计算公式如下:
P(k+1|k+1)=[I-K(k+1)H(k+1)]P(k+1|k)
其中,I是3维矩阵,P(k+1|k+1)表示k+1时刻的目标状态估计方差,k为采样时刻,K(k+1)为k+1时刻的卡尔曼滤波增益,P(k+1|k)表示向前一步估计方差,|表示条件操作符,H(k+1)表示k+1时刻的测量矩阵。
进一步地,步骤12的计算公式如下:
式中,lk(1)为k时刻的状态向量中变化率分量的向前一步相关函数,lk(0)为k时刻状态向量中变化率分量自相关函数;为k时刻的计算中间变量,为k时刻的变化率方差;表示k时刻数据波动加速度估计值,表示k-1时刻数据波动加速度估计值;ln为以e取对数计算,α(k)为k时刻的机动频率,α(k)和为系统自适应参数,k为采样时刻,T为采样间隔。
本发明的有益效果是:
本发明的自适应在线滤波方法,利用多个自适应模型实时修正参数,解决了传感器测量数据的高精度在线去噪问题,具有以下优点:
1.针对传感器数据实时处理的问题,利用卡尔曼递归估计算法实现在线去噪。
2.针对数据机动性强的问题,利用自适应当前统计模型来抓取数据的波动特性,与此同时,去除估计过程中的有色噪音。
3.针对不同测量数据的测量噪音不同的问题,引入滑动窗口,利用一种自适应平滑滤波的误差补偿方法,将测量方差收敛于真值。
4.实验证明本发明的去噪方法精度高,普适性强,具有良好的在线去噪效果。
附图说明
图1是本发明的自适应在线滤波方法的流程图;
图2是实施例1的真实值和测量值的对比图;
图3是实施例1的测量值和去噪后的值的对比图;
图4是实施例1的真实值和去噪后的值的对比图;
图5是实施例1的测量噪音方差的收敛图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例对本发明的自适应在线滤波方法进行进一步详细说明。需要说明的是,在不冲突的情况下,以下各实施例及实施例中的特征可以相互组合。应当理解,此处所描述的具体实施例仅用于解释本发明,并不用于限定本发明。
参照图1,本发明一实施例的自适应在线滤波方法,包括以下步骤:
步骤S1:数据波动状态和系统自适应参数初始化;
步骤S2:建立具有系统自适应参数的自适应当前统计模型,求出符合数据波动特性的状态转移矩阵Φ(k+1,k),输入矩阵U(k)以及有色过程噪音方差Q(k);其中,系统自适应参数包括机动频率α和变化率方差
步骤S3:根据自适应当前统计模型和数据初始状态对数据进行一步预测,得出下一时刻数据的状态预测值
步骤S4:基于自适应当前统计模型和过程噪音计算向前一步估计方差P(k+1|k);
步骤S5:通过测量数据y(k+1)和状态预测值计算出估计过程中的残差e(k);
步骤S6:引入滑动窗口;
步骤S7:通过滑动窗口和残差计算出窗口内残差均值
步骤S8:通过残差均值和向前一步估计方差求出测量噪音R(k);
步骤S9:根据向前一步估计方差和测量噪音求出卡尔曼滤波增益K(k+1);
步骤S10:根据向前一步状态预测值,测量数据和卡尔曼滤波增益更新状态估计值
步骤S11:通过卡尔曼滤波增益和向前一步估计方差,得到更新后的估计方差P(k+1|k+1);
步骤S12:利用Yule-Walker方法,通过状态估计值更新系统自适应参数,进而更新自适应当前统计模型。
步骤S13:重复步骤S2至步骤S12,直至所有测量数据全部执行完毕,则结束。
以上各步骤具体如下:
步骤S1:设置初值:
设置数据波动状态的初始值
设置估计方差初值P(0|0)=P0;
设置自适应当前统计模型参数初值:α(0)=α0、
设置过程噪音方差初值Q(0)=Q0;
设置测量噪音方差初值R(0)=R0。
本实例中:x0=0;P0=100*eye(3);α0=1/20;Q0=anyvalue;R0=anyvalue。
步骤S2:建立自适应当前统计模型:
为了更好的抓取数据的波动特性,将系统的状态向量设置成:其中x,分别表示位移、速度和加速度;其次,为了去除估计过程中的有色噪音,设数据的波动特性为非零均值的时间相关随机过程:其中为加速度均值,v(t)为零均值指数相关有色噪音模型,其相关函数为:
式中:Rv(τ)表示相关函数,表示的方差,α为机动频率,反应数据的波动特性。
接着对有色噪音v(t)做白化处理,得到:
式中:表示有色噪音v(t)的一阶导数;w(t)为零均值白噪音,方差为
综上所述,以周期T采样,可以得到如下的反应数据波动特性的离散时间方程:
式中,Φ(k+1,k)表示状态转移矩阵,U(k)表示输入矩阵,w(k)表示过程噪音;x(k+1)为k+1时刻数据的状态向量,k为采样时刻;Φ(k+1,k)表示状态转移矩阵;x(k)为k时刻数据的状态向量,U(k)表示输入矩阵,为0时刻开始至k时刻数据的波动加速度均值;w(k)表示过程噪音,其均值为0,方差为Q(k);Φ(k+1,k)、U(k)和Q(k)中含有机动频率α和变化率方差随着系统自适应参数的变化而变化。
则:
其中:
步骤S3:根据自适应当前统计模型和系统状态初值计算下一时刻的状态预测值
其中,表示k时刻预测数据在k+1时刻的状态,k为采样时刻,|表示条件操作符,Φ(k+1,k)表示状态转移矩阵,U(k)表示输入矩阵,为加速度均值;表示数据在k时刻的状态估计值,特别的在k=0时刻为初值
步骤S4:基于自适应当前统计模型和过程噪音计算向前一步估计方差P(k+1|k):
P(k+1|k)=Φ(k+1,k)P(k|k)ΦT(k+1,k)+Q(k)
式中,P(k+1|k)表示向前一步估计方差,即k时刻预测数据在k+1时刻的状态协方差,k为采样时刻,|表示条件操作符;Φ(k+1,k)表示状态转移矩阵,U(k)表示输入矩阵,P(k|k)表示k时刻数据的状态协方差的估计值,Q(k)为过程噪音协方差。
步骤S5:通过测量数据y(k+1)和一步预测值计算估计过程中的残差e(k):计算公式如下:
式中,e(k+1)为估计过程中的残差,y(k+1)为测量数据,H(k)表示k时刻的测量矩阵,表示k时刻预测数据在k+1时刻的状态,k为采样时刻,|表示条件操作符。
步骤S6:引入滑动窗口,需取一个较大的数,这个窗口的大小对结果影响不大,本实验中滑动窗口长度取100。
步骤S7:优化残差值,得到残差均值计算公式如下:
其中,表示k+1时刻的残差均值,k为采样时刻,表示k时刻的残差均值,e(k+1)表示估计过程中的残差,N为残差的个数。
步骤S8:通过残差均值和向前一步方差求出测量噪音R(k+1),计算公式如下:
其中,e(k+1)表示估计过程中的残差,表示k+1时刻的残差均值,k为采样时刻;H(k+1)表示k+1时刻的测量矩阵,P(k+1|k)表示向前一步估计方差,|表示条件操作符;H(k+1)表示k+1时刻的测量矩阵,N为残差的个数,残差的个数与样本中数据的数量相等。
步骤S9:根据向前一步估计方差和测量噪音求出卡尔曼滤波增益K(k+1),计算公式如下:
K(k+1)=P(k+1|k)HT(k+1)[H(k+1)P(k+1|k)HT(k+1)+R]-1
式中,K(k+1)为k+1时刻的卡尔曼滤波增益,k为采样时刻,P(k+1|k)表示向前一步估计方差,|表示条件操作符;H(k+1)表示k+1时刻的测量矩阵,HT(k+1)表示k+1时刻的测量矩阵的装置,R为高斯测量白噪音的方差。
步骤S10:根据向前一步状态预测值、测量数据和卡尔曼增益更新状态估计值计算公式如下:
其中,表示状态估计值,y(k+1)为测量数据,表示k时刻预测数据在k+1时刻的状态,k为采样时刻,|表示条件操作符;K(k+1)表示k+1时刻的卡尔曼滤波增益,H(k+1)表示k+1时刻的测量矩阵。
步骤S11:通过卡尔曼增益和向前一步估计方差得到更新后的估计方差,计算公式如下:
P(k+1|k+1)=[I-K(k+1)H(k+1)]P(k+1|k)
其中,I是3维矩阵,P(k+1|k+1)表示k+1时刻的数据状态估计方差,k为采样时刻,K(k+1)为k+1时刻的卡尔曼滤波增益,P(k+1|k)表示向前一步估计方差,|表示条件操作符,H(k+1)表示k+1时刻的测量矩阵。
步骤S12:利用Yule-Walker方法,通过状态估计值更新自适应当前模型参数,计算公式如下:
式中,lk(1)为k时刻的状态向量中变化率分量的向前一步相关函数,lk(0)为k时刻状态向量中变化率分量自相关函数;为k时刻的计算中间变量,为k时刻的变化率方差;表示k时刻数据加速度估计值,表示k-1时刻数据加速度估计值;ln为以e取对数计算,α(k)为k时刻的机动频率,α(k)和为系统自适应参数,T为采样间隔。从而实时更新自适应当前统计模型中的参数。
步骤S13:重复步骤S2至步骤S12,直至所有测量数据全部执行完毕,则结束。
实施例1:
本实施例将自适应在线滤波方法应用于传感器数据的在线去噪,在未知过程噪声及测量噪声的方差的情况下,自适应滤波仍然可以获得很好的去噪效果。实验选用了10000组试验测量数据对本发明进行计算,时间步长为0.01s,数据见表1。
表1实验1测量数据和真实数据
序号 | t(s) | 测试值(mm) | 真实值(mm) | 序号 | t(s) | 测试值(mm) | 真实值(mm) |
1 | 0 | 0 | 0 | 4263 | 42.620 | 0.2604 | 0.1561 |
2 | 0.010 | 0.0730 | 0 | 4264 | 42.630 | 1.3571 | 0.1522 |
3 | 0.020 | 0.7186 | -0.0009 | 4265 | 42.640 | -1.6070 | 0.1559 |
4 | 0.030 | 0.7905 | -0.0058 | 4266 | 42.650 | -0.1795 | 0.1558 |
5 | 0.040 | -0.0331 | -0.0139 | 4267 | 42.660 | -0.6736 | 0.1473 |
6 | 0.050 | 0.7105 | -0.0147 | 4268 | 42.670 | -0.3565 | 0.1465 |
7 | 0.060 | -0.6498 | -0.0006 | … | … | … | … |
8 | 0.070 | 0.6986 | 0.0172 | 9996 | 99.950 | -0.3466 | 0.4242 |
… | … | … | … | 9997 | 99.960 | 0.6960 | 0.4145 |
4260 | 42.590 | -0.2593 | 0.1731 | 9998 | 99.970 | 0.3460 | 0.4117 |
4261 | 42.600 | -0.6345 | 0.1687 | 9999 | 99.980 | -0.2687 | 0.4118 |
4262 | 42.610 | 0.0060 | 0.1623 | 10000 | 99.990 | -0.2935 | 0.4156 |
按上述具体实施方式的步骤进行仿真验证,验证结果见附图2-附图5。附图2是实施例1的真实值和测量值的对比图;附图3是实施例1的测量值和去噪后的值的对比图;附图4是实施例1的真实值和去噪后的值的对比图;附图5是实施例1的测量噪音方差的收敛图。
在附图2-附图4中:横坐标表示时间,单位为s(秒);纵坐标表示位移,单位为mm(毫米)。附图2中,中部的一条连续折线表示真实值;附图3中,中部的一条连续折线表示去噪后的值;附图4中,连续折线101表示真实值,连续折线102表示去噪后的值。
在附图5中:横坐标表示离散采样点,纵坐标表示测量噪音方差,单位为mm(毫米)。
从附图2至附图5可以看出,采用本发明的自适应在线滤波方法可以对数据有效进行实时在线去噪,将测量方差收敛于真值,其精度高,具有良好的在线去噪效果,解决了传感器测量数据的高精度在线去噪问题。此外,该方法具有普适性,可拓展运用于各种具有动力学特性的数据的实时在线去噪,可以广泛的应用于实际系统中具有强机动性和有色噪音的数据预处理中。
以上各实施例的自适应在线滤波方法,利用多个自适应模型实时修正参数,解决了传感器测量数据的高精度在线去噪问题,具有以下优点:
1.针对传感器数据实时处理的问题,利用卡尔曼递归估计算法实现在线去噪。
2.针对数据机动性强的问题,利用自适应当前统计模型来抓取数据的波动特性,与此同时,去除估计过程中的有色噪音。
3.针对不同测量数据的测量噪音不同的问题,引入滑动窗口,利用一种自适应平滑滤波的误差补偿方法,将测量方差收敛于真值。
4.实验证明本发明的去噪方法精度高,普适性强,具有良好的在线去噪效果。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种自适应在线滤波方法,其特征在于,包括以下步骤:
步骤1:数据波动状态和系统自适应参数初始化;
步骤2:建立具有系统自适应参数的自适应当前统计模型,求出符合数据波动特性的状态转移矩阵Φ(k+1,k),输入矩阵U(k)以及有色过程噪音方差Q(k);其中,系统自适应参数包括机动频率α和变化率方差
步骤3:根据自适应当前统计模型和数据初始状态对数据进行一步预测,得出下一时刻数据的状态预测值
步骤4:基于自适应当前统计模型和过程噪音计算向前一步估计方差P(k+1|k);
步骤5:通过测量数据y(k+1)和状态预测值计算出估计过程中的残差e(k);
步骤6:引入滑动窗口;
步骤7:通过滑动窗口和残差计算出窗口内残差均值
步骤8:通过残差均值和向前一步估计方差求出测量噪音R(k);
步骤9:根据向前一步估计方差和测量噪音求出卡尔曼滤波增益K(k+1);
步骤10:根据向前一步状态预测值,测量数据和卡尔曼滤波增益更新状态估计值
步骤11:通过卡尔曼滤波增益和向前一步估计方差,得到更新后的估计方差P(k+1|k+1);
步骤12:利用Yule-Walker方法,通过状态估计值更新系统自适应参数,进而更新自适应当前统计模型。
步骤13:重复步骤2至步骤12,直至所有测量数据全部执行完毕,则结束。
2.根据权利要求1所述的自适应在线滤波方法,其特征在于,步骤1中数据波动状态和系统自适应参数初始化包括:
设置数据波动状态的初始值
设置估计方差初值P(0|0)=P0;
设置自适应当前统计模型参数初值:α(0)=α0、
设置过程噪音方差初值Q(0)=Q0;
设置测量噪音方差初值R(0)=R0。
3.根据权利要求2所述的自适应在线滤波方法,其特征在于,步骤2中建立具有系统自适应参数的自适应当前统计模型,包括:
将系统的状态向量设置成:x,分别表示位移、速度和加速度;
建立反应数据波动特性的离散时间方程:
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&Phi;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>U</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mover>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>w</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
式中,x(k+1)为k+1时刻数据的状态向量,k为采样时刻;Φ(k+1,k)表示状态转移矩阵;x(k)为k时刻数据的状态向量,U(k)表示输入矩阵,为0时刻开始至k时刻数据的加速度均值;w(k)表示过程噪音,其均值为0,方差为Q(k);Φ(k+1,k)、U(k)和Q(k)中含有机动频率α和变化率方差随着系统自适应参数的变化而变化。
4.根据权利要求3所述的自适应在线滤波方法,其特征在于,步骤5的计算公式如下:
<mrow>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>H</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
式中,e(k+1)为估计过程中的残差,y(k+1)为测量数据,H(k)表示k时刻的测量矩阵,表示k时刻预测数据在k+1时刻的状态,k为采样时刻,|表示条件操作符。
5.根据权利要求4所述的自适应在线滤波方法,其特征在于,步骤7的计算公式如下:
<mrow>
<mover>
<mi>e</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>N</mi>
</mfrac>
<mover>
<mi>e</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>N</mi>
</mfrac>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,表示k+1时刻的残差均值,k为采样时刻,表示k时刻的残差均值,e(k+1)表示估计过程中的残差,N为残差的个数。
6.根据权利要求5所述的自适应在线滤波方法,其特征在于,步骤8的计算公式如下:
<mrow>
<mi>&Delta;</mi>
<mi>R</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>(</mo>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
<mo>-</mo>
<mover>
<mi>e</mi>
<mo>&OverBar;</mo>
</mover>
<mo>(</mo>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>(</mo>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
<mo>-</mo>
<mover>
<mi>e</mi>
<mo>&OverBar;</mo>
</mover>
<mo>(</mo>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mi>N</mi>
</mfrac>
<mrow>
<mo>(</mo>
<mi>H</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mi>P</mi>
<mo>(</mo>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
</mrow>
<mo>)</mo>
<mi>H</mi>
<msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>R</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>N</mi>
</mfrac>
<mi>R</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>&Delta;</mi>
<mi>R</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,e(k+1)表示估计过程中的残差,表示k+1时刻的残差均值,k为采样时刻;H(k+1)表示k+1时刻的测量矩阵,P(k+1|k)表示向前一步估计方差,|表示条件操作符;H(k+1)表示k+1时刻的测量矩阵,N为残差的个数。
7.根据权利要求1所述的自适应在线滤波方法,其特征在于,步骤9的计算公式如下:
K(k+1)=P(k+1|k)HT(k+1)[H(k+1)P(k+1|k)HT(k+1)+R]-1
式中,K(k+1)为k+1时刻的卡尔曼滤波增益,k为采样时刻,P(k+1|k)表示向前一步估计方差,|表示条件操作符;H(k+1)表示k+1时刻的测量矩阵,HT(k+1)表示k+1时刻的测量矩阵的装置,R为高斯测量白噪音的方差。
8.根据权利要求1所述的自适应在线滤波方法,其特征在于,步骤10的计算公式如下:
<mrow>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>&lsqb;</mo>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>H</mi>
<mo>(</mo>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
其中,表示状态估计值,y(k+1)为测量数据,表示k时刻预测目标在k+1时刻的状态,k为采样时刻,|表示条件操作符;K(k+1)表示k+1时刻的卡尔曼滤波增益,H(k+1)表示k+1时刻的测量矩阵。
9.根据权利要求1所述的自适应在线滤波方法,其特征在于,步骤11的计算公式如下:
P(k+1|k+1)=[I-K(k+1)H(k+1)]P(k+1|k)
其中,I是3维矩阵,P(k+1|k+1)表示k+1时刻的目标状态估计方差,k为采样时刻,K(k+1)为k+1时刻的卡尔曼滤波增益,P(k+1|k)表示向前一步估计方差,|表示条件操作符,H(k+1)表示k+1时刻的测量矩阵。
10.根据权利要求1所述的自适应在线滤波方法,其特征在于,步骤12的计算公式如下:
<mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>l</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>k</mi>
</mfrac>
<mo>&lsqb;</mo>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>l</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>l</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>k</mi>
</mfrac>
<mo>&lsqb;</mo>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>l</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<msubsup>
<mi>&delta;</mi>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>w</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&alpha;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>&alpha;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mi>T</mi>
</mfrac>
<mi>l</mi>
<mi>n</mi>
<mfrac>
<mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mrow>
2
<mrow>
<msubsup>
<mi>&delta;</mi>
<mi>w</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<msubsup>
<mi>&delta;</mi>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>w</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>&lsqb;</mo>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>&rsqb;</mo>
</mrow>
</mfrac>
</mrow>
式中,lk(1)为k时刻的状态向量中变化率分量的向前一步相关函数,lk(0)为k时刻状态向量中变化率分量自相关函数;为k时刻的计算中间变量,为k时刻的变化率方差;表示k时刻数据波动加速度估计值,表示k-1时刻数据波动加速度估计值;ln为以e取对数计算,α(k)为k时刻的机动频率,α(k)和为系统自适应参数,k为采样时刻,T为采样间隔。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710492221.9A CN107169478A (zh) | 2017-06-26 | 2017-06-26 | 一种自适应在线滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710492221.9A CN107169478A (zh) | 2017-06-26 | 2017-06-26 | 一种自适应在线滤波方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107169478A true CN107169478A (zh) | 2017-09-15 |
Family
ID=59826427
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710492221.9A Pending CN107169478A (zh) | 2017-06-26 | 2017-06-26 | 一种自适应在线滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107169478A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109388063A (zh) * | 2018-08-27 | 2019-02-26 | 广西科技大学 | 自适应卡尔曼滤波复合控制方法 |
CN109815866A (zh) * | 2019-01-14 | 2019-05-28 | 北京工商大学 | 一种基于数据融合的噪声消除方法 |
CN110032711A (zh) * | 2019-04-22 | 2019-07-19 | 中南大学 | 一种基于参数动态调节的快速卡尔曼在线检测滤波方法 |
CN110545305A (zh) * | 2018-05-28 | 2019-12-06 | 塔塔咨询服务有限公司 | 用于自适应参数采样的方法和系统 |
CN113390421A (zh) * | 2021-08-17 | 2021-09-14 | 武汉理工大学 | 基于卡尔曼滤波的无人机定位方法及装置 |
-
2017
- 2017-06-26 CN CN201710492221.9A patent/CN107169478A/zh active Pending
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110545305A (zh) * | 2018-05-28 | 2019-12-06 | 塔塔咨询服务有限公司 | 用于自适应参数采样的方法和系统 |
CN110545305B (zh) * | 2018-05-28 | 2022-03-18 | 塔塔咨询服务有限公司 | 用于自适应参数采样的方法和系统 |
CN109388063A (zh) * | 2018-08-27 | 2019-02-26 | 广西科技大学 | 自适应卡尔曼滤波复合控制方法 |
CN109815866A (zh) * | 2019-01-14 | 2019-05-28 | 北京工商大学 | 一种基于数据融合的噪声消除方法 |
CN110032711A (zh) * | 2019-04-22 | 2019-07-19 | 中南大学 | 一种基于参数动态调节的快速卡尔曼在线检测滤波方法 |
CN110032711B (zh) * | 2019-04-22 | 2022-07-12 | 中南大学 | 一种基于参数动态调节的快速卡尔曼滤波的在线检测方法 |
CN113390421A (zh) * | 2021-08-17 | 2021-09-14 | 武汉理工大学 | 基于卡尔曼滤波的无人机定位方法及装置 |
CN113390421B (zh) * | 2021-08-17 | 2021-12-10 | 武汉理工大学 | 基于卡尔曼滤波的无人机定位方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107169478A (zh) | 一种自适应在线滤波方法 | |
CN110927706B (zh) | 基于卷积神经网络的雷达干扰检测识别方法 | |
Dini et al. | Class of widely linear complex Kalman filters | |
CN107229060B (zh) | 一种基于自适应滤波的gps测量数据处理方法 | |
Eichstädt et al. | Deconvolution filters for the analysis of dynamic measurement processes: a tutorial | |
CN110503071A (zh) | 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法 | |
JP2019513265A (ja) | 自動多閾値特徴フィルタリング方法及び装置 | |
CN110048416B (zh) | S-g滤波和自适应mp算法的低频振荡模态辨识方法 | |
WO2007053831A2 (en) | Optimum nonlinear correntropy filter | |
CN107202989A (zh) | 一种适用于被动拖曳线列阵声呐的复杂弱目标检测和跟踪方法 | |
CN108120452B (zh) | Mems陀螺仪动态数据的滤波方法 | |
CN107122724B (zh) | 一种基于自适应滤波的传感器数据在线去噪的方法 | |
CN106603036A (zh) | 一种基于低阶内插滤波器的自适应时延估计方法 | |
CN110855269B (zh) | 一种自适应滤波的系数更新方法 | |
CN110716203B (zh) | 一种被动声纳目标的时频分析与跟踪方法 | |
CN103784164B (zh) | 超声信号的预处理方法及系统 | |
CN112946641A (zh) | 一种基于卡尔曼滤波新息与残差相关的数据滤波方法 | |
Wang et al. | An innovative modulating functions method for pseudo-state estimation of fractional order systems | |
CN104316905B (zh) | 处理飞行时间测距数据的自适应卡尔曼滤波的方法 | |
Sun et al. | Variational Bayesian two-stage Kalman filter for systems with unknown inputs | |
CN104868876B (zh) | 一种针对过程噪声协方差矩阵Q未知情况下的Kalman滤波方法 | |
CN113884914B (zh) | 一种渐消并行卡尔曼滤波动力电池荷电状态估计方法 | |
CN114676732A (zh) | 基于改进卡尔曼滤波算法的色谱峰滤波方法及系统 | |
CN111207305A (zh) | 用于锅炉管道泄漏点定位的信号时延估值方法 | |
CN114061592A (zh) | 基于多模型的自适应鲁棒auv导航方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170915 |