《扩展卡尔曼滤波和粒子滤波算法比较》由会员分享，可在线阅读，更多相关《扩展卡尔曼滤波和粒子滤波算法比较（8页珍藏版）》请在金锄头文库上搜索。
1、上海大学20132014学年秋季学期研究生课程小论文课程名称：随机信号导论课程编号：07SB17002论文题目：扩展卡尔曼滤波和粒子滤波算法比较研究生姓名：班孝坤(33%学号:13720843研究生姓名：倪晴燕(34%学号：13720842研究生姓名：许成(33%学号：13720840论文评语:成绩： 任课教师：刘凯评阅日期：扩展卡尔曼滤波和粒子滤波算法比较第一章绪论在各种非线性滤波技术中，扩展卡尔曼滤波是一种最简单的算法，它将卡尔 曼滤波局部线性化，适用于弱非线性、高斯环境下。卡尔曼滤波用一系列确定样 本来逼近状态的后验概率密度，适用于高斯环境下的任何非线性系统。 粒子滤波 用随机样本来近似
2、状态的后验概率密度，适用于任何非线性非高斯环境，但有时 选择的重要性分布函数与真实后验有较大差异，从而导致滤波结果存在较大误 差，而粒子滤波正好克服了这一不足，它先通过UKF产生重要性分布，再运用 PF算法。通过仿真实验，对其的性能进行比较。严格说来，所有的系统都是非线性的，其中许多还是强非线性的。因此,非线性 系统估计问题广泛存在于飞行器导航、目标跟踪及工业控制等领域中 ，具有重要 的理论意义和广阔的应用前景。系统的非线性往往成为困扰得到最优估计的重要因素， 为此，人们提出了大 量次优的近似估计方法。包括 EKF,基于UT变换的卡尔曼滤波（UKF），粒子滤 波，等等。第二章扩展卡尔曼滤波介绍
3、2.1扩展卡尔曼滤波的理论（EKF）设非线性状态空间模型为：Xt = f （Xtj,Vt（1） yt=h（xt,m）（2）式中x R和y R分别表示在t时刻系统的状态和观测，vR和nr 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所示时间更新（预测）（1 ）向前推算状态变量（2）向前推算误差协方差测量更新（校正）计算卡尔曼增益（2）由观测变量勺更新估计（3）更新误差协方差图2.12.3扩展卡尔曼滤波的缺点因为EKF忽略了非线性函数泰勒展开的高阶项，仅仅用了一阶项，是非线 性函数在局部线性化的结果，这就给估计带来了很大误差，所以只有当系统的状 态方程和观测方程都接近线性且连续时,EKF的滤波结果才有可能接近真实值。EKF滤波结果的好坏还与状态噪声和观测噪声的统计特性有关，在EKF的递推滤波过程
5、中，状态噪声和观测噪声的协方差矩阵保持不变，如果这两个噪声 协方差矩阵估计的不够准确，那就容易产生误差累计，导致滤波器发散。EKF的 另外一个缺点是初始状态不太好确定，如果假设的初始状态和初始协方差误差 较大，也容易导致滤波器发散。第三章粒子滤波介绍3.1粒子滤波的理论粒子滤波利用一系列带权值的空间随机采样的粒子来逼近后验概率密度函 数，是一种基于Monte Carlo的贝叶斯估计方法，因此它就独立于系统的模型， 不受线性化误差或高斯噪声假定的限制，既可以解决EKF因线性化带来的误差，也可以避免UKF因非高斯的PDF导致的误差，适用于任何环境下的任何状态和 量测模型。3.2粒子滤波的算法粒子滤
6、波算法的基本步骤如下：(1) 从先验分布p(x)中采集样本z，i 一 1, ?，N 0i(2) t时刻，从参考分布q(Xi,Xi丄Zk)中采集样本xt，并计算归一化后的权Wti i p(yt |x；)p(x； |x；)wt =wt一 i 一 一q(xt | Xt)ii wtNWt iwtj吕(3) 进行重采样：用新的采样值代替，去除低权值的粒子，复制高权值的粒 子。1 N(4) 输出 PDF: pdtlyj 歸一送务(治-X；)N g粒子滤波的两个关键问题是参考分布的选择和 q(xk XkzJ重采样。3.3粒子滤波的缺点粒子滤波对状态估计的好坏，在很大程度上取决于所选的参考分布与状 态后验概率
7、分布的接近程度。因此，最优的参考分布为q(xk xkj,zk)p(xlz卜，) 但实际工程应用中，很难对其采样。第五章实验仿真分析为了在同种条件下比较粒子滤波和扩展卡尔曼算法性能，我们在这里共做了 三组实验，并设状态模型：x = 0.5 * x + 25 * x / (1 + xA2) + 8 * cos(1.2*(k-1) + w( t)观测方程：y = xA2 / 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
8、=10,R=10。仿真一次后，两种滤波器的估计结果的比较。Q=0.1, R=0.1：Q=1，R=1：图5-3 EKF的估计值和真值图5-4粒子滤波的估计值和真值Q=10, R=10图5-5 EKF的估计值和真值图5-6粒子滤波的估计值和真值通过比较发现，EKF是通过线性化处理来实现非线性滤波估计，而 PF是利 用样本来逼近状态的 PDF。在计算速度上，EKF具有明显的优势，但它的性能 随着非线性强度变大而明显下降。但是，EKF是用高斯分布来逼近系统状态的后验概率密度。如果系统状态的后验概率密度是非高斯的，那么将产生极大的误 差。PF因采用随机样本集则可以用在任何复杂环境下，但此时的计算量却远远 超过EKF。所以，应该根据实际工程的需要来选择合适的滤波器。显然，若无 需考虑系统的非线性强度和非高斯环境，则优先采用EKF，而随着计算机计算能力的不断提高，在复杂的非线性非高斯环境中，PF将是最优的选择。
