基于差分演化的粒子滤波方法
【专利摘要】本发明公开了基于差分演化的粒子滤波方法，属于信号处理、非线性滤波领域。该发明是对粒子滤波的改进，主要创新集中在：一、为了充分利用最新的观测信息，采用无迹卡尔曼滤波来产生粒子滤波的重要性分布；二、对重要性分布产生的采样粒子不再做传统重采样操作，而是对采样粒子做差分迭代优化处理，从而得到最优的粒子点集。本发明一改传统重采样算法对粒子的简单复制与丢弃的做法，而是采用差分演化算法对粒子集进行进化寻优，有效缓解了粒子滤波中的粒子退化和贫化问题，提高了粒子的利用率，具有更高的估计精度，在信号处理、非线性滤波领域具有较好的应用前景。
【专利说明】基于差分演化的粒子滤波方法
【技术领域】
[0001]本发明属于信号处理、非线性滤波领域，涉及粒子滤波技术，具体说是基于差分演化的粒子滤波方法。
【背景技术】
[0002]非线性系统状态估计问题广泛存在于目标跟踪、信号处理、自动控制、人工智能、无线通信和金融分析等诸多领域。
[0003]扩展卡尔曼滤波器(Extented Kalman Filter, EKF)是最经典的非线性滤波方法之一，其基本思想是通过对非线性系统进行线性化操作，实现对非线性系统状态的估计。由于其线性化误差较大，且许多实际问题中很难得到非线性函数的Jacobian矩阵，使其估计精度和使用范围受到了很大限制。之后，出现了无需计算Jacobian矩阵的无迹卡尔曼滤波器(Unscented Kalman Filter, UKF),但是对于非线性、非高斯性较强的问题,UKF的收敛性会急剧下降，甚至出现发散现象。
[0004]为了解决非线性、非高斯系统的估计问题，1993年Gordon等人提出一种基于SIS的Bootstrap滤波方法，即粒子滤波(PF或SIR)算法，其思想是利用一组带有相应权重的样本(或粒子)来描述系统随机变量的后验概率密度，以样本均值代替积分运算，从而获得状态最小方差估计的过程。粒子滤波可完整的反映状态的后验分布，理论上适用于任何的非线性系统。
[0005]尽管如此，粒子滤波存在粒子退化现象，即经过若干次迭代后，除了一个粒子外，几乎所有粒子都只具有非常小的权值，这就意味着大量的计算花在了那些对后验概率估计几乎没有影响的粒子上。
[0006]选择好的重要性分布，是改善粒子退化的方法之一。无迹粒子滤波(UPF)正是利用了这一点，它利用UKF来产生重要性分布函数，同时利用了当前时刻新的观测值，从而可获得较高的估计精度，但存在计算量大的问题。
[0007]重采样是减弱粒子退化的另一种方法，虽然重采样后的粒子权值不为零，但由于传统重采样将权值大的粒子多次复制，同时抛弃权值较小的粒子，如此下去，有效粒子样本被逐渐耗尽，从而导致新的问题，即粒子样本贫化现象。UPF采用了传统重采样方法，显然无法避免粒子贫化问题的出现。
【发明内容】
[0008]本发明的目的在于避免上述【背景技术】中的不足，提供一种能在一定程度上解决样本贫化，降低计算量，提高粒子利用率的基于差分演化的粒子滤波方法。
[0009]本发明的目的是这样实现的:基于差分演化的粒子滤波方法，其特征在于包括步骤如下:
[0010]a.在时间t = O时，从先验概率分布P(Xci)中随机采样，获得初始化粒子其中i = 1，2，...，N代表粒子个数，N为大于I的整数，同时设每个初始化粒子的权值为H =1/#，并计算粒子的均值与方差；
[0011]b.根据当前时刻的观测，利用UKF算法对前一时刻的粒子进行滤波处理，得到重要性函数，并从重要性函数采样得到当前时刻的重要性采样粒子；
[0012]c.计算当前时刻重要性采样粒子的权值并对其归一化；
[0013]d.利用差分演化重采样方法对当前时刻重要性采样粒子进行优化；
[0014]e.对差分演化重采样优化后的带权粒子群加权后就得到了当前时刻的滤波结果;
[0015]f.继续步骤b~e,直至完成所有时刻的滤波处理。
[0016]其中，步骤b中所述的重要性函数为澹(if1,於1);所述的从重要性函数采样得到当前时刻的重要性采样粒子#，过程为:if1其中叉"表示由UKF算法滤波得到的粒子估计值的均值，Pf表示由UKF算法估计得到的粒子估计值的方差，Λ? Pf)表示均值力P 1方差为Pt 1的高斯分布函数或正态分布函数。
[0017]其中，步骤c中所述的对粒子权值n归一化具体为:
【权利要求】
1.基于差分演化的粒子滤波方法，其特征在于包括步骤如下:a.在时间t= O时,从先验概率分布P (Xci)中随机采样，获得初始化粒子Χ(0ο，其中i =1,2,...，NR表粒子个数，N为大于I的整数，同时设每个初始化粒子的权值为=UN，并计算粒子的均值与方差； b.根据当前时刻的观测，利用UKF算法对前一时刻的粒子进行滤波处理，得到重要性函数，并从重要性函数采样得到当前时刻的重要性采样粒子； c.计算当前时刻重要性采样粒子的权值并对其归一化； d.利用差分演化重采样方法对当前时刻重要性采样粒子进行优化； e.对差分演化重采样优化后的带权粒子群加权后就得到了当前时刻的滤波结果； f.继续步骤b~e，直至完成所有时刻的滤波处理。
2.根据权利要求1所述的基于差分演化的粒子滤波方法，其特征在于，步骤b中所述的重要性函数为
3.根据权利要求1所述的基于差分演化的粒子滤波方法，其特征在于，步骤c中所述的对粒子权值m归一化具体为
4.根据权利要求1所述的基于差分演化的粒子滤波方法，其特征在于:步骤d具体包括以下步骤: dl.把步骤b中产生的采样粒子作为差分演化算法中的种群样本，构成当前时刻的原始种群，把相应的粒子权重作为当前时刻原始种群样本的适应函数； d2.对当前时刻原始种群中的样本做差分变异，得到当前时刻变异种群；d3.对当前时刻的原始种群和变异种群中的样本做差分交叉，得到当前时刻试验种群，并计算其适应函数； d4.对当前时刻的原始种群和试验种群中的样本做差分选择，得到下一代的原始种群; d5.继续步骤d2~d4，直到种群可以满足设定的终止条件或者种群繁殖代数达到设定的最大值为止。
5.根据权利要求4所述的基于差分演化的粒子滤波方法，其特征在于，步骤d2中所述的对当前时刻原始种群px，m= (Xi, J中的样本Xi,= (Xd^)d = U，…，D做差分变异,得到当前时刻变异种群，具体实现如下: 从初始种群中随机选择两个样本做比例差分，再与种群中的随机样本相加得到变异种群 FV，m = (Vi，m)中的变异样本 Vi，m= (Vd,i,m)d= 1,2,...,D:
Vi,m = F1.Xrl；m+F2.(Xr2；m-Xr3；m)其中，i=l，2,..., NP为种群样本个数，种群样本个数与粒子数相同，即NP = N，每个样本由D维样本数值构成；比例因子F1, F2 e (O, 1+)用来控制样本发生变异的速度；为差异向量，反映群体的差异度，rl，r2，r3是每次种群变异时随机产生的序号，且i ^ rl ^ r2 ^ r3 ；m表示种群的进化代数。
6.根据权利要求4所述的基于差分演化的粒子滤波方法，其特征在于:步骤d3中所述的对当前时刻的原始种群和变异种群中的样本做差分交叉，得到当前时刻试验种群，具体实现如下: 交叉是对原种群P5tm和变异种群pv，m中样本数值的融合交叉，以产生试验种群Pllm =(Ui, J:
7.根据权利要求6所述的基于差分演化的粒子滤波方法，其特征在于，步骤d4具体实现如下: 若Ui,的适应函数值大于Xi,的适应函数值，在下一代种群中就用Ui,来取代Xiim，否则保留\m:
【文档编号】H03H21/00GK103684352SQ201310695501
【公开日】2014年3月26日 申请日期:2013年12月18日 优先权日:2013年12月18日
【发明者】李红伟 申请人:中国电子科技集团公司第五十四研究所