适用于非线性系统状态的粒子估计方法

文档序号:6460657阅读:636来源:国知局
专利名称:适用于非线性系统状态的粒子估计方法
技术领域
本发明属于工程领域,具体涉及的是非线性系统状态估计的技术领域。
技术背景非线性系统状态估计问题广泛存在于信号处理及其相关领域中,例如视觉跟 踪、语音识别、机器人定位、通信和故障检测等。尽管经过了近半个世纪的发 展,但非线性系统状态估计方法还较不成熟。
一方面,这是由于非线性系统的复杂性、多样性所造成的;另一方面,由于非线性系统中各种随机噪声的存在, 导致状态估计更加困难,影响了状态估计的准确率,为非线性系统状态估计带 来了较大的困难。20世纪80年代以来,非线性系统状态估计方法受到越来越多的 关注,其中最常用的是扩展卡尔曼滤波器。但扩展卡尔曼滤波仅对某些特定的 非线性系统有效,对于一般的非线性系统扩展卡尔曼滤波不能保证其收敛且滤 波误差较大。近年来一种在非线性系统状态估计方面^r有独到优势的新滤波方 法一粒子滤波得到了迅速的发展,它有效克服了扩展卡尔曼滤波的缺点,并已被 成功应用于众多非线性系统状态估计问题中,例如,美国国家航空和宇宙航行 局研制的"火星漫游者"机器人、舰船涡轮发动机、涡轮喷气飞机发动机等。 粒子滤波是递归贝叶斯状态估计的一种模拟实现方法。它利用大量随机样本(或 称为粒子)代表待估计状态的后验概率密度函数。这些粒子通过系统模型按时 间顺序向前传播,从而得到大量系统状态的路径样本。各时刻系统状态的后验 概率密度函数用这些粒子来代表。目前比较有实用价值的粒子滤波方法有标准 粒子滤波方法(SIR)、辅助粒子滤波方法(APF)、正则化粒子滤波方法(RPF) 和高斯粒子滤波方法(GPF)。其中,辅助粒子滤波方法、正则化粒子滤波方法 和高斯粒子滤波方法均是标准粒子滤波方法的改进方法。如果用j^表示/r时刻的系统状态,用"表示j^的观测值,用{^(/>:/=1,2,...》^}代 表A时刻的所有粒子,用/KvW表示观测似然函数,则标准粒子滤波方法的步骤可描述为步骤一、粒子预测步骤一将A时刻系统状态先验分布作为重要性密度函数并从中抽取随机粒子^(0:—l,2,…A);步骤二、粒子权值更新步骤一得到A时刻系统状态观测值贝后,利用观测似然函数计算^时刻上述各粒子的似然函数值并将其作为^时刻各粒子的权值即涵啡稀):—1,2"" W;步骤三、系统状态估计步骤一利用这些粒子及其权值组成的离散概率分布作 为A时刻系统状态后验概率分布,去近似A时刻系统状态的真实概率分布,并用 于A时刻系统状态估计;步骤四、重采样步骤一在上述离散概率分布中重新采样得到新的粒子群,各 粒子的权值等于1/N,然后返回步骤一。辅助粒子滤波方法在标准粒子滤波方法的基础上,采用辅助方法预先从前一 时刻的粒子样本中选出较好的预测粒子,以期其粒子组成的离散概率分布接近 系统状态真实概率分布的可能性更高。实际应用中该方法的估计精度在系统噪 声较小时好于标准粒子滤波方法,但当系统噪声较大时精度不如标准粒子滤波 方法。正则化粒子滤波方法改变了标准粒子滤波方法步骤四中的重采样。不像 标准粒子滤波方法在离散概率分布上重采样,正则化粒子滤波方法利用正则化 方法获得一个连续概率分布并从中重采样。该方法改善了标准粒子滤波方法中 存在的粒子多样性匮乏问题,但它有一个理论上的缺陷,即所得的粒子离散概 率分布不再能保证是渐进地收敛到系统状态真实概率分布。实际应用中当粒子 多样性匮乏问题较严重时该方法好于标准粒子滤波方法。高斯粒子滤波方法在 标准粒子滤波方法的基础上,采用一个高斯分布来近似系统状态真实概率分布, 并且没有重采样步骤。当系统状态真实概率分布服从高斯分布时该方法的状态 估计精度优于标准粒子滤波方法。综上所述,以上四种方法都具有各自的优点,在其所适合的应用范围内都是 比较有效的。然而在实际非线性系统状态估计中,系统状态观测似然函数常常 具有双峰特性,这通常导致上述方法的状态估计精度较差。 发明内容本发明是为解决现有粒子滤波方法在对非线性系统状态进行估计时,因系 统状态观测似然函数具有双峰特性而导致估计精度较差的问题,进而提供的一 种适用于非线性系统状态的粒子估计方法。本发明的步骤为步骤一、粒子预测步骤将A时刻系统状态先验分布作为重要性密度函数 并从中抽取随机粒子{^(/):/=1,2,...^}; 步骤二、粒子权值更新步骤(1) 得到A时刻系统状态观测值力后,利用观测似然函数计算/^时刻各粒子 的似然函数值为(/K^^(,W,其中—l,2,…,N;(2) 计算各粒子观测向量F④和系统状态观测向量Kt间的夹角^i),其中/=1,2,.."N;(3) 计算A时刻各粒子的权值^②如下^(/)=,"')Xjp(h I ^ (/)),/ = 1,2,."iV计算/^£+/时刻各粒子的权值^^+/,)如下』)= x /7d+, I &_』)),/ = 1,2,." iV 其中,"是一个预先指定的比例因子; 步骤三、系统状态估计步骤(7J A时刻系统状态的滤波估计一利用/t时刻粒子及其权值组成的离散概 率分布作为&时刻系统状态后验概率分布,去近似/t时刻系统状态 的真实概率分布,并用于A时刻系统状态估计;时刻系统状态的平滑估计--利用时刻粒子及其权值组成 的离散概率分布作为时刻系统状态后验概率分布,去近似 /^+/时刻系统状态的真实概率分布,并用于时刻系统状态估 计;O返回步骤一;用JCA表示A时刻的系统状态,用力表示A的观测值,用^(/):/=1,2,...^} 代表A时刻的所有粒子,用p(vlA:)表示观测似然函数,用{~(/):戶/^:+1,...,/^代 表^£+1时刻到A时刻的所有粒子,用^^=0^+/0,>^+^,...,^朋表示粒子观测向量,用「={^4+1,^+2,...,^}表示系统状态观测向量,用6Y,)表示这两种 向量的夹角。这里,1和/是两个预先指定的常量且1 《是一个预先指 定的比例因子。本发明的粒子权值更新步骤和系统状态估计步骤不同于现有的粒子滤波方法,本发明方法在粒子权值更新步骤中将粒子观测向量和系统状态观测向量的 夹角作为计算粒子权值的参数,并在系统状态估计步骤中加入了平滑操作。这 些特征都是现有的粒子滤波方法所不具备的。本发明适用于一般非线性系统状 态估计问题的求解,在系统状态观测似然函数具有双峰特性时该方法优于现有 粒子滤波方法,能有效地提高非线性系统状态的估计精度。


图1是本发明的方法与SIR、 APF、 RPF和GPF算法的性能对比实验效 果图。
具体实施方式
具体实施方式
一本发明基于下述理论基础如果一个粒子的观测路径靠近系统状态的观测 路径,则该粒子的路径应靠近系统状态的路径。如果将一个粒子的一系列观测 值和系统状态的一系列观测值分别看作一个粒子观测向量和系统状态观测向 量,则可用这两个向量的夹角来度量它们之间的相似程度。当该夹角较小时就 表示该粒子靠近系统状态。用A表示A时刻的系统状态,用"表示J^的观测值,用^(/):/=1,2,...^}代 表A时刻的所有粒子,用jKvW表示观测似然函数,用{~(/):7'=^丄+1,...,/^代表yn+i时刻到&时刻的所有粒子,用ni:)={^i+^,》-i+/o,...,j^:n表示粒子观领U向量,用^={^./:+1,>^:+2,...,力}表示系统状态观测向量,用0④表示这两种向 量的夹角。这里,£和/是两个预先指定的常量且1^/<£, 《是一个预先指定 的比例因子。本实施方式的非线性系统状态粒子估计方法步骤为步骤一、粒子预测步骤将/t时刻系统状态先验分布作为重要性密度函数 并从中抽取随机粒子{^/):/=1,2,...>^;步骤二、粒子权值更新步骤(1) 得到A时刻系统状态观测值力后,利用观测似然函数计算A时刻各粒子 的似然函数值为(p(v4^(/)》,其中lM,2,.,.,N;(2) 计算各粒子观测向量K②和系统状态观测向量Kt间的夹角^i),其中,.=1,2,""N;(3)计算A时刻各粒子的权值<formula>formula see original document page 8</formula>如下<formula>formula see original document page 8</formula>计算<formula>formula see original document page 8</formula>时刻各粒子的权值<formula>formula see original document page 8</formula>如下<formula>formula see original document page 8</formula>其中,《是一个预先指定的比例因子; 步骤三、系统状态估计步骤-(7JA时刻系统状态的滤波估计一利用A时刻粒子及其权值组成的离散概 率分布作为A时刻系统状态后验概率分布,去近似A时刻系统状态的真实 概率分布,并用于A时刻系统状态估计;时刻系统状态的平滑估计一利用时刻粒子及其权值组成 的离散概率分布作为时刻系统状态后验概率分布,去近似时 刻系统状态的真实概率分布,并用于时刻系统状态估计;(3)返回步骤一。本具体实施方式
的非线性系统状态粒子估计方法步骤二中第(2)子步骤所 述的向量K(T^和F之间的夹角0④的计算步骤为 步骤1、计算K②和K的内积如下步骤2、分别计算K④和F的范数如下<formula>formula see original document page 8</formula>遵步骤3、计算K②和F之间的夹角e②如下广歐、、<formula>formula see original document page 8</formula>其中,arccos"是反余弦函数。本方法在被应用于如下具有代表性的观测似然函数有双峰特性的非线性系统中时,本方法的误差远小于SIR、 APF、 RPF和GPF方法。<formula>formula see original document page 9</formula>使用粒子总数 =100、 W-广A/(0,1)、 W~A/(0,1), xQ=ai; —次实验运行时 间为5000个时间点,共进行100次实验运行r取/_=5、 /=2和gf1.8;采用误差均方根值(賜SE)评价算法性能。实验结果显示在图1中,其中PE代表本 方法结果,SIR代表标准粒子滤波方法,APF代表辅助粒子滤波方法,RPF代表 正则化粒子滤波方法,GPF代表高斯粒子滤波方法。
权利要求
1、适用于非线性系统状态的粒子估计方法,其特征是它通过下述步骤实现步骤一、粒子预测步骤将k时刻系统状态先验分布作为重要性密度函数并从中抽取随机粒子{x(i)i=1,2,...,N};步骤二、粒子权值更新步骤(1)得到k时刻系统状态观测值yk后,利用观测似然函数计算k时刻各粒子的似然函数值为{p(yk|xk(i))},其中i=1,2,...,N;(2)计算各粒子观测向量V(i)和系统状态观测向量V之间的夹角θ(i),其中i=1,2,...,N;(3)计算k时刻各粒子的权值qk(i)如下qk(i)=eα/θ(i)×p(yk|xk(i)),i=1,2,..,N计算k-L+l时刻各粒子的权值qk-L+l(i)如下qk-L+l(i)=eα/θ(i)×p(yk-L+l|xk-L+l(i)),i=1,2,..,N其中,α是一个预先指定的比例因子;步骤三、系统状态估计步骤(1)k时刻系统状态的滤波估计一利用k时刻粒子及其权值组成的离散概率分布作为k时刻系统状态后验概率分布,去近似k时刻系统状态的真实概率分布,并用于k时刻系统状态估计;(2)k-L+l时刻系统状态的平滑估计一利用k-L+l时刻粒子及其权值组成的离散概率分布作为k-L+l时刻系统状态后验概率分布,去近似k-L+l时刻系统状态的真实概率分布,并用于k-L+l时刻系统状态估计;(3)返回步骤一;用xk表示k时刻的系统状态,用yk表示xk的观测值,用{x(i)i=1,2,...,N}代表k时刻的所有粒子,用p(y|x)表示观测似然函数,用{xj(i)j=k-L+1,...,k}代表k-L+1时刻到k时刻的所有粒子,用V(i)={yk-L+1(i),yk-L+2(i),...,yk(i)}表示粒子观测向量,用V={yk-L+1,yk-L+2,...,yk}表示系统状态观测向量,用θ(i)表示这两种向量的夹角;这里,L和l是两个预先指定的常量且1≤l<L,α是一个预先指定的比例因子。
2、根据权利要求1所述适用于非线性系统状态的粒子估计方法, 其特征是步骤二中第(2)子步骤的向量r②和F之间的夹角0②的 计算步骤为步骤1、计算F④和K的内积如下步骤2、分别计算F②和K的范数如下步骤3、计算F②和K之间的夹角0②如下 W.、 「 ( 、其中,arccos(J是反余弦函数
全文摘要
适用于非线性系统状态的粒子估计方法。本发明属于工程领域,具体涉及到非线性系统状态估计的技术领域。它是为解决对非线性系统状态进行估计时,因系统状态观测似然函数具有双峰特性使状态估计精度较差的问题。它在标准粒子滤波方法的基础上,在粒子权值更新步骤中将粒子观测向量和系统状态观测向量的夹角作为计算粒子权值的参数,并在系统状态估计步骤中加入了平滑操作。本发明适用于一般非线性系统的状态估计问题,当系统状态观测似然函数具有双峰特性时,该方法的状态估计精度较高。
文档编号G06N7/00GK101261691SQ200810064328
公开日2008年9月10日 申请日期2008年4月18日 优先权日2008年4月18日
发明者彭喜元, 军 梁 申请人:哈尔滨工业大学
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1