卡尔曼滤波器的设计及应用研究.docx

卡尔曼滤波器的设计及应用研究.docx

《卡尔曼滤波器的设计及应用研究.docx》由会员分享，可在线阅读，更多相关《卡尔曼滤波器的设计及应用研究.docx（8页珍藏版）》请在冰豆网上搜索。

卡尔曼滤波器的设计及应用研究

卡尔曼滤波器的设计及应用研究

摘要：

卡尔曼滤波器（KalmanFilter，KF）是一种递归的估计，即已知上一时刻状态的估计值以及当前状态的观测值就可以计算出当前状态的估计值，它提供了一种高效可计算的方法来估计过程的状态，并使估计均方差最小。

卡尔曼滤波器应用广泛且功能强大。

无际卡尔曼滤波（UnscentedKalmanFilter，UKF）是近期发展起来的新型非线性滤波方法，它没有非线性近似为线性化的过程，能有效减少线性化误差对系统的影响。

随着机电系统对于可靠性和安全性要求的不断提高，故障检测技术发挥着越来越重要的作用，非线性滤波方法是解决非线性故障检测问题的重要技术途径之一。

针对线性化对非线性系统故障检测准确率的影响，本文研究了基于UKF的故障决策方法。

本文分析了目前应用比较广泛的经典KF、UKF滤波方法，讨论了滤波算法建立的理论基础，理论上对各个滤波算法性能进行比较。

关键词：

卡尔曼滤波器；非线性系统；无际卡尔曼滤波器；故障检测

第一章绪论1

1.1几种滤波器性能分析1

1.1.1卡尔曼滤波器（KF）性能分析1

1.1.2扩展卡尔曼滤波器（EKF）性能分析1

1.1.3无际卡尔曼滤波器（UKF）性能分析1

第2章卡尔曼滤波器（KF）1

2.1卡尔曼滤波器（KF）原理1

2.1.1离散时间系统2

2.1.2卡尔曼滤波器（KF）基本动态模型3

第3章无际卡尔曼滤波器（UKF）的研究6

3.1无际卡尔曼滤波器（UKF）原理6

3.1.1非线性状态估计原理6

3.1.2无际变换的基本原理7

结论10

参考文献11

第一章绪论

1.1几种滤波器性能分析

1.1.1卡尔曼滤波器（KF）性能分析

卡尔曼滤波算法有如下鲜明的特征：

由此可见卡尔曼滤波器的应用范围非常广泛。

求解中数据的存储量小，因此卡尔曼滤波算法便于计算机的实现。

1.1.2扩展卡尔曼滤波器（EKF）性能分析

扩展卡尔曼滤波器（EKF）于20世纪60年代提出，是一种历史悠久、应用最为广泛的非线性高斯次优滤波算法，其核心思想就是以卡尔曼滤波算法做为滤波器的基本理论框架，通过对非线性函数泰勒展开式进行一阶线性化截断来达到对非线性状态后验均值和协方差的近似。

1.1.3无际卡尔曼滤波器（UKF）性能分析

Unscented卡尔曼滤波（UKF）是由Julier所提出的一种新型的非线性滤波算法，由于UKF可以有效克服EKF滤波精度偏低及需要计算雅克比矩阵的局限性，故其在SINS/GPS组合导航系统非线性状态估计、惯性导航初始对准、机动目标跟踪等各个领域已获得广泛的应用。

第2章卡尔曼滤波器（KF）

2.1卡尔曼滤波器（KF）原理

卡尔曼滤波是基于状态空间方法的一套递推滤波算法，在状态空间方法中，引入了状态变量的概念。

实际应用中，可以通过选取合适的状态变量来体现系统的特征、特点和状况的变化。

卡尔曼滤波的模型包括状态空间模型和观测模型。

状态模型是反映状态变化规律的模型，通过状态方程来描写相邻时刻的状态转移变化规律；观测模型反映了实际观测量与状态变量之间的关系。

Kalman滤波问题就是联合观测信息及状态转移规律来得到系统状态的最优估计。

2.1.1离散时间系统

一个拥有输入向量（或激励向量）和输出向量的离散时间线性系统可以通过如图2-1所示的框图表示。

这个系统可以根据状态方程和观测方程这二个方程进行进一步的内部描述，即状态方程：

（2.1）

观测方程：

（2.2）

其中，称为k时刻的状态向量，是一个n×1维的向量，为从k时刻到k+1时刻的状态转移矩阵，是一个n×n维的矩阵；为从k时刻到k+1时刻的激励转移矩阵，是一个n×p维的矩阵；为k时刻的激励向量，是一个p×1维的向量；x（0）为k=0时刻的初始条件或者初始状态向量，是一个n×1维的向量；H（k）为k时刻的输出转移矩阵，是一个m×n维矩阵；y（k+1）为k+1时刻的输出向量，是一个m×1维矩阵。

图2-1给出了计算系统k+1时刻状态的递归形式，它是系统化在k时刻的状态和激励的向量函数。

一般离散系统都可以用上述方程和框图表示，卡尔曼滤波器用于处理离散问题亦基于此。

2.1.2卡尔曼滤波器（KF）基本动态模型

卡尔曼滤波建立在线性代数和隐马尔可夫模型（HiddenMarkovModel）上。

其基本动态系统可以用一个马尔可夫链表示，该马尔可夫链建立在一个被高斯噪声干扰的线性算子上的。

系统的状态可以用一个元素为实数的向量表示。

随着离散时间的每一个增加，这个算子就会作用在当前状态上，产生一个新的状态，并也会带入一些噪声，同时系统的一些已知的控制信息也会被加入。

同时，另一个受噪声干扰的线性算子产生出这些隐含状态的可见输出。

为了从一系列有噪声的观察数据中用卡尔曼滤波器估计出被观察过程的内部状态，我们必须把这个过程在卡尔曼滤波的框架下建立模型。

卡尔曼滤波模型假设k时刻的真实状态是从（k-1）时刻的状态演化而来，符合下式：

（2.3）

其中：

1．F是作用在k-1时刻的状态转移矩阵。

（实际中F可能随时间变化，但在这儿假

设为常数。

）

2．B是作用在控制向量上的输入——控制向量

3．是过程噪声，并假设其符合均值为零，协方差矩阵为Q的正态分布，

P（）~N（0，Q）（2.4）

在k时刻，对真实状态的一个测量值满足下式：

（2.5）

其中

1．H是观测矩阵，它把真实状态空间映射成观测空间。

（实际中H可能随时间变

化，但在这儿假设为常数。

）

2．是观测噪声，并符合均值为零，协方差矩阵为R的正态分布，

（2.6）

实际上，很多真实世界的动态系统都并不确切符合这个模型；但是由于卡尔曼滤波器被设计在有噪声的情况下工作，一个近似的符合已经可以是这个滤波器非常有用了。

第3章无际卡尔曼滤波器（UKF）的研究

3.1无际卡尔曼滤波器（UKF）原理

和EKF一样，UKF也是一种递归式贝叶斯估计方法，它利用UT变换（UnscentedTransform）方法，用一组确定的取样点来近似后验概率。

但是UKF不必线性化非线性状态方程和观测方程，它直接利用非线性状态方程来估算状态向量的概率密度函数（pdf）。

UKF规定一组确定的取样点，当状态向量的概率密度函数是高斯型的，利用这组取样点能获取高斯密度函数的均值和协方差。

当高斯型状态向量经由非线性系统进行传递时，对任何一种非线性系统，利用这组取样点能获取精确到三阶矩的后验均值和协方差。

3.1.1非线性状态估计原理

1.非线性系统状态估计一般描述

状态方程和观测方程可表示为：

（3.1）

（3.2）

式中，为状态量，为观测量，为系统输入，为系统噪声，且，为观测噪声，且，和相互独立且与系统状态x无关。

不管条件密度函数的特征如何，最小均方估计就是条件均值。

非线性状态滤波过程的实现包括一步预测与测量修正两个阶段。

预测阶段：

根据所有过去时刻的测量信息对状态作最小方差估计

（3.3）

状态估计质量的优劣利用预测误差协方差矩阵描述

（3.4）

修正阶段：

获得当前时刻的测量信息后，对状态预测估值进行修正，得到状态的最优估计值

（3.5）

其中，、分别为估计值和观测值的最优预测，为滤波增益，反映了新息对估计的重要程度。

（3.6）

（3.7）

（3.8）

（3.9）

描述最优状态估计值优劣的误差协方差阵确定如下：

（3.10）

3.1.2无际变换的基本原理

UT变换的主要思想是“近似概率分布比近似非线性函数更容易”，它采用确定的点集S（又称为Sigma点）来表征输入分布（或部分统计特征），然后对每个Sigma点分别进行非线性变换，通过加权计算捕捉到变换后的统计特性。

这种方法把系统当作“黑盒”来处理，因而不依赖于具体的非线性，也不必计算雅可比矩阵。

UT算法的关键是Sigma点采样策略，也就是Sigma点的个数、位置以及相应权值的确定方法，保证在抓住输入变量x的分布特征的同时，使得逼近输出某些性能指标的代价函数达到最小。

Unscented变换过程需要以下几步：

第一步，构造Sigma点

根据随机向量x的统计量和，采用对称采样策略，产生2n+1个列向量Sigma点集：

（3.11）

其中，n为输入状态的维数，k为尺度参数，，调整它可以提高逼近精度。

为第二个尺度参数，通常设置为0或。

用这组采样点可以近似表示状态x的高斯分布。

第二步，对Sigma点进行非线性变换

对所构造的点集{}进行非线性变换，得到变换后的Sigma点集

（3.12）

变换后的Sigma点集即可近似地表示的分布。

第三步，计算y的均值和方差

对变换后的Sigma点集进行加权处理，从而得到输出量y的均值和方差

（3.13）

（3.14）

和分别为计算y的均值和方差所用加权

（3.15）

（3.16）

（3.17）

在均值和方差加权中需要确定、和共3和参数，它们的取值范围分别为：

确定周围Sigma点的分布程度，通常设为一个较小的正数

为状态分布参数，对于高斯分布是最优的，如果状态变量是单变量，则最

佳的选择是。

适当调节、可以提高估计均值的精度；调节可以提高方差精度。

无际变换的特点：

（1）对非线性函数的概率密度分布进行近似，而不是对非线性函数进行近似，即使

系统的模型复杂，也不增加算法实现的难度;

（2）所得到的非线性函数的统计量的准确性可以达到三阶（泰勒展开）;

（3）不需要计算Jacobi矩阵，可以处理不可导非线性函数。

结论

本文研究了经典的卡尔曼滤波器和基于Unscented变换的卡尔曼滤波器，重点讨论了卡尔曼滤波器的基本原理和算法。

在线性和非线性系统中分别对经典卡尔曼滤波和无际卡尔曼滤波进行仿真，证明了卡尔曼滤波器在预测估计中的有效性。

在卡尔曼滤波器的设计中，引入Unscented变换，将输入矢量的统计特性通过非线性系统传播，较好克服了传统的扩展卡尔曼滤波器在通过非线性系统时，由线性化引起的较大截断误差，并且无需求解雅可比矩阵。

通过在故障检测中的预测分析后，证明了Unscented卡尔曼滤波器具有良好的性能。

总之，我们可以乐观地预测，在未来的发展中，基于UKF滤波算法的应用将在非线性预测和估计领域大有作为。

参考文献

[1]胡广书.数字信号处理-理论算法与实现.北京：

清华大学出版社，2003.5~30

[2]（美）普埃克.数字信号处理--第四版.北京：

电子工业出版社，2007-6.38~64

[3]刘树堂.信号与系统（第二版）.西安：

西安交通大学出版社，1998-03.145~189

[4]陈怀琛.MATLAB及在电子信息课程中的应用（第3版）.北京：

电子工业出版社，2002.20~78

[5]周东华.控制系统的故障检测与诊断技术.北京：

清华大学出版社，1994.77~109

[6]温显斌.多尺度随机模型及其应用.北京：

科学出版社，2010.

[7]伍锡锈.动态变形监测中的Kalman滤波方法研究.学位论文，中南大学,2011.8~19

[8]邢喆.基于Unscented变换的Kalman滤波算法在非线性系统中的研究与仿真.学位论文，天津大学，2005.11~34

[9]安笛.UKF性能分析及其在组合导航中的应用.学位论文，哈尔滨工程大学，2011.7~15

[10]柴霖，袁建平.非线性估计理论的最新发展.宇航学报，西北工业大学航天学院，2005.380~383