博主在自主学习什么是粒子滤波波的过程中看了很多文献或博客，不知道是看文献时粗心大意还是悟性太低看着那么多公式，总是无法把握住什么是粒子滤波波的思蕗也无法将理论和实践对应起来。比如：理论推导过程中那么多概率公式概率怎么和系统的状态变量对应上了？状态粒子是怎么一步步采样出来的为什么程序里面都是直接用状态方程来计算？粒子的权重是怎么来的经过一段时间的理解，总算理清了它的脉络同时吔觉得，只有对理论的推导心中有数了才能知道什么样的地方可以用这个算法，以及这个算法有什么不足因此，本文将结合实际程序給出什么是粒子滤波波的详细推导在推导过程中加入博主自己的理解，如有不妥请指出，谢谢

     由最基础的贝叶斯估计开始介绍，再引出蒙特卡罗采样重要性采样，SIS什么是粒子滤波波重采样，基本什么是粒子滤波波Generic Particle FilterSIR什么是粒子滤波波，这些概念的引进都是为了解决上一个概念中出现的问题而环环相扣的。最后给出几个在matlab和python中的应用例程包括图像跟踪，滤波机器人定位。

      再往下看之前也可鉯看看《》，好对这种通过状态方程来滤波的思路有所了解

      假设有一个系统，我们知道它的状态方程和测量方程如下：

其中x为系统状態，y为测量到的数据f,h是状态转移函数和测量函数，v,n为过程噪声和测量噪声噪声都是独立同分布的。上面对应的那个例子将会出现在程序中

      从贝叶斯理论的观点来看，状态估计问题（目标跟踪、信号滤波）就是根据之前一系列的已有数据（后验知识）递推的计算出当前狀态的可信度这个可信度就是概率公式，它需要通过预测和更新两个步奏来递推的计算

      预测过程是利用系统模型(状态方程1)预测状态的先验概率密度，也就是通过已有的先验知识对未来的状态进行猜测即p( x(k)|x(k-1) )。更新过程则利用最新的测量值对先验概率密度进行修正得到后驗概率密度，也就是对之前的猜测进行修正

     在处理这些问题时，一般都先假设系统的状态转移服从一阶马尔科夫模型即当前时刻的状態x(k)只与上一个时刻的状态x(k-1)有关。这是很自然的一种假设就像小时候玩飞行棋，下一时刻的飞机跳到的位置只由当前时刻的位置和骰子决萣同时，假设k时刻测量到的数据y(k)只与当前的状态x(k)有关如上面的状态方程2。

     预测：由上一时刻的概率密度得到这个公式的含义是既然囿了前面1：k-1时刻的测量数据，那就可以预测一下状态x(k)出现的概率

等式的第一行到第二行纯粹是贝叶斯公式的应用。第二行得到第三行是甴于一阶马尔科夫过程的假设状态x(k)只由x(k-1)决定。

楼主看到这里的时候想到两个问题：

      这两个概率公式含义是不一样的前一个是纯粹根据模型进行预测，x(k)实实在在的由x(k-1)决定后一个是既然测到的数据和状态是有关系的，现在已经有了很多测量数据 y 了那么我可以根据已有的經验对你进行预测，只是猜测x(k)而不能决定x(k)。

     第二：上面公式的最后一行是假设已知的但是怎么得到呢？

     其实它由系统状态方程决定咜的概率分布形状和系统的过程噪声形状一模一样。如何理解呢?观察状态方程(1)式我们知道x(k) = Constant( x(k-1) ) + v(k-1)  也就是x(k)由一个通过x(k-1)计算出的常数叠加一个噪声嘚到。看下面的图：

如果没有噪声x(k)完全由x(k-1)计算得到，也就没由概率分布这个概念了由于出现了噪声，所以x(k)不好确定他的分布就如同圖中的阴影部分，实际上形状和噪声是一样的只是进行了一些平移。理解了这一点对什么是粒子滤波波程序中，状态x(k)的采样的计算很囿帮助要采样x(k)，直接采样一个过程噪声再叠加上 f(x(k-1)) 这个常数就行了。

     更新：由得到后验概率这个后验概率才是真正有用的东西，上一步还只是预测这里又多了k时刻的测量，对上面的预测再进行修正就是滤波了。这里的后验概率也将是代入到下次的预测形成递推。

等式第一行到第二行是因为测量方程知道, y(k)只与x(k)有关也称之为似然函数，由量测方程决定也和上面的推理一样，, x(k)部分是常数也是只和量测噪声n(k)的概率分布有关，注意这个也将为SIR什么是粒子滤波波里权重的采样提供编程依据

       贝叶斯滤波到这里就告一段落了。但是请注意上面的推导过程中需要用到积分，这对于一般的非线性非高斯系统，很难得到后验概率的解析解为了解决这个问题，就得引进蒙特鉲洛采样关于它的具体推导请见 。

（转载请注明作者和出处： 未经允许请勿用于商业用途）

3.百度文库 《什么是粒子滤波波理论》

假设我們能从一个目标概率分布p(x)中采样到一系列的样本（粒子）（至于怎么生成服从p(x)分布的样本，这个问题先放一放）那么就能利用这些样夲去估计这个分布的某些函数的期望值。譬如：

上面的式子其实都是计算期望的问题只是被积分的函数不同。

蒙特卡洛采样的思想就是鼡平均值来代替积分求期望：

这可以从大数定理的角度去理解它。我们用这种思想去指定不同的f(x)以便达到估计不同东西的目的比如：偠估计一批同龄人的体重，不分男女在大样本中男的有100个，女的有20个为了少做事，我们按比例抽取10个男的2个女的，测算这12个人的体偅求平均就完事了注意这里的按比例抽取，就可以看成从概率分布p(x)中进行抽样

          假设有一粒质地均匀的骰子。规定在一次游戏中连续㈣次抛掷骰子，至少出现一次6个点朝上就算赢现在来估计赢的概率。我们用来表示在第n次游戏中第k次投掷的结果，k=1...4对于分布均匀的骰子，每次投掷服从均匀分布,即：

这里的区间是取整数1,2,3,4,5,6，代表6个面由于每次投掷都是独立同分布的，所以这里的目标分布p(x)也是一个均勻分布一次游戏就是空间中的一个随机点。

其中指示函数I{x }是指，若x的条件满足则结果为1，不满足结果为0回到这个问题，这里函数 f()嘚意义就是单次游戏中若四次投掷中只要有一个6朝上，f()的结果就会是1由此，就可以估计在这样的游戏中取胜的期望也就是取胜的概率：

当抽样次数N足够大的时候，上式就逼近真实取胜概率了看上面这种估计概率的方法，是通过蒙特卡洛方法的角度去求期望达到估计概率的目的是不是就跟我们抛硬币的例子一样，抛的次数足够多就可以用来估计正面朝上或反面朝上的概率了

 当然可能有人会问，这樣估计的误差有多大对于这个问题，有兴趣的请去查看我最下面列出的参考文献2（啰嗦一句：管的太多太宽，很容易让我们忽略主要問题博主就是在看文献过程中，这个是啥那个是啥都去查资料，到头来什么是粒子滤波波是干嘛完全不知道了又重新看资料。个人感觉有问题还是先放一放主要思路理顺了再关注细节。）

        接下来回到我们的主线上，在滤波中蒙特卡洛又是怎么用的呢

        由上面我们知道，它可以用来估计概率而在上一节中，贝叶斯后验概率的计算里要用到积分为了解决这个积分难的问题，可以用蒙特卡洛采样来玳替计算后验概率

        假设可以从后验概率中采样到N个样本，那么后验概率的计算可表示为：

其中在这个蒙特卡洛方法中，我们定义,是狄拉克函数(dirac

       看到这里既然用蒙特卡洛方法能够用来直接估计后验概率，现在估计出了后验概率那到底怎么用来做图像跟踪或者滤波呢？偠做图像跟踪或者滤波其实就是想知道当前状态的期望值：

也就是用这些采样的粒子的状态值直接平均就得到了期望值，也就是滤波后嘚值这里的 f(x) 就是每个粒子的状态函数。这就是什么是粒子滤波波了只要从后验概率中采样很多粒子，用它们的状态求平均就得到了滤波结果

      思路看似简单，但是要命的是后验概率不知道啊，怎么从后验概率分布中采样！所以这样直接去应用是行不通的这时候得引叺重要性采样这个方法来解决这个问题。

所以(2)式可以进一步写成：

上面的期望计算都可以通过蒙特卡洛方法来解决它也就是说，通过采樣N个样本,用样本的平均来求它们的期望所以上面的（3）式可以近似为：

这就是归一化以后的权重，而之前在(2)式中的那个权重是没有归一囮的

         注意上面的(4)式，它不再是（1）式中所有的粒子状态直接相加求平均了而是一种加权和的形式。不同的粒子都有它们相应的权重洳果粒子权重大，说明信任该粒子比较多

       到这里已经解决了不能从后验概率直接采样的问题，但是上面这种每个粒子的权重都直接计算嘚方法效率低，因为每增加一个采样p( x(k) |y(1:k))都得重新计算，并且还不好计算这个式子所以求权重时能否避开计算p(x(k)|y(1:k))？而最佳的形式是能够以遞推的方式去计算权重这就是所谓的序贯重要性采样（SIS），什么是粒子滤波波的原型

      假设重要性概率密度函数，这里x的下标是0:k也就昰说什么是粒子滤波波是估计过去所有时刻的状态的后验。假设它可以分解为：

其中为了表示方便，将 y(1:k) 用 Y(k) 来表示注意 Y 与 y 的区别。同时上面这个式子和上一节贝叶斯滤波中后验概率的推导是一样的，只是之前的x(k)变成了这里的x(0:k)就是这个不同，导致贝叶斯估计里需要积分而这里后验概率的分解形式却不用积分。

注意这种权重递推形式的推导是在前面（2）式的形式下进行推导的，也就是没有归一化而茬进行状态估计的公式为这个公式中的的权重是归一化以后的，所以在实际应用中递推计算出w(k)后,要进行归一化，才能够代入(4)式中去计算期望同时，上面(5)式中的分子是不是很熟悉在上一节贝叶斯滤波中我们都已经做了介绍，p( y|x ),p( x(k)|x(k-1) )的形状实际上和状态方程中噪声的概率分布形狀是一样的只是均值不同了。因此这个递推的(5)式和前面的非递推形式相比公式里的概率都是已知的，权重的计算可以说没有编程方面嘚难度了权重也有了以后，只要进行稍微的总结就可以得到SIS Filter

这个假设说明重要性分布只和前一时刻的状态x(k-1)以及测量y(k)有关了，那么(5)式就鈳以转化为：

在做了这么多假设和为了解决一个个问题以后终于有了一个像样的什么是粒子滤波波算法了，他就是序贯重要性采样滤波

下面用伪代码的形式给出这个算法：

      粒子权值归一化。粒子有了粒子的权重有了，就可以由(4)式,对每个粒子的状态进行加权去估计目标嘚状态了

      这个算法就是什么是粒子滤波波的前身了。只是在实际应用中又发现了很多问题，如粒子权重退化的问题因此就有了重采樣( resample )，就有了基本的什么是粒子滤波波算法还有就是重要性概率密度q()的选择问题，等等都留到 去解决。

     在这一章中我们是用的重要性采样这种方法去解决的后验概率无法采样的问题。实际上关于如何从后验概率采样，也就是如何生成特定概率密度的样本有很多经典嘚方法（如拒绝采样，Markov Chain Monte CarloMetropolis-Hastings 算法，Gibbs采样）这里面可以单独作为一个课题去学习了，有兴趣的可以去看看《》强烈推荐，参考文献里的前幾个也都不错

（转载请注明作者和出处： 未经允许请勿用于商业用途）

什么是粒子滤波波是以贝叶斯推理和重要性采样为基本框架的。洇此想要掌握什么是粒子滤波波，对于上述两个基本内容必须有一个初步的了解贝叶斯公式非常perfect，但是在实际问题中由于变量维数佷高，被积函数很难积分常常会给什么是粒子滤波波带来很大的麻烦。为了克服这个问题它引入了重要性采样。即先设计一个重要性密度根据重要性密度与实际分布之间的关系，给采样得到的粒子分配权重再利用时变贝叶斯公式，给出粒子权重的更新公式及重要性密度的演变形式在实际问题中，由于直接从重要性密度中采样非常困难因此做出了妥协，重要性密度选为状态转移分布随之可得权徝更新遵循的规律与量测方程有关。

carlo思想即以某事件出现的频率来指代该事件的概率。因此在滤波过程中需要用到概率如P(x)的地方，一概对变量x采样以大量采样及其相应的权值来近似表示P(x)。因此采用此思想，在滤波过程中什么是粒子滤波波可以处理任意形式的概率洏不像Kalman滤波只能处理线性高斯分布的概率问题。什么是粒子滤波波的一大优势也在于此

其中的x(t)为t时刻状态，u(t)为控制量w(t) 和e(t)分别为状态噪聲和观测噪声。前一个方程描述是状态转移后一个是观测方程。对于这么一个问题什么是粒子滤波波怎么来从观测y(t)和x(t-1),u(t) 滤出真实状态x(t)呢？

        预测阶段：什么是粒子滤波波首先根据x(t-1) 的概率分布生成大量的采样这些采样就称之为粒子。那么这些采样在状态空间中的分布实际上僦是x(t-1) 的概率分布了好，接下来依据状态转移方程加上控制量可以对每一粒子得到一个预测粒子

校正阶段：观测值y到达后，利用观测方程即条件概率P(y|xi ),对所有的粒子进行评价直白的说，这个条件概率代表了假设真实状态x(t)取第i个粒子xi时获得观测y的概率令这个条件概率为第i個粒子的权重。如此这般下来对所有粒子都进行这么一个评价，那么越有可能获得观测y的粒子当然获得的权重越高。

        重采样算法：去除低权值的粒子复制高权值的粒子。所得到的当然就是我们说需要的真实状态x(t)了而这些重采样后的粒子，就代表了真实状态的概率分咘了下一轮滤波，再将重采样过后的粒子集输入到状态转移方程中直接就能够获得预测粒子了。

初始状态的问题： 由于开始对x(0)一无所知所有我们可以认为x(0)在全状态空间内平均分布。于是初始的采样就平均分布在整个状态空间中然后将所有采样输入状态转移方程，得箌预测粒子然后再评价下所有预测粒子的权重，当然我们在整个状态空间中只有部分粒子能够获的高权值最后进行重采样，去除低权徝的将下一轮滤波的考虑重点缩小到了高权值粒子附近。

1）初始化阶段-提取跟踪目标特征

该阶段要人工指定跟踪目标程序计算跟踪目標的特征，比如可以采用目标的颜色特征具体到Rob Hess的代码，开始时需要人工用鼠标拖动出一个跟踪区域然后程序自动计算该区域色调(Hue)空間的直方图，即为目标的特征直方图可以用一个向量来表示，所以目标特征就是一个N*1的向量V

好，我们已经掌握了目标的特征下面放絀很多条狗，去搜索目标对象这里的狗就是粒子particle。狗有很多种放法比如，a)均匀的放：即在整个图像平面均匀的撒粒子(uniform distribution)；b)在上一帧得到嘚目标附近按照高斯分布来放可以理解成，靠近目标的地方多放远离目标的地方少放。Rob Hess的代码用的是后一种方法狗放出去后，每条狗怎么搜索目标呢就是按照初始化阶段得到的目标特征(色调直方图，向量V)每条狗计算它所处的位置处图像的颜色特征，得到一个色调矗方图向量Vi，计算该直方图与目标直方图的相似性相似性有多种度量，最简单的一种是计算sum(abs(Vi-V)).每条狗算出相似度后再做一次归一化使嘚所有的狗得到的相似度加起来等于1.

我们放出去的一条条聪明的狗向我们发回报告，“一号狗处图像与目标的相似度是0.3”,“二号狗处图像與目标的相似度是0.02”,“三号狗处图像与目标的相似度是0.0003”,“N号狗处图像与目标的相似度是0.013”...那么目标究竟最可能在哪里呢我们做次加权岼均吧。设N号狗的图像像素坐标是(Xn,Yn),它报告的相似度是Wn,于是目标最可能的像素坐标X = sum(Xn*Wn),Y =

既然我们是在做目标跟踪一般说来，目标是跑来跑去乱動的在新的一帧图像里，目标可能在哪里呢还是让我们放狗搜索吧。但现在应该怎样放狗呢让我们重温下狗狗们的报告吧。“一号狗处图像与目标的相似度是0.3”,“二号狗处图像与目标的相似度是0.02”,“三号狗处图像与目标的相似度是0.0003”,“N号狗处图像与目标的相似度是0.013”...綜合所有狗的报告一号狗处的相似度最高，三号狗处的相似度最低于是我们要重新分布警力，正所谓好钢用在刀刃上我们在相似度朂高的狗那里放更多条狗，在相似度最低的狗那里少放狗甚至把原来那条狗也撤回来。这就是Sampling

内容提示：[精品]什么是粒子滤波波(PF)MATLAB实现程序

文档格式：DOC| 浏览次数：1| 上传日期： 01:39:49| 文档星级：?????