CN103389094A - 一种改进的粒子滤波方法 - Google Patents
一种改进的粒子滤波方法 Download PDFInfo
- Publication number
- CN103389094A CN103389094A CN2013102960862A CN201310296086A CN103389094A CN 103389094 A CN103389094 A CN 103389094A CN 2013102960862 A CN2013102960862 A CN 2013102960862A CN 201310296086 A CN201310296086 A CN 201310296086A CN 103389094 A CN103389094 A CN 103389094A
- Authority
- CN
- China
- Prior art keywords
- particle
- factor
- constantly
- state
- calculate
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Filters That Use Time-Delay Elements (AREA)
Abstract
本发明提供的是一种改进的粒子滤波方法。包括:(1)运载体启动后,选取运载体状态函数及量测函数;(2)选取渐消因子和弱化因子;(3)采用STSRCKF设计重要性密度函数;(4)重新产生粒子;(5)计算粒子重要性权值并归一化;(6)重采样;(7)状态估计;(8)时刻迭代更新,判断当前时刻k是否为迭代终止时刻,若当前时刻k不是迭代终止时刻,则由当前时刻k更新到下一时刻k+1,重复执行步骤(2);若当前时刻k是迭代终止时刻,则结束,控制运载体停止运动。
Description
技术领域
本发明涉及的是一种粒子滤波方法。
背景技术
非线性非高斯系统状态估计问题广泛存在于运载体(移动机器人、水下航行器等)导航领域,备受许多学者关注。本发明涉及的是一种基于强跟踪平方根容积粒子滤波(StrongTracking Square Root Cubature Particle Filter,即STSRCPF)技术。
基于贝叶斯理论与Monte Carlo方法的粒子滤波(particle filter,PF)是一种新的处理非线性非高斯系统的有效方法,这种方法利用大量的随机样本描述概率分布,并在测量的基础上调节各粒子权值的大小和样本位置来近似实际后验概率分布,因此该方法在任何非线性非高斯系统中都可以进行估计。由于粒子需要从重要性密度函数(或称为建议分布)中抽取,因此重要性密度函数的选择就影响着粒子滤波性能的好坏。而传统的粒子滤波方法采用未含当前最新测量数据的状态转移先验分布作为重要性密度函数,引入了较大的权重方差,无法很好地逼近后验概率,尤其当量测数据出现在转移概率分布的尾部或似然函数同转移概率分布相比过于集中时(如呈尖峰型),粒子滤波可能失败。
为了很好地解决粒子滤波出现的上述问题,文献《Cubature粒子滤波》(系统工程与电子技术,2011,33(11):2554-2557)提出容积粒子滤波,将CKF引入到粒子滤波框架中,在先验分布更新阶段融入了最新的量测数据,采用CKF设计粒子滤波的重要性密度函数,使重要性密度函数更加接近系统状态后验概率密度,提高了滤波估计精度。
上述容积粒子滤波方法在精度和稳定性方面仍有提高的余地。
发明内容
本发明的目的在于提供一种能改善标准粒子滤波的估计性能,精度高、稳定性强的运用于运载体导航过程的改进的粒子滤波方法。
本发明的目的是这样实现的:
(1)运载体启动后,
首先,选取运载体状态函数及量测函数如下:
其中,xk为状态向量,zk为量测向量,f(xk-1)和h(xk)分别为运载体状态函数和量测函数,wk-1为随机系统噪声,且wk-1~N(0,Q),vk为随机量测噪声,且vk~N(0,R);
在初始时刻,即k=0时刻,设定运载体的初始状态 ,初始状态协方差P0=[0]8×8,系统噪声Q,量测噪声R,并设定粒子数N,重采样阈值Nthreshold,用于求取渐消因子C0,k的初始值C0,0和弱化因子ρ;
(2)选取渐消因子和弱化因子
选取渐消因子λk和弱化因子β如下:
其中,λk为渐消因子,当模型较准确时,λk=1,STSRCKF退化为普通SRCKF;tr(·)为求矩阵的迹;β≥1为弱化因子;Szz,k|k-1为新息协方差矩阵的平方根因子;γk是残差;0<ρ≤1为遗忘因子,能提高滤波器的快速跟踪能力,通常取;ρ=0.95;
(3)采用STSRCKF设计重要性密度函数
采用STSRCKF方法的时间更新和量测更新更新每个粒子:
①时间更新
Sk-1|k-1=Chol{Pk-1|k-1}
计算容积点,i=1,2,…,m;m=2n:
通过状态方程传播容积点:
估计k时刻的状态预测值:
计算k时刻状态协方差预测值的平方根因子:
②量测更新,融入最新量测数据:
计算容积点,i=1,2,…,m;m=2n:
通过量测方程传播容积点:
zi,k|k-1=h(Xi,k|k-1)
估计k时刻的量测预测值:
计算新息协方差矩阵的平方根因子:
Szz,k|k-1=Tria([ξk|k-1 SR,k])
计算互相关协方差矩阵:
引入渐消因子λk实时估计滤波增益:
计算k时刻的状态估计值:
计算k时刻状态协方差估计值的平方根因子:
Sk|k=Tria([ηk|k-1-Kkζk|k-1 KkSR,k])
其中,、Pk-1|k-1分别为k-1时刻的状态估计值和协方差估计值;Sk-1|k-1为Pk-1|k-1的乔里斯基因子;[1]i表示集合[1]的第i列,[1]=[enye()n-, ;m=2n为容积点个数,n=8为UUV状态向量的维数;Xi,k-1|k-1、Xi,k|k-1分别为k-1时刻和k时刻的容积点;f(·)、h(·)分别为状态方程和量测方程;zi,k|k-1分别为通过状态方程和量测方程传播后的容积点;SQ,k-1、SR,k分别为Qk-1和Rk的平方根因子; 分别为k时刻的状态预测值和量测预测值;Sk|k-1、Sk|k分别为k时刻状态协方差预测值和估计值的平方根因子;Szz,k|k-1为信息协方差矩阵的平方根因子;Pxz,k|k-1为互相关协方差矩阵;Kk为滤波增益;zk为量测向量;
(4)重新产生粒子
重新产生粒子:
(5)计算粒子重要性权值并归一化
对于i=1,2,…,N,计算重要性权值并归一化
计算重要性权值:
归一化:
(6)重采样
(7)状态估计
计算状态估计值:
计算协方差估计值:
(8)时刻迭代更新
判断当前时刻k是否为迭代终止时刻,若当前时刻k不是迭代终止时刻,则由当前时刻k更新到下一时刻k+1,重复执行步骤(2);若当前时刻k是迭代终止时刻,则结束,控制运载体停止运动。
本发明的有益效果在于:
STSRCPF采用具有强跟踪性能的SRCKF设计重要性密度函数,STSRCKF通过引入时变渐消因子和弱化因子,实时修正滤波增益矩阵,实现残差序列正交,确保了滤波器的准确跟踪能力;并通过传播目标状态的均值和协方差的平方根,确保协方差矩阵的对称性和半正定性,从而改进SRCKF和CPF的估计精度和稳定性。
附图说明
图1一种改进的粒子滤波方法结构框图;
图2无人水下航行器的全局坐标系与船体坐标系示意图;
图3三种滤波方法的估计轨迹与GPS真实轨迹对比曲线示意图;
图4图3中矩形区域的局部放大示意图;
图5东向误差比较示意图;
图6北向误差比较示意图。
具体实施方式
下面给出本发明的优选实施方式,并结合附图和无人水下航行器湖试例证加以说明。
如附图1所示,本发明的目的是通过如下步骤实现的:
(1)启动运载体
首先,选取运载体状态函数及量测函数如下:
其中,xk为状态向量,zk为量测向量,f(xk-1)和h(xk)分别为运载体状态函数和量测函数,wk-1为随机系统噪声,且wk-1~N(0,Q),vk为随机量测噪声,且vk~N(0,R)。
在初始时刻,即k=0时刻,设定运载体的初始状态 ,初始状态协方差P0=[0]8×8,系统噪声Q,量测噪声R,并设定粒子数N,重采样阈值Nthreshold,用于求取渐消因子C0,k的初始值C0,0和弱化因子ρ。
(2)选取渐消因子和弱化因子
CKF基于容积准则,计算出一组偶数个具有同等权值的容积点,它们能完全捕获高斯分布变量的均值和方差,且经过非线性系统方程转换后,其后验均值和方差能够精确到非线性系统泰勒级数展开的三阶项或更高阶项,无需对非线性模型进行线性化,不依赖于具体系统模型的非线性方程,算法相对独立,适用于任何形式的非线性模型。但CKF仍存在对模型参数变化的鲁棒性差、收敛速度慢及对突变状态的跟踪能力低等缺陷。
SRCKF是CKF的平方根实现,其通过传播状态协方差的平方根,确保了协方差矩阵的对称性和半正定性,改进了数值精度和稳定性。因此,本发明将SRCKF和STF相结合,设计了一种STSRCKF方法,并将STSRCKF引入到粒子滤波框架中,提出STSRCPF滤波方法。
标准SRCKF成为STSRCKF的充分条件是在线选择k时刻的时变滤波增益Kk,使得:
式中,γk是k时刻的残差,k=0,1,2…,j=1,2…,xk为k时刻的真实状态值,为k时刻的状态估计值。条件(4)是SRCKF状态估计残差最小方差性能指标;条件(5)要求不同时刻的输出残差序列处处保持正交。
实际应用中,系统模型不确定性造成滤波器的状态估计值偏离系统真实状态时,会导致滤波输出残差序列不正交,建立在前述性能指标(4)和(5)基础上的STSRCKF通过引入渐消因子强行使输出残差序列保持正交,具有类似高斯白噪声的性质,最大程度地提取输出残差序列中一切有效信息,使STSRCKF在模型不确定时仍能保持对系统状态的强跟踪能力。
STSRCKF满足引理1所述的性质。
引理1反映了残差自协方差的一个重要性质。当滤波器的增益最优时,Cj,k=0,表明残差是不相关的,而当模型参数和噪声方差存在误差时,Cj,k≠0。如果能选择渐消矩阵使得Cj,k的最后一项,对于所有的j=1,2,3,…,都有式(7)成立,可以认为Kk仍将是最优的。SRCKF满足式(7)时成为STSRCKF。
Pxz,k|k-1-KkC0,k=0 (7)
其中, Szz,k|k-1为新息协方差矩阵的平方根因子。
由引理1可知,当等式Pxz,k|k-1-KkC0,k=0成立时,即:
式(9)成立的一个充分条件是:
即:
对式(11)求迹得:
为削弱λk的调节作用,避免过调节,使状态估计更平滑,引入弱化因子β,式(12)转化为:
其中,β≥1为弱化因子;0<ρ≤1为遗忘因子,能提高滤波器的快速跟踪能力,通常取ρ=0.95,ρ值越大,k时刻以前的信息所占的比例越小,就越突出当前残差向量的影响。该方法具有很强的关于突变状态的跟踪能力,且在滤波达到稳态时,仍保持对缓变状态及突变状态的跟踪能力。当模型较准确时,λk=1,STSRCKF退化为普通SRCKF。
(3)采用STSRCKF设计重要性密度函数
用STSRCKF设计重要性密度函数可以表示为式(14):
①时间更新
Sk-1|k-1=Chol{Pk-1|k-1} (15)
计算容积点(i=1,2,…,m;m=2n):
通过状态方程传播容积点:
估计七时刻的状态预测值:
计算七时刻状态协方差预测值的平方根因子:
②量测更新,融入最新量测数据:
计算容积点(i=1,2,…,m;m=2n):
通过量测方程传播容积点:
zi,k|k-1=h(xi,k|k-1) (23)估计七时刻的量测预测值:
计算新息协方差矩阵的平方根因子:
计算互相关协方差矩阵:
引入渐消因子λk实时估计滤波增益:
计算k时刻的状态估计值:
计算k时刻状态协方差估计值的平方根因子:
Sk|k=Tria([ηk|k-1-Kkζk|k-1 KkSR,k]) (32)
其中,Pk-1|k-1分别为k-1时刻的状态估计值和协方差估计值;Sk-1|k-1为Pk-1|k-1的乔里斯基因子;,[1]i表示集合[1]的第i列,[1]=[enye()n-, ;m=2n为容积点个数(n=8为UUV状态向量的维数);Xi,k-1|k-1、Xi,k|k-1分别为k-1时刻和k时刻的容积点;f(·)、h(·)分别为状态方程和量测方程;zi,k|k-1分别为通过状态方程和量测方程传播后的容积点;SQ,k-1、SR,k分别为Qk-1和Rk的平方根因子; 分别为k时刻的状态预测值和量测预测值;Sk|k-1、Sk|k分别为k时刻状态协方差预测值和估计值的平方根因子;Szz,k|k-1为信息协方差矩阵的平方根因子;Pxz,k|k-1为互相关协方差矩阵;Kk为滤波增益;zk为量测向量。
(4)重新产生粒子
重新产生粒子:
(5)计算粒子重要性权值并归一化
对于i=1,2,…,N,计算重要性权值并归一化。
计算重要性权值:
归一化:
(6)重采样
(7)状态估计
计算状态估计值:
计算协方差估计值:
(8)时刻迭代更新
判断当前时刻k是否为迭代终止时刻。若当前时刻k不是迭代终止时刻,则由当前时刻k更新到下一时刻k+1,重复执行步骤(2)~(8);若当前时刻k是迭代终止时刻,则结束计算。
(9)控制运载体停止运动
下面描述本发明的具体实施例。
通过引用申请人自研无人水下航行器(Unmanned Underwater Vehicle,UUV)于2010年3月在杭州千岛湖完成的湖试试验数据,进一步说明本发明对提高导航精度和稳定性上所带来的有益效果。
(1)湖试条件
UUV采集的传感器数据包括深度计、运动传感器OCTANS、多普勒计程仪(Doppler VelocityLog,DVL)等测量数据,UUV近水面航行且采用全球定位定位系统(Global Positioning System,GPS)记录其航迹。湖试中UUV的运动轨迹大致为五边形,选取其中的1圈试验航段,历时12分30秒。根据上述实测湖试数据,基于强跟踪平方根容积粒子滤波、容积粒子滤波、粒子滤波三种方法进行UUV导航定位试验。
(2)构建UUV离散时间非线性动态系统
如附图2所示,以UUV初始位置和初始艏向角建立全局坐标系L;V是UUV船体坐标系;E为北东坐标系,North方向为地磁北向。x、y为UUV在L中的位置;ψ为UUV在L中的艏向角,显然,其中zψ为采用运动传感器OCTANS测得的UUV艏向角。
①UUV运动模型:
选取一个简单的四自由度、常速动力学模型xk=f(xk-1)+wk-1对UUV的运动过程进行建模:
式中,[x,y,z,ψ]表示UUV在L中的位置和艏向;[u,v,w,r]表示UUV在V中相应的线速度和角速度;k表示任意采样时刻;T为航位推算传感器的采样时间间隔;wk-1为随机系统噪声。
②UUV传感器测量模型:
湖试中,UUV配置了深度计、运动传感器OCTANS和多普勒计程仪DVL。深度计即压力传感器,通过测量水柱压力提供UUV的深度数据;UUV通过OCTANS实时测量其艏向角,即UUV艏艉向与地磁北之间的夹角;DVL可以测量海流速度、对底跟踪速度等,UUV在湖试中使用DVL进行对底跟踪速度的测量。它们提供状态向量中深度、艏向和对底速度的直接测量值,因而量测模型为线性的。本发明选取式(40)的测量模型对UUV的传感器测量进行建模:
zk=Hxk+vk (40)
式中,zk是量测向量, vk是量测噪声,测量矩阵H为:
③通过UUV运动模型和传感器测量模型构建UUV离散时间非线性动态系统:
式中, zk是量测向量;随机系统噪声wk~N(0,Qk),随机量测噪声vk~N(0,Rk),系统初始状态为x0,x0与wk,vk统计独立;非线性函数f(xk-1)和h(xk)为关于状态的一阶连续偏导数:
(3)参数设置
试验参数设置如表1所示:
表1试验参数设置
(4)试验结果及分析
附图3为采用强跟踪平方根容积粒子滤波、容积粒子滤波和粒子滤波三种方法的UUV运行轨迹与GPS真实轨迹的对比曲线。附图4为附图3中矩形区域的局部放大示意图。附图5、附图6分别对应三种滤波方法东向和北向的估计误差。
对比附图3、附图4、附图5和附图6的试验结果,有以下分析结果:
从附图3和附图4试验结果来看,PF的运行轨迹与GPS真实轨迹偏离最大,吻合度最低。STSRCPF的运行轨迹与GPS真实轨迹最接近,吻合度最高。理论上来说,由于考虑了最新量测值,STSRCPF及CPF的估计精度均高于标准PF。同时,对比STSRCPF和CPF,两者都是通过对后验概率密度进行高斯近似而实现系统的状态估计的,而STSRCPF采用具有强跟踪性能的SRCKF设计重要性密度函数,STSRCKF通过引入时变渐消因子和弱化因子,实时修正滤波增益矩阵,实现残差序列正交,确保了滤波器的准确跟踪能力;并通过传播目标状态的均值和协方差的平方根,确保协方差矩阵的对称性和半正定性,从而改进CPF的估计精度和稳定性。因此,理论与试验结果吻合。
附图5和附图6中k为试验迭代步数,试验总迭代过程共1464步。东向/北向的估计误差计算公式:ε=E-T,其中,ε、E和T分别为东向/北向的估计误差、估计值和真实值。显然,东向/北向估计误差绝对值|ε|越小,滤波方法精度越高。根据附图5和附图6,三种方法东向/北向的估计误差曲线呈现相同趋势,但STSRCPF东向/北向估计误差绝对值|ε|一直是最小的,估计精度明显优于CPF和PF。
定义系统导航定位误差模型为:
表2给出UUV总航时为12分30秒时,STSRCPF、CPF和PF的导航定位误差和方法平均运行时间。导航定位精度方面,STSRCPF导航定位误差最小,其导航定位精度优于CPF和PF。在运行时间方面,PF的运行时间最短,STSRCPF运行时间较短,而CPF耗时最长。在兼顾方法精度和运行时间的情况下,相对于CPF和PF,STSRCPF是粒子滤波改进方法的一种较好的权衡选择。
表2导航定位误差和平均运行时间比较
由前述基于UUV湖试数据集的验证结果可见,STSRCPF的导航定位估计精度优于CPF和PF。
Claims (8)
1.一种改进的粒子滤波方法,其特征是:
(1)运载体启动后,选取运载体状态函数及量测函数;
(2)选取渐消因子和弱化因子;
(3)采用STSRCKF设计重要性密度函数;
(4)重新产生粒子;
(5)计算粒子重要性权值并归一化;
(6)重采样;
(7)状态估计;
(8)时刻迭代更新,
判断当前时刻k是否为迭代终止时刻,若当前时刻k不是迭代终止时刻,则由当前时刻k更新到下一时刻k+1,重复执行步骤(2);若当前时刻k是迭代终止时刻,则结束,控制运载体停止运动。
2.根据权利要求1所述的改进的粒子滤波方法,其特征是:所述选取运载体状态函数及量测函数包括:
其中,xk为状态向量,zk为量测向量,f(xk-1)和h(xk)分别为运载体状态函数和量测函数,wk-1为随机系统噪声,且wk-1~N(0,Q),vk为随机量测噪声,且vk~N(0,R);
在初始时刻,即k=0时刻,设定运载体的初始状态 初始状态协方差P0=[0]8×8,系统噪声Q,量测噪声R,并设定粒子数N,重采样阈值Nthreshold,用于求取渐消因子C0,k的初始值C0,0和弱化因子ρ;
3.根据权利要求1所述的改进的粒子滤波方法,其特征是所述选取渐消因子和弱化因子包括:
选取渐消因子λk和弱化因子β如下:
其中,λk为渐消因子,当模型较准确时,λk=1,STSRCKF退化为普通SRCKF;tr(·)为求矩阵的迹;β≥1为弱化因子;Szz,k|k-1为新息协方差矩阵的平方根因子;γk是残差;0<ρ≤1为遗忘因子。
4.根据权利要求1所述的改进的粒子滤波方法,其特征是所述采用STSRCKF设计重要性密度函数包括:
采用STSRCKF方法的时间更新和量测更新更新每个粒子:
①时间更新
Sk-1|k-1=Chol{Pk-1|k-1}
计算容积点,i=1,2,…,m;m=2n:
通过状态方程传播容积点:
估计k时刻的状态预测值:
计算k时刻状态协方差预测值的平方根因子:
②量测更新,融入最新量测数据:
计算容积点,i=1,2,…,m;m=2n:
通过量测方程传播容积点:
zi,k|k-1=h(Xi,k|k-1)
估计k时刻的量测预测值:
计算新息协方差矩阵的平方根因子:
Szz,k|k-1=Tria([ζk|k-1SR,k])
计算互相关协方差矩阵:
引入渐消因子λk实时估计滤波增益:
计算k时刻的状态估计值:
计算k时刻状态协方差估计值的平方根因子:
Sk|k=Tria([ηk|k-1-Kkζk|k-1KkSR,k])
其中,Pk-1|k-1分别为k-1时刻的状态估计值和协方差估计值;Sk-1|k-1为Pk-1|k-1的乔里斯基因子;,[1]i表示集合[1]的第i列,[1]=[enye()n-, ;m=2n为容积点个数,n=8为UUV状态向量的维数;Xi,k-1|k-1、Xi,k|k-1分别为k-1时刻和k时刻的容积点;f(·)、h(·)分别为状态方程和量测方程;zi,k|k-1分别为通过状态方程和量测方程传播后的容积点;SQ,k-1、SR,k分别为Qk-1和Rk的平方根因子; 分别为k时刻的状态预测值和量测预测值;Sk|k-1、Sk|k分别为k时刻状态协方差预测值和估计值的平方根因子;Szz,k|k-1为信息协方差矩阵的平方根因子;Pxz,k|k-1为互相关协方差矩阵;Kk为滤波增益;zk为量测向量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310296086.2A CN103389094B (zh) | 2013-07-15 | 2013-07-15 | 一种改进的粒子滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310296086.2A CN103389094B (zh) | 2013-07-15 | 2013-07-15 | 一种改进的粒子滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103389094A true CN103389094A (zh) | 2013-11-13 |
CN103389094B CN103389094B (zh) | 2017-03-01 |
Family
ID=49533439
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310296086.2A Active CN103389094B (zh) | 2013-07-15 | 2013-07-15 | 一种改进的粒子滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103389094B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103684350A (zh) * | 2013-12-04 | 2014-03-26 | 北京理工大学 | 一种粒子滤波方法 |
CN103856185A (zh) * | 2014-02-17 | 2014-06-11 | 上海大学 | 一种基于fpga的粒子滤波权值处理及重采样方法 |
CN104833981A (zh) * | 2015-05-11 | 2015-08-12 | 西北工业大学 | 基于距离参数化混合坐标系下srckf的纯方位目标跟踪方法 |
CN106323280A (zh) * | 2016-09-22 | 2017-01-11 | 重庆水利电力职业技术学院 | 用于bds和sins导航定位系统的滤波器和滤波方法 |
CN107246873A (zh) * | 2017-07-03 | 2017-10-13 | 哈尔滨工程大学 | 一种基于改进的粒子滤波的移动机器人同时定位与地图构建的方法 |
CN107387064A (zh) * | 2017-07-27 | 2017-11-24 | 河南科技学院 | 一种新的排爆机器人隧进定位方法 |
CN108681614A (zh) * | 2018-03-07 | 2018-10-19 | 南京航空航天大学 | 基于改进高斯粒子滤波的涡扇发动机突变故障诊断方法 |
CN109253727A (zh) * | 2018-06-22 | 2019-01-22 | 东南大学 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
CN109460539A (zh) * | 2018-10-15 | 2019-03-12 | 中国科学院声学研究所 | 一种基于简化容积粒子滤波的目标定位方法 |
CN109492769A (zh) * | 2018-10-31 | 2019-03-19 | 深圳大学 | 一种粒子滤波方法、系统和计算机可读存储介质 |
CN109829938A (zh) * | 2019-01-28 | 2019-05-31 | 杭州电子科技大学 | 一种应用在目标跟踪的自适应容错容积卡尔曼滤波方法 |
CN110765897A (zh) * | 2019-10-08 | 2020-02-07 | 哈尔滨工程大学 | 一种基于粒子滤波的水下目标跟踪方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102980579A (zh) * | 2012-11-15 | 2013-03-20 | 哈尔滨工程大学 | 一种自主水下航行器自主导航定位方法 |
EP2570772A1 (en) * | 2011-09-16 | 2013-03-20 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Method for localisation and mapping of pedestrians or robots using wireless access points |
-
2013
- 2013-07-15 CN CN201310296086.2A patent/CN103389094B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2570772A1 (en) * | 2011-09-16 | 2013-03-20 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Method for localisation and mapping of pedestrians or robots using wireless access points |
CN102980579A (zh) * | 2012-11-15 | 2013-03-20 | 哈尔滨工程大学 | 一种自主水下航行器自主导航定位方法 |
Non-Patent Citations (4)
Title |
---|
孙枫: ""Cubature粒子滤波"", 《系统工程与电子技术》 * |
徐树生: ""强跟踪SRCKF及其在船舶动力定位中的应用"", 《仪器仪表学报》 * |
王眷柏: ""模糊自适应强跟踪卡尔曼滤波器研究"", 《系统工程与电子技术》 * |
穆静: ""容积粒子滤波算法及其应用"", 《西安交通大学学报》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103684350A (zh) * | 2013-12-04 | 2014-03-26 | 北京理工大学 | 一种粒子滤波方法 |
CN103684350B (zh) * | 2013-12-04 | 2016-07-13 | 北京理工大学 | 一种粒子滤波方法 |
CN103856185A (zh) * | 2014-02-17 | 2014-06-11 | 上海大学 | 一种基于fpga的粒子滤波权值处理及重采样方法 |
CN103856185B (zh) * | 2014-02-17 | 2016-08-17 | 上海大学 | 一种基于fpga的粒子滤波权值处理及重采样方法 |
CN104833981A (zh) * | 2015-05-11 | 2015-08-12 | 西北工业大学 | 基于距离参数化混合坐标系下srckf的纯方位目标跟踪方法 |
CN106323280A (zh) * | 2016-09-22 | 2017-01-11 | 重庆水利电力职业技术学院 | 用于bds和sins导航定位系统的滤波器和滤波方法 |
CN107246873A (zh) * | 2017-07-03 | 2017-10-13 | 哈尔滨工程大学 | 一种基于改进的粒子滤波的移动机器人同时定位与地图构建的方法 |
CN107387064A (zh) * | 2017-07-27 | 2017-11-24 | 河南科技学院 | 一种新的排爆机器人隧进定位方法 |
CN108681614A (zh) * | 2018-03-07 | 2018-10-19 | 南京航空航天大学 | 基于改进高斯粒子滤波的涡扇发动机突变故障诊断方法 |
CN109253727A (zh) * | 2018-06-22 | 2019-01-22 | 东南大学 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
CN109253727B (zh) * | 2018-06-22 | 2022-03-08 | 东南大学 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
CN109460539A (zh) * | 2018-10-15 | 2019-03-12 | 中国科学院声学研究所 | 一种基于简化容积粒子滤波的目标定位方法 |
CN109460539B (zh) * | 2018-10-15 | 2020-05-26 | 中国科学院声学研究所 | 一种基于简化容积粒子滤波的目标定位方法 |
CN109492769A (zh) * | 2018-10-31 | 2019-03-19 | 深圳大学 | 一种粒子滤波方法、系统和计算机可读存储介质 |
CN109829938A (zh) * | 2019-01-28 | 2019-05-31 | 杭州电子科技大学 | 一种应用在目标跟踪的自适应容错容积卡尔曼滤波方法 |
CN110765897A (zh) * | 2019-10-08 | 2020-02-07 | 哈尔滨工程大学 | 一种基于粒子滤波的水下目标跟踪方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103389094B (zh) | 2017-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103389094A (zh) | 一种改进的粒子滤波方法 | |
CN111985093B (zh) | 一种带噪声估计器的自适应无迹卡尔曼滤波状态估计方法 | |
CN102980579B (zh) | 一种自主水下航行器自主导航定位方法 | |
Zhang | A fusion methodology to bridge GPS outages for INS/GPS integrated navigation system | |
CN109724599B (zh) | 一种抗野值的鲁棒卡尔曼滤波sins/dvl组合导航方法 | |
Jwo et al. | Adaptive fuzzy strong tracking extended Kalman filtering for GPS navigation | |
Chen et al. | A hybrid prediction method for bridging GPS outages in high-precision POS application | |
CN105180935B (zh) | 一种适用于gnss微弱信号的组合导航数据融合方法 | |
Chiang et al. | Multisensor integration using neuron computing for land-vehicle navigation | |
Jwo et al. | A practical note on evaluating Kalman filter performance optimality and degradation | |
CN102568004A (zh) | 一种高机动目标跟踪算法 | |
CN103217175A (zh) | 一种自适应容积卡尔曼滤波方法 | |
CN110749891B (zh) | 一种可估计未知有效声速的自适应水下单信标定位方法 | |
CN104112079A (zh) | 一种模糊自适应变分贝叶斯无迹卡尔曼滤波方法 | |
CN112525218A (zh) | 一种ins/dvl组合导航系统鲁棒智能协同校准方法 | |
CN103308896A (zh) | 一种适于非引擎机动目标的高精度跟踪方法 | |
Lavis et al. | Dynamic space reconfiguration for Bayesian search and tracking with moving targets | |
CN108983271A (zh) | 基于rtk-gps/ins列车组合定位方法 | |
CN110794409A (zh) | 一种可估计未知有效声速的水下单信标定位方法 | |
CN111913175A (zh) | 一种传感器短暂失效下带补偿机制的水面目标跟踪方法 | |
CN110989341A (zh) | 一种约束辅助粒子滤波方法及目标跟踪方法 | |
Zhang et al. | Novel improved UKF algorithm and its application in AUV navigation system | |
Liu et al. | Navigation algorithm based on PSO-BP UKF of autonomous underwater vehicle | |
Sustika et al. | Nonlinear-filtering with interacting multiple-model algorithm for coastal radar target tracking system | |
CN112986977A (zh) | 一种克服雷达扩展卡尔曼航迹滤波发散的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |