扩展卡尔曼滤波和粒子滤波算法比较

1、上海大学20132014学年秋季学期研究生课程小论文课程名称：随机信号导论课程编号:07SB17002论文题目:扩展卡尔曼滤波和粒子滤波算法比较研究生姓名：班孝坤(33%学 号：13720843研究生姓名：倪晴燕(34%学号:13720842研究生姓名：许成(33%学 号：13720840论文评语:成绩：任课教师：刘凯评阅日期：_扩展卡尔曼滤波和粒子滤波算法比较第一章绪论在各种非线性滤波技术中，扩展卡尔曼滤波是一种最简单的算法，它将卡尔 曼滤波局部线性化，适用丁弱非线性、高斯环境下。卡尔曼滤波用一系歹0确定样 本来逼近状态的后验概率密度,适用丁高斯环境下的任何非线性系统。 粒子滤波 用随机样本

2、来近似状态的后验概率密度，适用丁任何非线性非高斯环境，但有时 选择的重要性分布函数与真实后验有较大差异,从而导致滤波结果存在较大误 差，而粒子滤波正好克服了这一不足，它先通过UKF产生重要性分布，再运用PF算法。通过仿真实验，对其的性能进行比较。严格说来， 所有的系统都是非线性的， 其中许多还是强非线性的。 因此,非线性 系统估计问题广泛存在丁飞行器导航、目标跟踪及工业控制等领域中 ，具有重要 的理论意义和广阔的应用前景。系统的非线性往往成为困扰得到最优估计的重要因素，为此，人们提出了大量次优的近似估计方法。包括EKF，基丁UT变换的卡尔曼滤波（UKF）,粒子滤 波，等等。第二章扩展卡尔曼滤波

3、介绍2.1扩展卡尔曼滤波的理论（EKF）设非线性状态空间模型为：Xt= f （X，Vt）（1） yt=h（xt,n）（2）式中Xt W R和ytW R分别表示在t时刻系统的状态和观测，Vtw R和ntw R分别表示过程噪声和观测噪声，f和h表示非线性函数。扩展卡尔曼滤波（Extended kalman filter,以下简称EKF）是传统非线性估计的 代表，其基本思想是围绕状态估值对非线性模型进行一阶Taylor展开，然后应用线 性系统Kalman滤波公式。EKF是用泰勒展开式中的一次项来对式（1）和（2 ）中的非线性函数f和h进行线性化处理，即先计算f和h的雅克比矩阵，然后再在标准卡尔曼滤波

4、框架 下进行递归滤波。vt和nt均为零均值的高斯白噪声。2.2扩展卡尔曼滤波的算法EKF的算法同KF一样，也可分为两步预测和更新。如图2.1所示交交- -和为初始估计和为初始估计图2.12.3扩展卡尔曼滤波的缺点时时间更新（预测）间更新（预测）（1 ）向前推算状态变量向前推算状态变量（2）向前推算误差协方向前推算误差协方测测量更新（量更新（校正校正）（1）计算卡尔曼增益计算卡尔曼增益（2）由观测变量瓦更新估由观测变量瓦更新估计计艾艾上上= =艾艾上上+KjEkh（史（史（3）更更新误差协方差新误差协方差因为EKF忽略了非线性函数泰勒展开的高阶项，仅仅用了一阶项，是非线 性函数在局部线性化的结果

5、，这就给估计带来了很大误差，所以只有当系统的状 态方程和观测方程都接近线性且连续时,EKF的滤波结果才有可能接近真实值。EKF滤波结果的好坏还与状态噪声和观测噪声的统计特性有关,在EKF的递推滤波过程中，状态噪声和观测噪声的协方差矩阵保持不变,如果这两个噪声 协方差矩阵估计的不够准确，那就容易产生误差累计，导致滤波器发散。EKF的 另外一个缺点是初始状态不太好确定，如果假设的初始状态和初始协方差误差 较大，也容易导致滤波器发散。第三章粒子滤波介绍3.1粒子滤波的理论粒子滤波利用一系列带权值的空间随机采样的粒子来逼近后验概率密度函 数，是一种基丁Monte Carlo的贝叶斯估计方法，因此它就独

6、立丁系统的模型， 不受线性化误差或高斯噪声假定的限制，既可以解决EKF因线性化带来的误差，也可以避免UKF因非高斯的PDF导致的误差，适用丁任何环境下的任何状态和 量测模型。3.2粒子滤波的算法粒子滤波算法的基本步骤如下：(1)从先验分布p(x)中采集样本z , i 1, ?, N。(2)t时刻，从参考分布qMxzQ中采集样本xt ,并计算归一化后的权Wti ip(yt|xt)p(xt|乂)W=Wt_1i i- -q(xt| xt，yt)iwt-NWt w iwtj w(3)进行重采样：用新的采样值代替，去除低权值的粒子，复制高权值的粒 子。1一Ni(4)车刖出PDF: p(xt|y1t) &

7、amp;(xtxt)Njd粒子滤波的两个关键问题是参考分布的选择和q(xkxka, 4)重采样。3.3粒子滤波的缺点粒子滤波对状态估计的好坏，在很大程度上取决丁所选的参考分布与状 态后验概率分布的接近程度。因此，最优的参考分布为q(xkxka,zk)p(x I z卜,)但实际工程应用中，彳艮难对其采样。图5-1Q=1,EKF的估计值和真值R=1：第五章实验仿真分析为了在同种条件下比较粒子滤波和扩展卡尔曼算法性能，我们在这里共做了 三组实验，并设状态模型：x = 0.5 * x + 25 * x / (1 + xA2) + 8 * cos(1.2*(k-1) + w观测方程：y = xA2 /

8、20 +v (t)w(t)、v (t)均服从高斯分布N (0,1)其中x=0.1，粒子滤波的粒子数为N = 100独立仿真次数为tf = 50分别选取控制噪声方差Q=0.1，观测噪声方差R=0.1; Q=1, R=1; Q=10, R=10。仿真一次后，两种滤波器的估计结果的比较。Q=0.1, R=0.1:(t)图5-2粒子滤波的估计值和真值图5-3EKF的估计值和真值图5-4粒子滤波的估计值和真值图5-5 EKF的估计值和真值图5-6粒子滤波的估计值和真值通过比较发现,EKF是通过线性化处理来实现非线性滤波估计，而PF是利 用样本来逼近状态的PDF。在计算速度上，EKF具有明显的优势，但它的性能 随着非线性强度变大而明显下降。但是，EKF是用高斯分布来逼近系统状态的后验概率密度。如果系统状态的后验概率密度是非高斯的，那么将产生极大的误 差。PF因采用随机样本集则可以用在任