CN113850009A - 一种基于椭圆rhm的标签粒子多扩展目标跟踪方法 - Google Patents
一种基于椭圆rhm的标签粒子多扩展目标跟踪方法 Download PDFInfo
- Publication number
- CN113850009A CN113850009A CN202010598717.6A CN202010598717A CN113850009A CN 113850009 A CN113850009 A CN 113850009A CN 202010598717 A CN202010598717 A CN 202010598717A CN 113850009 A CN113850009 A CN 113850009A
- Authority
- CN
- China
- Prior art keywords
- particle
- tag
- target
- label
- time
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
- G06F30/25—Design optimisation, verification or simulation using particle-based methods
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0294—Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/12—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves by co-ordinating position lines of different shape, e.g. hyperbolic, circular, elliptical or radial
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种基于椭圆RHM的标签粒子多扩展目标跟踪方法,步骤包括:建立增广空间,并初始化标签粒子集;进行量测划分,并根据量测划分单元及其中的量测进行新生标签粒子补入,并与存活标签粒子集合并;根据预测方程与似然方程对合并生成的标签粒子集进行预测和更新;对更新后的标签粒子集进行标签处理,得到多扩展目标数目估计、多扩展目标状态估计与航迹关联;对经过标签处理后的标签粒子子集进行重采样之后进入下一时刻的扩展目标质心状态及其形状估计。本发明的方法运算速度快,跟踪精度高,不仅能够准确估计多扩展目标质心状态及形状,还可以获得目标航迹,区分不同目标。
Description
技术领域
本发明属于信息融合技术领域,具体涉及一种基于椭圆RHM的标签粒子多扩展目标跟踪方法。
背景技术
目标跟踪是通过一系列滤波算法处理雷达和其他传感器获得的目标量测信息,以计算目标当前运动状态、目标数量及其扩展形状等。目标跟踪与现实生活密切相关,在日常生活中广泛应用,在民用领域和军事领域具有重要应用价值,做出了突出贡献。
在跟踪过程中,若每个时刻传感器的感知单元最多捕获到每个目标的一个测量值,将目标抽象为点目标,即点目标跟踪,是目标跟踪发展的基础。随着传感器分辨率的大幅度提高,高分辨率传感器收集目标量测时会捕捉到同一个目标产生的多个量测,这种在每个时刻产生多个量测的目标称为扩展目标(Extended Target,ET)。扩展目标具有一定的形状,不能当作点目标进行处理。扩展目标因其特有的形状、大小以及运动方向等信息,在军用、民用领域具有重要的应用需求和现实意义,提出后迅速成为热点研究方向。
目前多目标跟踪方法主要分为两类:传统的基于数据关联的多目标跟踪方法以及基于随机有限集(Random Finite Set,RFS)的多目标跟踪方法。在传统多目标跟踪方法中,通过数据关联将目标量测与目标一一对应,将多目标跟踪转化为单目标跟踪问题,不仅计算量大、效率低,当目标数目较多时很传统方法很可能产生组合***的情况。基于RFS的多目标跟踪方法将多目标状态以及量测分别建模为随机有限集,并且集合内的元素无序,元素数目随机,避免了数据关联,促进了多目标跟踪算法的迅速发展。对于扩展目标,可以用椭圆随机超曲面模型(Random Hypersurface Model,RHM)将其建模为椭圆形状,但是目前基于椭圆RHM的多扩展目标无法实现航迹跟踪。
发明内容
为了解决现有技术中存在的上述问题,本发明提供了一种基于椭圆RHM的标签粒子多扩展目标跟踪方法。本发明要解决的技术问题通过以下技术方案实现:
本发明提供了一种基于椭圆RHM的标签粒子多扩展目标跟踪方法,包括:
S1:在初始时刻,对每个目标分配L0个标签粒子,对所述目标进行初始状态采样,得到初始化标签粒子集;
所述初始化标签粒子集为:
S2:根据上一时刻的重采样标签粒子集,得到存活标签粒子集,对所述目标的量测进行划分,得到m个划分单元,对每个划分单元中的每个量测补入M个新生标签粒子,得到新生标签粒子集,其中,对同一划分单元中的量测采样的粒子分配相同的标签,对不同划分单元中的量测采样的粒子分配不同的标签;
S3:将所述新生标签粒子集和所述存活标签粒子集进行合并,得到新的标签粒子集;
S4:根据预测方程和似然函数,对所述新的标签粒子集进行预测和更新,得到更新后的标签粒子集,其中,在预测和更新过程中,粒子数目及其标签保持不变;
S5:根据不同的目标标识将所述更新后的标签粒子集划分为若干个子集,获取每个子集的粒子权值和,将所述粒子权值和与预设的门限值比较,根据比较结果,得到经过标签处理的标签粒子集;
S6:根据所述经过标签处理的标签粒子集,获取扩展目标的状态估计集,根据所述扩展目标的状态估计集,得到多扩展目标航迹;
S7:对所述经过标签处理的标签粒子集进行重采样处理,得到重采样标签粒子集。
在本发明的一个实施例中,在所述步骤S1中,对所述目标进行状态采样,包括对所述目标的质心运动参数[mxk myk vxk vyk]T和形状参数[ak,bk,φk]同时进行随机采样,其中,
[mxk myk vxk vyk]T为k时刻的质心运动参数,mxk,myk分别表示k时刻质心在x,y轴的坐标,vxk,vyk分别表示k时刻质心在x,y轴方向的速度,ak、bk分别表示k时刻椭圆的长轴和短轴,φk表示k时刻椭圆长轴与x轴之间的夹角。
在本发明的一个实施例中,所述步骤S2包括:
2a.根据上一时刻的重采样标签粒子集,得到存活标签粒子集,所述存活标签粒子集为:
其中,表示k-1时刻第i个存活粒子的状态向量,表示k-1时刻第i个存活粒子的权重,表示k-1时刻第i个存活粒子的标签,表示k-1时刻的存活粒子的标签集,Lk-1表示k-1时刻的存活标签粒子数目,Nk-1表示k-1时刻的目标估计数目;
其中,Pb(·)表示新生目标强度;
在本发明的一个实施例中,所述步骤S3包括:对所述新生标签粒子集和所述存活标签粒子集求并集,得到所述新的标签粒子集,所述新的标签粒子集为:
所述新的标签粒子集的标签粒子数目为:
所述新的标签粒子集的标签集为:
在本发明的一个实施例中,所述步骤S4包括:
4a.根据预测方程对所述新的标签粒子集进行状态预测,得到预测处理后的标签粒子集,其中,
所述预测方程为:
在预测过程中,粒子数目及其标签保持不变:
在本发明的一个实施例中,所述步骤S5包括:
5a.根据不同的目标标识θn将所述更新后的标签粒子集划分为若干个子集:
所述经过标签处理的标签粒子集为:
其中,Lk表示标签处理后的标签粒子数目;
k时刻扩展目标的数目为:
k时刻扩展目标的标签集为:
在本发明的一个实施例中,所述步骤S6包括:
6a.将所述经过标签处理的标签粒子集的每一个子集的标签粒子状态加权平均得到该扩展目标的状态估计结果,
所述扩展目标的状态估计结果为:
6c.在滤波过程中,根据所述扩展目标的状态估计集,将具有相同目标标识的估计结果连接起来,用不同的图标或者颜色表示不同的目标标识,得到所述多扩展目标航迹。
在本发明的一个实施例中,所述步骤S7包括:
对所述经过标签处理的标签粒子集的每一个子集,进行重采样得到所述重采样标签粒子集:
与现有技术相比,本发明的有益效果在于:
本发明的基于椭圆RHM的标签粒子多扩展目标跟踪方法,基于RFS,用椭圆随机超曲面模型(Random Hypersurface Model,RHM)对扩展目标形状进行建模,在新的多扩展目标新生标签粒子补入方法的基础上,提出基于椭圆RHM的标签粒子多扩展目标跟踪方法,该方法运算速度快,跟踪精度高,不仅能够准确估计多扩展目标质心状态及形状,还可以获得目标航迹,区分不同目标。
上述说明仅是本发明技术方案的概述,为了能够更清楚了解本发明的技术手段,而可依照说明书的内容予以实施,并且为了让本发明的上述和其他目的、特征和优点能够更明显易懂,以下特举较佳实施例,并配合附图,详细说明如下。
附图说明
图1是本发明实施例提供的椭圆随机超曲面及其量测模型图;
图2是本发明实施例提供的一种基于椭圆RHM的标签粒子多扩展目标跟踪方法的流程框图;
图3是本发明实施例提供的一种基于椭圆RHM的标签粒子多扩展目标跟踪方法的流程实现图;
图4是本发明实施例提供的一种仿真实验的扩展目标质心运动轨迹及其真实形状示意图;
图5是本发明实施例提供的一种仿真实验的扩展目标量测图
图6是本发明实施例提供的ET-LP-PHD一次估计结果示意图;
图7是本发明实施例提供的一种仿真扩展目标的平均数目估计图;
图8是本发明实施例提供的一种扩展目标质心平均OSPA距离示意图;
图9是本发明实施例提供的一种扩展目标的估计椭圆形状的长轴、短轴和朝向角的OSPA距离的示意图。
具体实施方式
为了进一步阐述本发明为达成预定发明目的所采取的技术手段及功效,以下结合附图及具体实施方式,对依据本发明提出的一种基于椭圆RHM的标签粒子多扩展目标跟踪方法进行详细说明。
有关本发明的前述及其他技术内容、特点及功效,在以下配合附图的具体实施方式详细说明中即可清楚地呈现。通过具体实施方式的说明,可对本发明为达成预定目的所采取的技术手段及功效进行更加深入且具体地了解,然而所附附图仅是提供参考与说明之用,并非用来对本发明的技术方案加以限制。
本发明的基于椭圆RHM的标签粒子多扩展目标跟踪方法,是基于椭圆RHM的多扩展目标标签粒子PHD(Extended Target Labeled Particle PHD,ET-LP-PHD)滤波算法的,首先对椭圆随机超曲面进行简单介绍。
请参见图1,图1是本发明实施例提供的椭圆随机超曲面及其量测模型图。如图所示,
椭圆的目标状态向量x由质心运动参数和目标形状参数两部分组成:
x=[mx my vx vy a b φ]T (1),
其中,[mx my vx vy]T表示质心运动状态,mx,my分别表示质心在x,y轴的坐标,vx,vy分别表示质心在x,y轴方向的速度,a、b分别表示椭圆的长轴和短轴,φ表示椭圆朝向角,也就是椭圆的长轴与x轴间的夹角,规定逆时针为正方向。为了便于计算,将椭圆方程写为极坐标形式:
量测源在真实形状的缩小版本上,则椭圆RHM上的量测源为:
y=m+s·R(θ;a,b,φ)e (3),
e=[cosθ sinθ]T (4),
其中,s表示缩放因子,m表示椭圆质心,e表示极坐标系到直角坐标系的转换向量,对于未知参数θ,用量测到椭圆质心的向量与x轴间的夹角代替。
椭圆RHM上的量测源产生的量测为:
z=m+s·R(θ;a,b,φ)e+v (5),
其中,v表示加性噪声。
实施例一
请结合参见图2和图3,图2是本发明实施例提供的一种基于椭圆RHM的标签粒子多扩展目标跟踪方法的流程框图;图3是本发明实施例提供的一种基于椭圆RHM的标签粒子多扩展目标跟踪方法的流程实现图。如图所示,本实施例的基于椭圆RHM的标签粒子多扩展目标跟踪方法,包括:
S1:在初始时刻,对每个目标分配L0个标签粒子,对目标初始状态进行采样,得到初始化标签粒子集;
初始化标签粒子集为:
在本实施例中,对目标进行状态采样,包括对目标的质心运动参数[mxk myk vxkvyk]T和形状参数[ak,bk,φk]同时进行随机采样,其中,
[mxk myk vxk vyk]T为k时刻的质心运动参数,mxk,myk分别表示k时刻质心在x,y轴的坐标,vxk,vyk分别表示k时刻质心在x,y轴方向的速度,ak、bk分别表示k时刻椭圆的长轴和短轴,φk表示k时刻椭圆长轴与x轴之间的夹角。
S2:根据上一时刻的重采样标签粒子集,得到存活标签粒子集,对目标的量测进行划分,得到m个划分单元,对每个划分单元中的每个量测补入M个新生标签粒子,得到新生标签粒子集,其中,对同一划分单元中的量测采样的粒子分配相同的标签,对不同划分单元中的量测采样的粒子分配不同的标签;
具体地,步骤S2包括:
2a.根据上一时刻的重采样标签粒子集,得到存活标签粒子集,在本实施例中,假设k-1时刻的存活标签粒子集为:
其中,表示k-1时刻第i个存活粒子的状态向量,表示k-1时刻第i个存活粒子的权重,表示k-1时刻第i个存活粒子的标签,表示k-1时刻的存活粒子的标签集,Lk-1表示k-1时刻的存活标签粒子数目,Nk-1表示k-1时刻的目标估计数目;
其中,Pb(·)表示新生目标强度,在本实施例中,新生目标强度设置为0.01;
S3:将新生标签粒子集和存活标签粒子集进行合并,得到新的标签粒子集;
具体地,包括,对新生标签粒子集和存活标签粒子集求并集,得到新的标签粒子集为:
新的标签粒子集的标签粒子数目为:
新的标签粒子集的标签集为:
S4:根据预测方程和似然函数,对新的标签粒子集进行预测和更新,得到更新后的标签粒子集,其中,在预测和更新过程中,粒子数目及其标签保持不变;
具体地,步骤S4包括:
4a.根据预测方程对新的标签粒子集进行状态预测,得到预测处理后的标签粒子集,其中,
预测方程为:
在预测过程中,粒子数目及其标签保持不变:
具体地,对根据当前量测及似然函数对预测处理后的标签粒子集进行更新,进行具体说明如下:
单扩展目标量测似然函数为:
则式(18)可以写为:
式(20)在椭圆RHM框架下的闭合形式为:
其中,
b k=zk-mk (28),
θk=arctan(zky-mky,zkx-mkx) (29),
其中,式中,ak,bk,φk表示椭圆形状参数,θk表示量测到质心与x轴形成的夹角,zk表示量测,mk表示椭圆质心,zky,mky分别表示量测和质心的y轴坐标,zkx,mkx分别表示量测和质心的x轴坐标。
为了便于计算,将式(21)表示的似然函数化为对数形式:
其对数形式为:
根据多扩展目标量测似然函数,更新为多目标预测PHD与量测伪似然函数相乘:
Dk(x|Zk)=LZ(x)Dk|k-1(x|Zk-1) (33),
其中,Dk|k-1(x|Zk-1)表示多目标预测PHD。
S5:根据不同的目标标识将更新后的标签粒子集划分为若干个子集,获取每个子集的粒子权值和,将粒子权值和与预设的门限值比较,根据比较结果,得到经过标签处理的标签粒子集;
具体地,步骤S5包括:
5a.根据不同的目标标识θn将更新后的标签粒子集划分为若干个子集:
经过标签处理的标签粒子集为:
其中,Lk表示标签处理后的标签粒子数目;
k时刻扩展目标的数目为:
k时刻扩展目标的标签集为:
S6:根据经过标签处理的标签粒子集,获取扩展目标的状态估计集,根据扩展目标的状态估计集,得到多扩展目标航迹;
具体地,步骤S6包括:
6a.将经过标签处理的标签粒子集的每一个子集的标签粒子状态加权平均得到该扩展目标的状态估计结果,
扩展目标的状态估计结果为:
6c.在滤波过程中,根据扩展目标的状态估计集,将具有相同目标标识的估计结果连接起来,用不同的图标或者颜色表示不同的目标标识,得到多扩展目标航迹。
由于扩展目标的状态估计集中含有目标标识,因此不同的目标可以用相应的目标标识进行区分。
S7:对经过标签处理的标签粒子集进行重采样处理,得到重采样标签粒子集。
具体地,步骤S7包括:
对经过标签处理的标签粒子集的每一个子集,进行重采样得到重采样标签粒子集:
在步骤S5中,获得了经过标签处理的标签粒子集为:
根据式(43),得到重采样标签粒子集。
在本实施例中,重采样过程为,在由目标标识区分的各个标签粒子子集中复制权重较大的粒子,舍弃权值较小的粒子。重采样标签粒子集作为步骤S2中的存活标签粒子集。
本实施例的基于椭圆RHM的标签粒子多扩展目标跟踪方法,基于RFS,用椭圆随机超曲面模型对扩展目标形状进行建模,在新的多扩展目标新生标签粒子补入方法的基础上,提出基于椭圆RHM的标签粒子多扩展目标跟踪方法,该方法运算速度快,跟踪精度高,不仅能够准确估计多扩展目标质心状态及形状,还可以获得目标航迹,区分不同目标。
实施例二
本实施例结合MATLAB仿真实验对实施例一的基于椭圆RHM的标签粒子多扩展目标跟踪方法的多扩展目标跟踪效果进行说明。
在本实施例的仿真实验中,跟踪目标为匀速直线运动目标。观测场景为二维平面区域,大小为[-600,600]×[-600,600](m2),并在观测区域中增加随机噪声作为真实场景的模拟,设计初始位置、大小、运动方向各异的多个椭圆形扩展目标在观测区域内进行匀速直线运动。各扩展目标的初始状态、形状参数以及存活时间如表1所示。
表1各扩展目标的初始状态、形状参数及存活时间
从表1可以看出,扩展目标1从初始时刻开始运动,第5s时扩展目标2出现,第15s时,扩展目标1与扩展目标2相交,第20s时,扩展目标3出现在仿真场景中,同时,扩展目标4由扩展目标2***产生,由第30s时,扩展目标3并入扩展目标1中。
观测区域中所有扩展目标运动模型均为CV模型,扩展目标泊松率为15,且目标量测均匀分布在目标扩散范围内,杂波泊松率为5,均匀地分布在观测区域中。比例因子的分布为采样时间间隔为Ts=1s,目标存活概率为PS=0.99,目标新生概率为Pb=0.01,检测概率为PD=0.99,OSPA距离参数为c=100,p=2。在ET-LP-PHD滤波算法中,初始时刻对每个目标用L0=600个粒子采样,新生粒子设置为M=60。扩展目标状态向量为包含运动参数和形状参数的七维矢量,状态方程和量测方程分别为:
xk=Fkxk-1+vk (45),
zk=Hxk+wk (46),
其中,Fk表示状态转移矩阵,vk表示协方差为Qk的状态噪声,H表示量测矩阵,wk表示协方差为Rk的量测噪声,参数取值如下:
请结合参见图4和图5,图4是本发明实施例提供的一种仿真实验的扩展目标质心运动轨迹及其真实形状示意图,图5是本发明实施例提供的一种仿真实验的扩展目标量测图。图4中“·”表示扩展目标质心,椭圆表示扩展目标真实扩展形状。图5中“×”表示各个扩展目标产生的量测。
请参见图6,图6是本发明实施例提供的ET-LP-PHD一次估计结果示意图。如图所示,不同扩展目标估计质心用不同的图标表示,具体为:1-14s扩展目标1的估计质心和形状分别用“·”和椭圆表示,15s时两个扩展目标相交,扩展目标2被检测到而扩展目标1漏检,16s扩展目标1被检测到,其标签改变,对应的用“o”和椭圆表示其质心和扩展形状,“×”和椭圆表示扩展目标2的估计质心和形状,“*”和椭圆表示扩展目标3的估计质心及形状,“+”和椭圆表示扩展目标4的估计质心和形状。因此可以看出,ET-LP-PHD在获得扩展目标质心、形状估计的基础上,可以区分不同目标,形成目标航迹。
请参见图7,图7是本发明实施例提供的一种仿真扩展目标的平均数目估计图。图中为100次蒙特卡洛仿真扩展目标数目估计的平均值,从图中可以看出,第15s时,由于两个目标交叉,出现漏估的情况,第20s时,同时出现新生目标和衍生目标,由于衍生目标在前一时刻的量测附近产生,因此可以预测到衍生目标。在ET-LP-PHD算法中,当具有相同标签的粒子子集的权重和大于阈值η时,认为目标存活或者目标新生,对这些标签粒子子集中的粒子权重求和得到目标估计数目,因此ET-LP-PHD滤波算法对目标数目的估计值略小于真实数目,但仍能够准确地估计扩展目标数目。
请结合参见图8和图9,图8是本发明实施例提供的一种扩展目标质心平均OSPA距离示意图,图9是本发明实施例提供的一种扩展目标的估计椭圆形状的长轴、短轴和朝向角的OSPA距离的示意图。从图8中可以看出,本发明的方法可以准确地估计扩展目标质心。第5s和第20s,由于新生扩展目标的出现,OSPA距离出现峰值,第15s,由于扩展目标交叉出现漏检,OSPA距离出现峰值。从图9中可以看出,基于新的扩展目标新生标签粒子补入方法的ET-LP-PHD滤波算法可以很好的估计扩展目标形状。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明的保护范围。
Claims (8)
1.一种基于椭圆RHM的标签粒子多扩展目标跟踪方法,其特征在于,包括:
S1:在初始时刻,对每个目标分配L0个标签粒子,对所述目标初始状态进行采样,得到初始化标签粒子集;
所述初始化标签粒子集为:
S2:根据上一时刻的重采样标签粒子集,得到存活标签粒子集,对所述目标的量测进行划分,得到m个划分单元,对每个划分单元中的每个量测补入M个新生标签粒子,得到新生标签粒子集,其中,对同一划分单元中的量测采样的粒子分配相同的标签,对不同划分单元中的量测采样的粒子分配不同的标签;
S3:将所述新生标签粒子集和所述存活标签粒子集进行合并,得到新的标签粒子集;
S4:根据预测方程和似然函数,对所述新的标签粒子集进行预测和更新,得到更新后的标签粒子集,其中,在预测和更新过程中,粒子数目及其标签保持不变;
S5:根据不同的目标标识将所述更新后的标签粒子集划分为若干个子集,获取每个子集的粒子权值和,将所述粒子权值和与预设的门限值比较,根据比较结果,得到经过标签处理的标签粒子集;
S6:根据所述经过标签处理的标签粒子集,获取扩展目标的状态估计集,根据所述扩展目标的状态估计集,得到多扩展目标航迹;
S7:对所述经过标签处理的标签粒子集进行重采样处理,得到重采样标签粒子集。
2.根据权利要求1所述的方法,其特征在于,在所述步骤S1中,对所述目标进行状态采样,包括对所述目标的质心运动参数[mxk myk vxk vyk]T和形状参数[ak,bk,φk]同时进行随机采样,其中,
[mxk myk vxk vyk]T为k时刻的质心运动参数,mxk,myk分别表示k时刻质心在x,y轴的坐标,vxk,vyk分别表示k时刻质心在x,y轴方向的速度,ak、bk分别表示k时刻椭圆的长轴和短轴,φk表示k时刻椭圆长轴与x轴之间的夹角。
3.根据权利要求1所述的方法,其特征在于,所述步骤S2包括:
2a.根据上一时刻的重采样标签粒子集,得到存活标签粒子集,所述存活标签粒子集为:
其中,表示k-1时刻第i个存活粒子的状态向量,表示k-1时刻第i个存活粒子的权重,表示k-1时刻第i个存活粒子的标签,表示k-1时刻的存活粒子的标签集,Lk-1表示k-1时刻的存活标签粒子数目,Nk-1表示k-1时刻的目标估计数目;
其中,Pb(·)表示新生目标强度;
6.根据权利要求1所述的方法,其特征在于,所述步骤S5包括:
5a.根据不同的目标标识θn将所述更新后标签粒子集划分为若干个子集:
所述经过标签处理的标签粒子集为:
其中,Lk表示标签处理后的标签粒子数目;
k时刻扩展目标的数目为:
k时刻扩展目标的标签集为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010598717.6A CN113850009B (zh) | 2020-06-28 | 2020-06-28 | 一种基于椭圆rhm的标签粒子多扩展目标跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010598717.6A CN113850009B (zh) | 2020-06-28 | 2020-06-28 | 一种基于椭圆rhm的标签粒子多扩展目标跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113850009A true CN113850009A (zh) | 2021-12-28 |
CN113850009B CN113850009B (zh) | 2022-09-09 |
Family
ID=78972615
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010598717.6A Active CN113850009B (zh) | 2020-06-28 | 2020-06-28 | 一种基于椭圆rhm的标签粒子多扩展目标跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113850009B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106019253A (zh) * | 2016-05-19 | 2016-10-12 | 西安电子科技大学 | 基于箱粒子cphd的多扩展目标跟踪方法 |
CN106054167A (zh) * | 2016-05-27 | 2016-10-26 | 西安电子科技大学 | 基于强度滤波器的多扩展目标跟踪方法 |
CN107677997A (zh) * | 2017-09-28 | 2018-02-09 | 杭州电子科技大学 | 基于GLMB滤波和Gibbs采样的扩展目标跟踪方法 |
-
2020
- 2020-06-28 CN CN202010598717.6A patent/CN113850009B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106019253A (zh) * | 2016-05-19 | 2016-10-12 | 西安电子科技大学 | 基于箱粒子cphd的多扩展目标跟踪方法 |
CN106054167A (zh) * | 2016-05-27 | 2016-10-26 | 西安电子科技大学 | 基于强度滤波器的多扩展目标跟踪方法 |
CN107677997A (zh) * | 2017-09-28 | 2018-02-09 | 杭州电子科技大学 | 基于GLMB滤波和Gibbs采样的扩展目标跟踪方法 |
Non-Patent Citations (2)
Title |
---|
曹倬等: "基于标签随机有限集滤波器的多扩展目标跟踪算法", 《***工程与电子技术》 * |
李翠芸等: "基于Mean Shift迭代的新生未知多扩展目标跟踪", 《控制与决策》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113850009B (zh) | 2022-09-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107677997B (zh) | 基于GLMB滤波和Gibbs采样的扩展目标跟踪方法 | |
CN104730511B (zh) | 星凸模型下的势概率假设密度多扩展目标跟踪方法 | |
CN107102295A (zh) | 基于glmb滤波的多传感器tdoa无源定位方法 | |
CN107300698B (zh) | 一种基于支持向量机的雷达目标航迹起始方法 | |
CN107703480B (zh) | 基于机器学习的混合核函数室内定位方法 | |
CN106599368B (zh) | 基于改进粒子提议分布和自适应粒子重采样的FastSLAM方法 | |
KR101912233B1 (ko) | 물체의 위치를 결정하기 위한 시스템 및 방법 | |
CN111722214B (zh) | 雷达多目标跟踪phd实现方法 | |
CN110503071A (zh) | 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法 | |
CN106054167B (zh) | 基于强度滤波器的多扩展目标跟踪方法 | |
CN109195110B (zh) | 基于层次聚类技术和在线极限学习机的室内定位方法 | |
CN108764157B (zh) | 基于法向量高斯分布的建筑物激光脚点提取方法及*** | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及*** | |
CN115204212A (zh) | 一种基于stm-pmbm滤波算法的多目标跟踪方法 | |
CN108320302B (zh) | 基于随机超曲面的CBMeMBer多目标跟踪方法 | |
CN114236480A (zh) | 一种机载平台传感器***误差配准算法 | |
CN113850009B (zh) | 一种基于椭圆rhm的标签粒子多扩展目标跟踪方法 | |
CN109509207A (zh) | 一种对点目标和扩展目标进行无缝跟踪的方法 | |
CN106772357B (zh) | 信噪比未知条件下的ai-phd滤波器多目标跟踪方法 | |
CN113409363B (zh) | 一种基于bp-pmbm滤波算法的多目标跟踪方法 | |
CN111274529B (zh) | 一种鲁棒的高斯逆威沙特phd多扩展目标跟踪算法 | |
CN116224320B (zh) | 一种极坐标系下处理多普勒量测的雷达目标跟踪方法 | |
CN116184512A (zh) | 一种基于磁矩不变量的矢量传感器网络实时定位方法及*** | |
CN111811515B (zh) | 一种基于高斯混合概率假设密度滤波器的多目标航迹提取方法 | |
Liu et al. | Asynchronous multi-sensor fusion multi-target tracking method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |