CN104168005A - 带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法 - Google Patents
带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法 Download PDFInfo
- Publication number
- CN104168005A CN104168005A CN201410422530.5A CN201410422530A CN104168005A CN 104168005 A CN104168005 A CN 104168005A CN 201410422530 A CN201410422530 A CN 201410422530A CN 104168005 A CN104168005 A CN 104168005A
- Authority
- CN
- China
- Prior art keywords
- covariance matrix
- matrix
- observation noise
- observation
- sequence
- 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
Landscapes
- Complex Calculations (AREA)
Abstract
本发明提供了针对离散时间时不变***的一种带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法,解决了离散时间线性时不变***中观测噪声协方差矩阵完全未知的情况下的***状态滤波估计问题。步骤一、利用观测序列构建新统计序列;步骤二、计算{ξk}的协方差矩阵递推公式;步骤三、计算观测噪声协方差矩阵估计序列{f(R)k};步骤四、计算出协方差矩阵的估计序列然后通过代数关系计算观测噪声协方差矩阵的实时估计;步骤五、将观测噪声的协方差矩阵估计序列替代真值代入标准卡尔曼滤波方法中,计算***实时的状态估计以及状态估计偏差的协方差矩阵。
Description
技术领域
本发明属于离散时间自适应滤波领域,具体涉及一种带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法。
背景技术
卡尔曼滤波理论由于其自身的优越性,经过50多年的发展,如今不同形式的卡尔曼滤波理论已经在不同的工程领域得到了理论推广与应用。
卡尔曼滤波方法是一种时域状态估计方法,由于其采用了状态空间的描述方法,且其递推形式易于计算机实现,基于状态空间的状态估计可以应用到现代控制理论中的先进性控制方法,获得良好的***性能。针对线性状态空间模型描述的***,通过标准的卡尔曼滤波方法可以从存在观测噪声的观测序列中获取***内部状态的估计,提高***控制性能,更好的完成***的控制目标。在***方程和量测方程已知的情况下,对信号进行估计,估计过程利用了如下信息:***方程、量测方程、白噪声激励的统计特性和量测误差的统计特性。
当线性***的***参数和噪声的统计特性符合要求时,标准的卡尔曼滤波方法是在最小方差和最大似然意义下的一种最优状态估计方法。标准卡尔曼滤波方法是针对线性***,并且要求其***噪声和观测噪声为零均值高斯白噪声。
在标准卡尔曼滤波方法中,观测噪声协方差矩阵是不可或缺的重要参数。观测噪声的协方差矩阵表征***模型中的观测信号叠加随机噪声的统计特性。在工程实践中,许多情况下***噪声和观测噪声的协方差矩阵常难以事先精确获知。当无法获取观测噪声协方差矩阵精确值时,设计者常采用观测噪声协方差矩阵的上限替代精确的协方差矩阵。这会破坏标准卡尔曼滤波方法的最优性,且如果选取的误差协方差矩阵的上限与真实协方差矩阵误差较大时,可能会引起标准卡尔曼滤波方法的性能大幅衰减甚至状态估计误差发散而不能正常工作。
针对离散时间***一般自适应卡尔曼滤波方法在线辨识观测噪声的协方差矩阵方法与***状态实时估计相互耦合,这会增加估计算法计算复杂度和闭环稳定性分析在数学上分析困难程度。
改进离散时间标准卡尔曼滤波的方法,在离散时间线性时不变***中观测噪声协方差矩阵完全未知的情况下,对***状态进行滤波估计是亟待解决的问题。
发明内容
有鉴于此,本发明提供了针对离散时间时不变***的一种带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法,目的是要解决离散时间线性时不变***中观测噪声协方差矩阵完全未知的情况下,兼顾滤波算法的实时性要求的***状态滤波估计问题。
为达到上述目的,本发明技术方案为:
一种带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法,该方法所针对的离散时间线性时不变***模型为:
其中xk∈Rn×1为k时刻***状态,xk-1为k-1时刻的***状态,A为状态转移矩阵,wk-1为***过程噪声,C为观测矩阵,vk为***观测噪声,yk∈Rm×1为k时刻***观测;
其中A、C为常值矩阵且已知;其中由***观测yk组成的观测序列{yk}有界;***的过程噪声和观测噪声为不相关零均值高斯白噪声,其中观测噪声协方差矩阵为常值R、过程噪声协方差矩阵为常值矩阵Q;存在可观测矩阵
Mo=[C CA … CAn-1]T
其中[·]T表示矩阵转置;
由于***可观测,则可观测矩阵Mo列满秩,即其存在左伪逆矩阵
并且左伪逆矩阵满足
其中In×n为n维单位矩阵;
其中Q已知,R未知;
针对上述离散时间线性时不变***的模型,本方法包括如下步骤:
步骤一、利用观测序列{yk}构建新统计序列{ξk}:
步骤二、计算{ξk}的协方差矩阵递推公式:
使用上述的协方差矩阵递推公式计算新统计序列{ξk}的协方差矩阵实时估计值Covk(ξ),Cov(·)为·的协方差矩阵;
步骤三、利用观测噪声协方差矩阵与新统计序列协方差矩阵实时估计值Covk(ξ)之间的代数关系,计算观测噪声协方差矩阵估计序列{f(R)k}:
f(R)k=Covk(ξ)-F(Q)
其中
步骤四、通过f(R)和观测噪声协方差矩阵R的关系,计算出协方差矩阵的估计序列从观测噪声序列与f(v)之间的关系
获取f(R)与观测噪声协方差矩阵的代数关系,然后通过代数关系计算观测噪声协方差矩阵的实时估计
步骤五、将观测噪声的协方差矩阵估计序列替代真值代入标准卡尔曼滤波方法中,计算***实时的状态估计以及状态估计偏差的协方差矩阵。
有益效果:
本发明相对于标准卡尔曼滤波方法,减弱了对观测噪声协方差矩阵参数的要求,可以用来处理观测噪声协方差矩阵事先完全未知,但协方差矩阵为定常值情况下的***状态滤波估计问题。从本发明中的基本递推协方差矩阵估计方法可知,由于观测噪声的协方差矩阵的计算与***状态估计值无关,由大数定律可保证观测噪声的协方差矩阵的估计序列以概率1收敛于观测噪声协方差矩阵真值。在观测噪声协方差矩阵估计序列收敛于真值的前提下,结合卡尔曼滤波方法的黎卡提递推分析可以给出基于递推协方差矩阵估计卡尔曼滤波方法的闭环稳定性结果以保证满足假设的离散时间线性时不变***模型中,***状态估计序列和估计偏差协方差矩阵序列收敛于具有精确观测噪声协方差矩阵的标准卡尔曼滤波的状态估计序列和估计偏差协方差矩阵序列。
此外,从方法的实现可以看出基于递推协方差矩阵估计卡尔曼滤波方法形式简单,计算复杂度不高,易于计算机实现,利于工程实践***中应用和实现。
附图说明
图1为本发明一种带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法流程图。
具体实施方式
本发明针对离散时间线性时不变***模型,其***观测噪声协方差矩阵完全未知时,能够从***的观测序列中构建新的统计序列,利用基于大数定律设计的递推计算协方差矩阵估计方法实时计算新构建序列的协方差矩阵估计序列,通过构建序列的协方差矩阵与观测噪声的协方差矩阵的关系计算观测噪声协方差矩阵的估计序列,然后将观测噪声的协方差矩阵的实时估计值代替真实观测噪声协方差矩阵代入标准卡尔曼滤波方法递推计算***状态的实时估计和估计偏差的协方差矩阵。
下面结合附图并举实施例,对本发明进行详细描述。
本实施例中,为了便于描述基于递推协方差估计卡尔曼滤波方法,我们首先给出离散时间线性时不变***模型以及前提假设。
本方法针对的可控、可观测的离散时间线性时不变***状态空间模型为:
其中xk∈Rn×1为k时刻***状态,xk-1为k-1时刻的***状态,A为状态转移矩阵,wk-1为***过程噪声,C为观测矩阵,vk为***观测噪声,yk∈Rm×1为k时刻***观测;
其中A、C为常值矩阵且已知;其中由***观测yk组成的观测序列{yk}有界;***的过程噪声和观测噪声为不相关零均值高斯白噪声,其中观测噪声协方差矩阵为常值R、过程噪声协方差矩阵为常值矩阵Q;***可控、可观测;存在可观测矩阵
Mo=[C CA … CAn-1]T
其中[·]T表示矩阵转制;
由于***可观测,则可观测矩阵Mo列满秩,即其存在左伪逆矩阵
并且左伪逆矩阵满足
其中In×n为n维单位矩阵;
由于本发明是基于大数定律从观测序列中重构序列给出观测噪声协方差矩阵的估计序列,所以要求观测序列{yk}有界以满足滤波方法的收敛条件。
上述***的观测噪声和观测噪声为不相关零均值高斯白噪声,其中***过程噪声协方差矩阵为常值Q、精确已知,观测噪声协方差矩阵为常值矩阵R、事先完全未知。
针对上述观测噪声协方差矩阵完全未知的***,本发明的具体实施步骤如下:
步骤一、利用观测序列{yk}构建新统计序列{ξk}。
从式(1)可知,
=CAxk-1+Cwk-1+vk (2)
由于可观测矩阵存在左伪逆矩阵,从式(3)中可知,
将式(4)代入式(2)整理可得,
其中
利用观测序列重构新统计序列{ξk}的定义如下:
上述所重构的新统计序列{ξk},其期望E(ξk)=0,而且{ξk}与***的状态估计无关,即{ξk}不与***状态估计耦合,从而能够方便后续的数据处理。
步骤二、依据大数定律,设计递推协方差矩阵估计方法计算{ξk}协方差矩阵估计序列:
依据大数定律可知,对于随机变量φ∈Rm×1,且E(φ)=0,则随机变量φ的协方差矩阵可以通过下式求取:
其中E(·)表示随机变量的数学期望,Cov(·)表示随机变量的协方差矩阵,Rm×1表示m维实数空间。φi为随机变量φ的取值,Covn(·)则表示随机变量φ的取值序列{φn}的协方差矩阵。
但是这种协方差矩阵计算方法适用于获取全部采样数据后数据处理过程,不能满足在线实时计算随机变量ξ的协方差矩阵估计序列,为了满足实时性要求需要对式(7)改进成为递推计算形式。
零均值新统计序列{ξk}的协方差矩阵Covk(ξ)的递推公式为:
式(8)是一种递推递推求解随机变量ξ的协方差矩阵实时估计值的公式,通过式(6)和式(8)可以得到随机变量协方差矩阵实时估计值Covk(ξ)。
步骤三、利用观测噪声协方差矩阵与新统计序列协方差矩阵实时估计值Covk(ξ)之间的代数关系,计算观测噪声协方差矩阵估计序列{f(R)k};
本发明的核心部分是处理观测噪声协方差矩阵事先完全未知情况下的***滤波估计问题。在上两步中利用观测序列和***参数构建了一个新的统计序列,并且通过基本的递推协方差矩阵估计方法得到序列的协方差矩阵估计序列,本步骤是在前两步的基础上给出观测噪声协方差矩阵实时估计方法。
从式(5)可得
f(R)=Cov(ξ)-F(Q) (9)
由于***过程噪声的协方差矩阵Q精确已知,可得
由步骤二的处理过程可以获得随机变量ξ的协方差矩阵的实时估计值Covk(ξ)。从式(9)可得观测噪声构造新序列的协方差矩阵实时估计值f(R)k:
f(R)k=Covk(ξ)-Cov(V) (10)
通过式(10)可以从步骤二的随机变量ξk的协方差估计值Covk(ξ)中得到观测噪声重构序列的协方差矩阵的实时估计序列{f(R)k}。
步骤四、通过f(R)和观测噪声协方差矩阵R的关系,计算出协方差矩阵的估计序列
从观测噪声序列与f(v)之间的关系
可以获取f(R)与观测噪声协方差矩阵的代数关系,然后通过代数关系计算观测噪声协方差矩阵的实时估计
步骤五、利用观测噪声的协方差矩阵估计序列作为参数代入标准卡尔曼滤波方法中,计算***实时的状态估计以及状态估计偏差的协方差矩阵。
观测噪声协方差矩阵是标准卡尔曼滤波方法的一项重要参数,若无法获得精确地观测噪声协方差矩阵则标准卡尔曼滤波方法不能正常工作。本发明所处理的问题是观测噪声协方差矩阵事先完全未知情况下的***状态滤波估计问题,通过上述四个步骤可以获得实时的观测噪声协方差矩阵的估计序列然后可将估计序列替代真值代入标准卡尔曼滤波方法中获得实时的状态估计及估计偏差的协方差矩阵。其处理过程与标准卡尔曼滤波方法类似,可以分为:时间更新和观测更新两部分。
时间更新:
观测更新:
其中为k时刻***状态预估值,Pk,k-1为其协方差矩阵;为k时刻状态估计值,Pk为k时刻状态估计偏差的协方差矩阵;Kk为卡尔曼滤波增益。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法,该方法所针对的离散时间线性时不变***模型为:
其中xk∈Rn×1为k时刻***状态,xk-1为k-1时刻的***状态,A为状态转移矩阵,wk-1为***过程噪声,C为观测矩阵,vk为***观测噪声,yk∈Rm×1为k时刻***观测;
其中A、C为常值矩阵且已知;其中由***观测yk组成的观测序列{yk}有界;***的过程噪声和观测噪声为不相关零均值高斯白噪声,其中观测噪声协方差矩阵为常值R、过程噪声协方差矩阵为常值矩阵Q;存在可观测矩阵
Mo=[C CA … CAn-1]T
其中[·]T表示矩阵转置;
由于***可观测,则可观测矩阵Mo列满秩,即其存在左伪逆矩阵
并且左伪逆矩阵满足
其中In×n为n维单位矩阵;
其中Q已知,R未知;
针对上述离散时间线性时不变***的模型,其特征在于,包括如下步骤:
步骤一、利用观测序列{yk}构建新统计序列{ξk}:
步骤二、计算{ξk}的协方差矩阵递推公式:
使用上述的协方差矩阵递推公式计算新统计序列{ξk}的协方差矩阵实时估计值Covk(ξ),Cov(·)为·的协方差矩阵;
步骤三、利用观测噪声协方差矩阵与新统计序列协方差矩阵实时估计值Covk(ξ)之间的代数关系,计算观测噪声协方差矩阵估计序列{f(R)k}:
f(R)k=Covk(ξ)-F(Q)
其中
步骤四、通过f(R)和观测噪声协方差矩阵R的关系,计算出协方差矩阵的估计序列从观测噪声序列与f(v)之间的关系
获取f(R)与观测噪声协方差矩阵的代数关系,然后通过代数关系计算观测噪声协方差矩阵的实时估计
步骤五、将观测噪声的协方差矩阵估计序列替代真值代入标准卡尔曼滤波方法中,计算***实时的状态估计以及状态估计偏差的协方差矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410422530.5A CN104168005B (zh) | 2014-08-25 | 带有未知观测噪声协方差矩阵递推估计的卡尔曼滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410422530.5A CN104168005B (zh) | 2014-08-25 | 带有未知观测噪声协方差矩阵递推估计的卡尔曼滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104168005A true CN104168005A (zh) | 2014-11-26 |
CN104168005B CN104168005B (zh) | 2017-01-04 |
Family
ID=
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105656453A (zh) * | 2016-01-06 | 2016-06-08 | 东南大学 | 一种基于时间序列的光纤电流互感器随机噪声实时滤波方法 |
CN105866504A (zh) * | 2016-03-23 | 2016-08-17 | 东南大学 | 一种基于卡尔曼滤波的光纤电流互感器温度补偿方法 |
CN106487358A (zh) * | 2016-09-30 | 2017-03-08 | 西南大学 | 一种基于统计线性回归的最大相关熵容积卡尔曼滤波方法 |
CN109033017A (zh) * | 2018-05-25 | 2018-12-18 | 浙江工业大学 | 一种丢包环境下的车辆侧倾角与俯仰角估计方法 |
CN110865334A (zh) * | 2019-11-26 | 2020-03-06 | 北京航空航天大学 | 一种基于噪声统计特性的多传感器目标跟踪方法及*** |
CN112491393A (zh) * | 2020-11-30 | 2021-03-12 | 长沙师范学院 | 一种基于观测噪声协方差矩阵未知的线性滤波方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080227400A1 (en) * | 2005-08-26 | 2008-09-18 | Telefonaktiebolaget Lm Ericsson (Publ) | Methods And Arrangements For Noise Rise Estimation |
CN102788976A (zh) * | 2012-06-27 | 2012-11-21 | 北京理工大学 | 高量级扩展卡尔曼滤波方法 |
CN103296995A (zh) * | 2013-06-01 | 2013-09-11 | 中国人民解放军电子工程学院 | 任意维高阶(≥4阶)无味变换与无味卡尔曼滤波方法 |
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080227400A1 (en) * | 2005-08-26 | 2008-09-18 | Telefonaktiebolaget Lm Ericsson (Publ) | Methods And Arrangements For Noise Rise Estimation |
CN102788976A (zh) * | 2012-06-27 | 2012-11-21 | 北京理工大学 | 高量级扩展卡尔曼滤波方法 |
CN103296995A (zh) * | 2013-06-01 | 2013-09-11 | 中国人民解放军电子工程学院 | 任意维高阶(≥4阶)无味变换与无味卡尔曼滤波方法 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105656453A (zh) * | 2016-01-06 | 2016-06-08 | 东南大学 | 一种基于时间序列的光纤电流互感器随机噪声实时滤波方法 |
CN105656453B (zh) * | 2016-01-06 | 2018-09-21 | 东南大学 | 一种基于时间序列的光纤电流互感器随机噪声实时滤波方法 |
CN105866504A (zh) * | 2016-03-23 | 2016-08-17 | 东南大学 | 一种基于卡尔曼滤波的光纤电流互感器温度补偿方法 |
CN105866504B (zh) * | 2016-03-23 | 2018-07-17 | 东南大学 | 一种基于卡尔曼滤波的光纤电流互感器温度补偿方法 |
CN106487358A (zh) * | 2016-09-30 | 2017-03-08 | 西南大学 | 一种基于统计线性回归的最大相关熵容积卡尔曼滤波方法 |
CN106487358B (zh) * | 2016-09-30 | 2019-05-10 | 西南大学 | 一种机动目标转弯跟踪方法 |
CN109033017A (zh) * | 2018-05-25 | 2018-12-18 | 浙江工业大学 | 一种丢包环境下的车辆侧倾角与俯仰角估计方法 |
CN109033017B (zh) * | 2018-05-25 | 2022-05-13 | 浙江工业大学 | 一种丢包环境下的车辆侧倾角与俯仰角估计方法 |
CN110865334A (zh) * | 2019-11-26 | 2020-03-06 | 北京航空航天大学 | 一种基于噪声统计特性的多传感器目标跟踪方法及*** |
CN110865334B (zh) * | 2019-11-26 | 2021-09-03 | 北京航空航天大学 | 一种基于噪声统计特性的多传感器目标跟踪方法及*** |
CN112491393A (zh) * | 2020-11-30 | 2021-03-12 | 长沙师范学院 | 一种基于观测噪声协方差矩阵未知的线性滤波方法 |
CN112491393B (zh) * | 2020-11-30 | 2024-05-10 | 长沙师范学院 | 一种基于观测噪声协方差矩阵未知的线性滤波方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20150302313A1 (en) | Method of predicating ultra-short-term wind power based on self-learning composite data source | |
Tornil-Sin et al. | Robust fault diagnosis of nonlinear systems using interval constraint satisfaction and analytical redundancy relations | |
CN104914775B (zh) | 基于vine copula相关性描述的多模态过程故障检测方法及*** | |
Zhang | Time series: Autoregressive models ar, ma, arma, arima | |
CN103684349A (zh) | 一种基于递推协方差阵估计的卡尔曼滤波方法 | |
CN105117550A (zh) | 一种面向产品多维相关性退化失效的建模方法 | |
CN105043384A (zh) | 一种基于鲁棒Kalman滤波的陀螺随机噪声ARMA模型建模方法 | |
JP2014215822A (ja) | 状態推定装置、方法、及びプログラム | |
Koul et al. | The transfer principle: a tool for complete case analysis | |
Lederer et al. | Uniform error and posterior variance bounds for Gaussian process regression with application to safe control | |
CN104283529B (zh) | 未知测量噪声方差的平方根高阶容积卡尔曼滤波方法 | |
CN104202019A (zh) | 带有未知过程噪声协方差阵递推估计的卡尔曼滤波方法 | |
CN116361616A (zh) | 一种鲁棒卡尔曼滤波方法 | |
JP2014041565A (ja) | 時系列データ解析装置、方法、及びプログラム | |
Kulikov et al. | State estimation in chemical systems with infrequent measurements | |
Yu | A novel semiparametric hidden Markov model for process failure mode identification | |
CN104168005A (zh) | 带有未知观测噪声协方差阵递推估计的卡尔曼滤波方法 | |
Chaudhry et al. | Uncertainty assessment and false discovery rate control in high-dimensional Granger causal inference | |
Carton et al. | Using penalized spline regression to calculate mean trajectories including confidence intervals of human motion data | |
CN104168005B (zh) | 带有未知观测噪声协方差矩阵递推估计的卡尔曼滤波方法 | |
Zhao et al. | A unified framework for fault detection and diagnosis using particle filter | |
Luz et al. | Robust filtering of sequences with periodically stationary multiplicative seasonal increments | |
Grover et al. | Chirp-like model and its parameters estimation | |
Stepanov et al. | Cramer-rao lower bound for a nonlinear filtering problem with multiplicative measurement errors and forcing noise | |
Komatsu et al. | Assessing statistical reliability of LiNGAM via multiscale bootstrap |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |