文档介绍：Forpersonaluseonlyinstudyandresearch;mercialuse腿上海大学2013~2014学年秋季学期袆研究生课程小论文螁螀羇羄蒄课程名称:随机信号导论课程编号:07SB17002蒀羈论文题目:扩展卡尔曼滤波和粒子滤波算法比较莇袃研究生姓名:班孝坤(33%)学号:13720843芀研究生姓名:倪晴燕(34%)学号:13720842螅研究生姓名:许成(33%)学号:13720840蒅芃论文评语:羁袇薃成绩:任课教师:刘凯螂评阅日期:螁扩展卡尔曼滤波和粒子滤波算法比较羈第一章绪论羆在各种非线性滤波技术中,扩展卡尔曼滤波是一种最简单的算法,它将卡尔曼滤波局部线性化,适用于弱非线性、高斯环境下。卡尔曼滤波用一系列确定样本来逼近状态的后验概率密度,适用于高斯环境下的任何非线性系统。粒子滤波用随机样本来近似状态的后验概率密度,适用于任何非线性非高斯环境,但有时选择的重要性分布函数与真实后验有较大差异,从而导致滤波结果存在较大误差,而粒子滤波正好克服了这一不足,它先通过UKF产生重要性分布,再运用PF算法。通过仿真实验,对其的性能进行比较。膁严格说来,所有的系统都是非线性的,其中许多还是强非线性的。因此,非线性系统估计问题广泛存在于飞行器导航、目标跟踪及工业控制等领域中,具有重要的理论意义和广阔的应用前景。蒁系统的非线性往往成为困扰得到最优估计的重要因素,为此,人们提出了大量次优的近似估计方法。包括EKF,基于UT变换的卡尔曼滤波(UKF),粒子滤波,等等。(EKF)蚇设非线性状态空间模型为:肆 薂式中和分别表示在t时刻系统的状态和观测,和分别表示过程噪声和观测噪声,f和h表示非线性函数。罿扩展卡尔曼滤波(Extendedkalmanfilter,以下简称EKF)是传统非线性估计的代表,其基本思想是围绕状态估值对非线性模型进行一阶Taylor展开,然后应用线性系统Kalman滤波公式。蝿EKF是用泰勒展开式中的一次项来对式(1)和(2)中的非线性函数f和h进行线性化处理,即先计算f和h的雅克比矩阵,然后再在标准卡尔曼滤波框架下进行递归滤波。和均为零均值的高斯白噪声。,也可分为两步预测和更新。,仅仅用了一阶项,是非线性函数在局部线性化的结果,这就给估计带来了很大误差,所以只有当系统的状态方程和观测方程都接近线性且连续时,EKF的滤波结果才有可能接近真实值。蒀EKF滤波结果的好坏还与状态噪声和观测噪声的统计特性有关,在EKF的递推滤波过程中,状态噪声和观测噪声的协方差矩阵保持不变,如果这两个噪声协方差矩阵估计的不够准确,那就容易产生误差累计,导致滤波器发散。EKF的另外一个缺点是初始状态不太好确定,如果假设的初始状态和初始协方差误差较大,也容易导致滤波器发散。,是一种基于MonteCarlo的贝叶斯估计方法,因此它就独立于系统的模型,不受线性化误差或高斯噪声假定的限制,既可以解决EKF因线性化带来的误差,也可以避免UKF因非高斯的PDF导致的误差,适用于任何环境下的任何状态和量测模型。:蚁(1)从先验分布p(x)中采集样本z,i一1,⋯,N。荿(2)t时刻,从参考分布中采集样本,并计算归一化后的权:葿(3)进行重采样:用新的采样值代替,去除低权值的粒子,复制高权值的粒子。膅(4)输出PDF:莄粒子滤波的两个关键问题是参考分布的选择和重采样。,在很大程度上取决于所选的参考分布与状态后验概率分布的接近程度。因此,最优的参考分布为p(xIz卜,)。但实际工程应用中,很难对其采样。芄螃衿莈蚆第五章实验仿真分析芃为了在同种条件下比较粒子滤波和扩展卡尔曼算法性能,我们在这里共做了三组实验,并薀设状态模型:荿x=*x+25*x/(1+x^2)+8*cos(*(k-1))+w(t)螄观测方程:蚂y=x^2/20+v(t)莀w(t)、v(t)均服从高斯分布N(0,1)膆其中x=,粒子滤波的粒子数为N=100***独立仿真次数为tf=50肂分别选取控制噪声方差Q=,观测噪声方差R=;Q=1,R=1;Q=10,R=10。仿真一次后,两种滤波器的估计结果的比较。肁Q=,R=:芈芅图5-1EKF的估计值和真值图5-2粒子滤波的估