粒子滤波及matlab实现

《粒子滤波及matlab实现》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、粒子滤波及matlab实现粒子滤波就是指：通过寻找一组在状态空间中传播的随机样本来近似的表示概率密度函数，用样本均值代替积分运算，进而获得系统状态的最小方差估计的过程，这些样本被形象的称为“粒子”，故而叫粒子滤波。粒子滤波通过非参数化的蒙特卡洛(MonteCarlo)模拟方法来实现递推贝叶斯滤波，适用于任何能用状态空间模型描述的非线性系统，精度可以逼近最优估计。粒子滤波器具有简单、易于实现等特点，它为分析非线性动态系统提供了一种有效的解决方法，从而引起目标跟踪、信号处理以及自动控制等领域的广泛关注。贝叶斯滤波动态系统的目标跟踪问题可以通过下图所示的状态空间模型

2、来描述。在目标跟踪问题中，动态系统的状态空间模型可描述为其中分别为状态转移方程与观测方程，为系统状态，为观测值，为过程噪声，为观测噪声。为了描述方便，用与分别表示到时刻所有的状态与观测值。在处理目标跟踪问题时，通常假设目标的状态转移过程服从一阶马尔可夫模型，即当前时刻的状态只与上一时刻的状态有关。另外一个假设为观测值相互独立，即观测值只与时刻的状态有关。贝叶斯滤波为非线性系统的状态估计问题提供了一种基于概率分布形式的解决方案。贝叶斯滤波将状态估计视为一个概率推理过程，即将目标状态的估计问题转换为利用贝叶斯公式求解后验概率密度或滤波概率密度，进而获得目标状态的最

3、优估计。贝叶斯滤波包含预测和更新两个阶段，预测过程利用系统模型预测状态的先验概率密度，更新过程则利用最新的测量值对先验概率密度进行修正，得到后验概率密度。假设已知时刻的概率密度函数为，贝叶斯滤波的具体过程如下：(1)预测过程，由得到：当给定时，状态与相互独立，因此上式两端对积分，可得Chapman-Komolgorov方程(2)更新过程，由得到：获取时刻的测量后，利用贝叶斯公式对先验概率密度进行更新，得到后验概率假设只由决定，即因此其中，为归一化常数贝叶斯滤波以递推的形式给出后验(或滤波)概率密度函数的最优解。目标状态的最优估计值可由后验(或滤波)概率密度函数

4、进行计算。通常根据极大后验(MAP)准则或最小均方误差(MMSE)准则，将具有极大后验概率密度的状态或条件均值作为系统状态的估计值，即贝叶斯滤波需要进行积分运算，除了一些特殊的系统模型（如线性高斯系统，有限状态的离散系统）之外，对于一般的非线性、非高斯系统，贝叶斯滤波很难得到后验概率的封闭解析式。因此，现有的非线性滤波器多采用近似的计算方法解决积分问题，以此来获取估计的次优解。在系统的非线性模型可由在当前状态展开的线性模型有限近似的前提下，基于一阶或二阶Taylor级数展开的扩展Kalman滤波得到广泛应用。在一般情况下，逼近概率密度函数比逼近非线性函数容易实

5、现。据此，Julier与Uhlmann提出一种UnscentedKalman滤波器，通过选定的sigma点来精确估计随机变量经非线性变换后的均值和方差，从而更好的近似状态的概率密度函数，其理论估计精度优于扩展Kalman滤波。获取次优解的另外一中方案便是基于蒙特卡洛模拟的粒子滤波器。粒子滤波早在20世纪50年代，Hammersley便采用基于序贯重要性采样(Sequentialimportancesampling,SIS)的蒙特卡洛方法解决统计学问题[121]。20世纪60年代后期，Handschin与Mayne使用序贯蒙特卡洛方法解决自动控制领域的相关问题。

6、20世纪70年代，Handschin、Akashi以及Zaritskii等学者的一系列研究工作使得序贯蒙特卡洛方法得到进一步发展。限于当时的计算能力以及算法本身存在的权值退化问题，序贯重要性采样算法没有受到足够重视，在随后较长一段时间内进展较为缓慢。直到20世纪80年代末，计算机处理能力的巨大进展使得序贯蒙特卡洛方法重新受到关注。Tanizaki、Geweke等采用基于重要性采样的蒙特卡洛方法成功解决了一系列高维积分问题。Smith与Gelfand提出的采样-重采样思想为Bayesian推理提供了一种易于实现的计算策略。随后，Smith与Gordon等人合作，

7、于20世纪90年代初将重采样(Resampling)步骤引入到粒子滤波中，在一定程度上解决了序贯重要性采样的权值退化问题，并由此产生了第一个可实现的SIR(Samplingimportanceresampling)粒子滤波算法(Bootstrap滤波)，从而掀起粒子滤波的研究热潮。美国海军集成水下监控系统中的Nodestar便是粒子滤波应用的一个实例。进入21世纪，粒子滤波器成为一个非常活跃的研究领域，Doucet、Liu、Arulampalam等对粒子滤波的研究作了精彩的总结，IEEE出版的论文集“SequentialMonteCarloMethodsinP

8、ractice”对粒子滤波器进行了详细