CN108717702B - 基于分段rts的概率假设密度滤波平滑方法 - Google Patents

基于分段rts的概率假设密度滤波平滑方法 Download PDF

Info

Publication number
CN108717702B
CN108717702B CN201810373957.9A CN201810373957A CN108717702B CN 108717702 B CN108717702 B CN 108717702B CN 201810373957 A CN201810373957 A CN 201810373957A CN 108717702 B CN108717702 B CN 108717702B
Authority
CN
China
Prior art keywords
target
moment
hypothesis density
time
gaussian
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.)
Expired - Fee Related
Application number
CN201810373957.9A
Other languages
English (en)
Other versions
CN108717702A (zh
Inventor
陈金广
王星辉
马丽丽
张馨东
巩林明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xian Polytechnic University
Original Assignee
Xian Polytechnic University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Xian Polytechnic University filed Critical Xian Polytechnic University
Priority to CN201810373957.9A priority Critical patent/CN108717702B/zh
Publication of CN108717702A publication Critical patent/CN108717702A/zh
Application granted granted Critical
Publication of CN108717702B publication Critical patent/CN108717702B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/207Analysis of motion for motion estimation over a hierarchy of resolutions
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T5/00Image enhancement or restoration
    • G06T5/70Denoising; Smoothing
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/277Analysis of motion involving stochastic approaches, e.g. using Kalman filters
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30241Trajectory

Landscapes

  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明公开了一种基于分段RTS的概率假设密度滤波平滑方法,将概率假设密度(PHD)滤波器和RTS平滑器相结合,提出了基于RTS的概率假设密度滤波平滑算法。考虑到在平滑过程中存在较大的输出延迟问题,采用分段思想,提出了分段RTS的概率假设密度滤波平滑方法。首先,对需要平滑的估计值进行分段;其次,采用匈牙利算法进行航迹‑估计关联;最后,对关联后的估计值逐段进行RTS平滑。本发明基于分段RTS的概率假设密度滤波平滑方法与PHD滤波结果相比,能够更加精确地估计目标状态,并且可以有效避免直接应用RTS平滑造成的实时性欠佳问题。

Description

基于分段RTS的概率假设密度滤波平滑方法
技术领域
本发明属于多目标跟踪领域,具体涉及一种基于分段RTS的概率假设密度滤波平滑方法。该方法能够更加精确的估计目标状态,同时可以改善直接使用RTS平滑造成的实时性欠佳的问题,可用于交通管制,机器人、视频监控等方面。
背景技术
多目标跟踪是指将传感器接收到的量测信息与先验知识相结合,对目标的运动进行实时预测、估计,识别目标属性,分析目标意图和势态估计,以此达到目标估计与跟踪的目的。目前,目标跟踪技术应用较为广泛如:1.视频监控领域:可利用摄像头对监控区域内的人或物进行跟踪,尤其是对犯罪嫌疑人的检测与跟踪,并进行轨迹分析与行为分析,以帮助解析案情。2.智能交通管理领域:无论是空中航道、公路还是海洋线路,都可以通过对交通工具的轨迹估计与预测,来确保交通安全。3.机器人视觉-人机交互领域:将目标跟踪技术与模式识别、图像处理等知识相结合,使得机器人可以对人体做出的一些指令进行识别并做出相应的反应。4.军事领域:在现代化战争中,通过处理雷达接收到的数据,估计出目标位置,进行火力攻击或者是对敌方的攻击做出预警、防御或反击。
Mahler提出的基于随机有限集(Random finite set,RFS)理论的概率假设密度(Probability hypothesis density,PHD)滤波方法,是一种全新的多目标跟踪方法,该方法通过传递多目标后验概率密度的一阶统计矩(PHD),来近似求解多目标跟踪问题,成为学术界研究的热点。Vo等给出了PHD滤波器的两种实现方法,分别是序贯蒙特卡罗PHD(Sequential MonteCarlo PHD,SMC-PHD)滤波器和高斯混合PHD(Gaussian Mixture PHD,GM-PHD)滤波器。由于PHD滤波器仅传递的是一阶多目标矩,丢失了高阶势分布信息,从而导致当目标数目较多时,对目标数目的估计具有不确定性,基于此,Mahler等人提出了势概率假设密度(Cardinalized Probability Hypothesis Density,CPHD)滤波算法,该算法不仅传递PHD,同时传递目标数目的势分布信息,提高了多目标估计的精度,2007年Vo等给出了势概率假设密度滤波算法在线性高斯条件下的解析解,即高斯混合势概率假设密度(Gaussian Mixture Cardinalized Probability Hypothesis Density,GM-CPHD)滤波算法,该算法较传统的GM-PHD滤波效果要好,但该算法的时间复杂度较大。
为了改善滤波效果,可通过平滑对状态向量做进一步处理,以此提高精度。最优平滑主要包括固定点平滑,固定区间平滑和固定滞后平滑。理论上讲,固定点平滑技术适合于利用后验数据对某些特殊点进行状态估计,而固定区间平滑则适合于利用后验数据对一固定区间的所有点进行估计。固定区间平滑通常包括前后向平滑算法和RTS(Rauch-Tung-Striebel)平滑算法。前后向平滑算法由前向平滑器和后向滤波器组成,前向平滑器用于获得固定时刻的后验估计和协方差,后向滤波器用于获得固定时刻的先验估计和协方差,然后将获得的前后向估计和协方差相结合得到固定时刻最终的滤波结果。RTS平滑算法包括前向滤波和逆向平滑两个过程。首先进行前向滤波,滤波结束后根据得到的滤波值进行逆向平滑,以此获得各个时刻的滤波结果。目前的研究集中在采用前后向平滑算法改善PHD滤波效果,但没有发现采用RTS改善PHD滤波效果的报道。
发明内容
本发明的目的在于提供一种基于分段RTS的概率假设密度滤波平滑方法,将RTS平滑方法应用于概率假设密度滤波器中,提供了一种能够更加精度估计目标状态的平滑方法,同时采用分段思想,避免了在滤波过程中直接应用RTS平滑造成的实时性欠佳的问题。
本发明所采用的技术方案是,基于分段RTS的概率假设密度滤波平滑方法,具体按照以下步骤实施:
步骤1、假设k时刻多个目标的状态值为
Figure GDA0003105298410000031
Nk为目标个数,
Figure GDA0003105298410000032
表示第i个目标在k时刻的状态值;量测值为
Figure GDA0003105298410000033
Mk为量测个数,
Figure GDA0003105298410000034
表示k时刻传感器接收到的第j个量测量;
采用随机集
Figure GDA0003105298410000035
表示k时刻目标的状态,预先设定第i个目标状态向量为
Figure GDA0003105298410000036
其动态方程具体如下:
Figure GDA0003105298410000037
上式中Fk为目标的动态转移矩阵,
Figure GDA0003105298410000038
是协方差为Qk的过程噪声,可将Fk作为线性高斯模型,采用卡尔曼滤波算法对目标进行跟踪;每个目标的动态转移方程采用的是同一模型且彼此之间相互独立;
传感器的量测集为
Figure GDA0003105298410000039
是由传感器观测k时刻的真实目标的运动状态产生的数据信息集合以及由杂波产生的信息集合之和组成的,第j个目标的状态产生的量测信息
Figure GDA00031052984100000310
按照以下方法实施:
Figure GDA00031052984100000311
其中,Hk表示目标量测矩阵,
Figure GDA00031052984100000312
表示量测噪声且协方差为Rk
在观测目标量测的同时,能观测到杂波信息,每一时刻杂波的数目服从一个随机变量为β的泊松分布,此处的β为杂波率,因此,在k时刻传感器的量测集Zk具体模型如下:
Figure GDA0003105298410000041
上式中Zc,k为k时刻的杂波集;
步骤2、根据目标可能的初始的起始位置,计算多目标的初始概率假设密度;
初始概率假设密度建模如下:
Figure GDA0003105298410000042
上式中Jk表示初始时刻高斯项个数,
Figure GDA0003105298410000043
表示初始时刻第j个高斯项的权值,
Figure GDA0003105298410000044
为初始时刻第j个高斯项的均值,
Figure GDA0003105298410000045
为初始时刻第j个高斯项的协方差;
步骤3、设置分段长度L,由步骤2得到的目标初始概率假设密度以及步骤1得到的量测集合,利用动态方程对目标位置进行估计;
步骤4、经步骤3完成对目标位置估计后,保存当前时刻目标总的权值、均值、以及协方差;
步骤5、对步骤4得到的目标估计进行航迹-估计关联,同时判断是否满足设置的分段长度,若不满足,返回步骤3,将步骤4得到的当前时刻目标总的权值、均值以及协方差作为下一时刻步骤3中所需要的目标初始权值、均值以及协方差,若满足,执行步骤6;
步骤6、当满足设置的分段长度L时,对步骤5得到的各个航迹分别进行RTS平滑,返回步骤3,将步骤4得到的当前时刻目标总的权值、均值以及协方差作为下一时刻步骤3中所需要的目标初始权值、均值以及协方差,经多次循环后最终实现对目标状态的估计;
步骤3~5为一次循环过程,用于得到分段长度内关联后的各条航迹,步骤3~6为一次循环过程,用于得到分段长度内目标的平滑结果,程序循环至目标结束移动后结束。
本发明的特点还在于:
步骤3具体按照以下步骤实施:
步骤3.1、经步骤2计算得到初始概率假设密度后,根据k-1采样时刻的概率假设密度,预测出k时刻的概率假设密度;
步骤3.2、经步骤1得到传感器的量测集合,使用自适应椭球门限技术剔除量测中的杂波;
步骤3.3、根据步骤3.1预测得到的k时刻的概率假设密度,利用3.2步骤中处理过的量测值进行更新;
步骤3.4、将步骤3.3处理后,对所得到的所有更新后的高斯项的权值、均值及协方差进行判断及合并;
步骤3.5、对步骤3.4处理后的高斯项进行修剪与合并,具体按照以下方法实施:
对于权值小于修剪阈值的高斯项进行剪枝操作,直接除去该高斯项,修剪阈值设置为0.00005时效果较好;
对于分布性非常接近的高斯项采取直接合并为一个高斯分布;
步骤3.1具体按照以下步骤实施:
步骤3.1.1、在k时刻,分别预测新生目标集的概率假设密度、衍生目标集的概率假设密度、幸存目标集的概率假设密度;
步骤3.1.2、经步骤3.1.1预测得到新生目标集、衍生目标集以及幸存目标集后,再预测出基于概率假设密度的高斯分布的总个数,具体按照以下步骤实施:
Jk|k-1=Jγ+Jβ+Jk-1|k-1
式中,Jγ为新生目标的高斯项个数;Jβ为衍生目标的高斯项个数;Jk-1|k-1为幸存目标的高斯项个数;
步骤3.1.3、根据步骤3.1.1和步骤3.1.2的结果,预测出k时刻的概率假设密度,具体预测模型如下:
Figure GDA0003105298410000061
可得到新生目标集的概率假设密度,具体如下:
Figure GDA0003105298410000062
预测衍生目标集在k时刻的概率假设密度,具体如下:
Figure GDA0003105298410000063
预测幸存目标集在k时刻时的概率假设密度,具体如下:
Figure GDA0003105298410000064
其中,PS,k表示的是目标幸存概率;下标γ、β和S分别表示新生目标、衍生目标以及幸存目标的分量,ω、m以及P下标中的k|k-1表示为k-1时刻到k时刻的一步预测对应的高斯项的权重、均值以及协方差。
步骤3.2具体按照以下步骤实施:
步骤3.2.1、根据步骤1传感器量测模型,计算第i个观测值和第j个高斯项的残差向量,具体按照以下方法实施:
Figure GDA0003105298410000071
其中ε(ij)表示残差向量;
步骤3.2.2、计算残差向量对应的协方差矩阵,具体按照以下方法实施:
Figure GDA0003105298410000072
上式中
Figure GDA0003105298410000073
为第j个预测值的协方差矩阵;
步骤3.2.3、根据步骤3.2.1和步骤3.2.2计算椭球门限判别式,具体按照以下方法实施:
Figure GDA0003105298410000074
Figure GDA0003105298410000075
其中
Figure GDA0003105298410000076
表示k时刻第j个高斯项对应的门限,Pg表示正确的量测落入门限
Figure GDA0003105298410000077
内的概率,nz表示观测空间维数,β表示杂波密度函数;
步骤3.3具体按照以下步骤实施:
步骤3.3.1、更新k时刻的概率假设密度,具体按照以下方法实施:
Figure GDA0003105298410000078
式中,PD,k表示目标的检测概率,vk|k-1表示由步骤3.1得到的k时刻目标预测概率假设密度,(1-PD,k)vk|k-1(x)用于计算漏检目标的情况,vD,k(x;z)用于计算检测到的目标的情况;
步骤3.3.2、vD,k(x;z)用于计算检测到目标的情况,对vD,k(x;z)建模,得到如下高斯形式:
Figure GDA0003105298410000079
式中
Figure GDA0003105298410000081
Figure GDA0003105298410000082
Figure GDA0003105298410000083
Figure GDA0003105298410000084
Figure GDA0003105298410000085
其中
Figure GDA0003105298410000086
表示步骤3.1得到的k时刻目标预测的权值,κk表示k时刻杂波强度,其计算公式为κk(z)=λvu(z),λ表示单位面积杂波点的平均个数,v表示检测区域面积,u(·)表示在观测区域内杂波是服从均匀分布,
Figure GDA0003105298410000087
表示表示滤波增益,I表示单位矩阵。
步骤5具体按照以下步骤实施:
步骤5.1、进行航迹初始化。建立初始航迹库并设置航迹的间断步数阈值,其中初始航迹的条数等于初始时刻的目标个数,各个航迹的初始位置为各个目标的初始位置;
步骤5.2、采用匈牙利算法进行配对。根据k-1时刻已形成的航迹库可得到Lk-1条航迹末端点的状态值为
Figure GDA0003105298410000088
由于目标运动具有连续性,可根据目标运动方程获得k时刻各条航迹尾端点对应的预测值,记为集合
Figure GDA0003105298410000089
由步骤3得到k时刻目标状态估计值记为集合
Figure GDA00031052984100000810
对两个集合元素采用匈牙利算法配对。
步骤5.3、进行航迹-估计关联。设置距离阈值dth,计算已配对元素的马氏距离,若该值小于dth,则进行关联;设置航迹的连续性阈值cnum,由于目标对应的航迹应具有一定的连续性,若航迹持续时间过短,则可将该航迹剔除;
步骤5.2具体按照以下步骤实施:
步骤5.2.1、计算步骤5.2中集合B和集合C中所有元素相互之间的距离,并将其作为效益矩阵,判断l与Nk之间的关系,利用匈牙利算法进行指派;
步骤5.2.2、如果l=Nk,由步骤5.2.1计算结果可直接进行配对;
步骤5.2.3、如果l>Nk,根据集合C中元素个数配对,对集合B中没有配对的预测值
Figure GDA0003105298410000091
认为其对应的第i条航迹在k时刻是间断的,并将其作为有效航迹
Figure GDA0003105298410000092
保留,以便进行下一时刻配对;
步骤5.2.4、如果l<Nk,令n=Nk-l,根据集合B中元素个数配对,对集合C中n个没有配对的状态估计值xk,将其作为起点,建立n条新航迹
Figure GDA0003105298410000093
(n=1,2,...,n)参与下一时刻配对;
步骤5.3具体按照以下步骤实施:
步骤5.3.1、对步骤5.2计算得到两个集合中已配对元素
Figure GDA0003105298410000094
(i≤l)与
Figure GDA0003105298410000095
(j≤Nk),计算其马氏距离,将该距离的平方记为d;
步骤5.3.2、对步骤5.3.1计算得到的距离d,判断该值是否位于χ2分布相应的置信区间内,若d小于预设距离阈值dth,则进行关联,即将k时刻的状态估计值
Figure GDA0003105298410000096
联结到航迹
Figure GDA0003105298410000097
末端,即形成航迹
Figure GDA0003105298410000098
否则将其作为起点,建立新航迹
Figure GDA0003105298410000099
(r=1,2,...),且r≤Nk,并将其作为有效航迹参与下一时刻配对;
步骤5.3.3、根据设置的连续性阈值cnum,对步骤5.2结束后形成的航迹Ω进行裁剪,由于目标对应的航迹在一段时间内具有连续性,如果一条已形成的航迹持续时间过短,就认为该航迹是由于发生虚假目标估计形成的,将其看作无效航迹予以剔除,设置的连续性阈值cnum=3效果较好;
步骤6具体按照以下步骤实施:
对步骤5得到的各个航迹的滤波结果分别采用RTS进行平滑,具体按照如下方法实施:
Figure GDA0003105298410000101
Figure GDA0003105298410000102
Figure GDA0003105298410000103
Figure GDA0003105298410000104
Figure GDA0003105298410000105
其中,
Figure GDA0003105298410000106
Figure GDA0003105298410000107
是k时刻第j个高斯分量平滑估计的均值和方差;
Figure GDA0003105298410000108
Figure GDA0003105298410000109
是步骤3得到的k时刻滤波结果的均值和方差;
Figure GDA00031052984100001010
Figure GDA00031052984100001011
是k+1时刻预测得到的均值和方差;
Figure GDA00031052984100001012
Figure GDA00031052984100001013
是步骤3得到的k+1时刻滤波结果的均值和方差,也是平滑的初始值;
Figure GDA00031052984100001014
是k时刻的平滑增益。
本发明的有益效果是:本发明将RTS平滑思想应用到PHD中,以解决多目标跟踪中的平滑问题,同时考虑到平滑过程存在的时间滞后现象,将分段思想应用到平滑过程中,以避免在滤波过程中应用平滑方法造成的实时性欠佳问题。
本发明基于分段RTS的概率假设密度滤波平滑方法,考虑到在多目标跟踪中航迹与滤波值不是一一对应的,而要获得目标航迹在每一时刻对应的滤波值,必须采用有效的算法进行航迹-估计关联,因此采用匈牙利算法进行航迹-估计关联,在关联后的基础上进行平滑,一方面可以提高目标估计的精度,另一方面在一定程度上减少了算法的延迟。
附图说明
为了简便起见,将基于RTS的概率假设密度滤波平滑方法记为PHD-RTS,将基于分段RTS的概率假设密度滤波平滑方法记为PHD-PW-RTS;
图1是单次运行基于RTS的概率假设密度滤波平滑方法与概率假设密度滤波之后采用匈牙利算法进行关联后的目标数目对比图;
图2是单次运行基于RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的最优子模式指派(Optimal Sub-pattern Assignment,OSPA)距离对比图;
图3是多次运行基于RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的OSPA距离对比图;
图4是多次运行本发明基于分段RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的OSPA距离对比图,其中分段长度为1;
图5是多次运行本发明基于分段RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的OSPA距离对比图,其中分段长度为2;
图6是多次运行本发明基于分段RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的OSPA距离对比图,其中分段长度为3;
图7是多次运行本发明基于分段RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的OSPA距离对比图,其中分段长度为4;
图8是多次运行本发明基于分段RTS的概率假设密度滤波平滑方法与PHD滤波估计出的目标状态与真实目标状态的OSPA距离对比图,其中分段长度为5。
具体实施方式
下面结合附图和具体实施方式对本发明进行详细说明。
本发明基于分段RTS的概率假设密度滤波平滑方法,具体按照以下步骤实施:
步骤1、在多目标跟踪中,k时刻多个目标的状态值为
Figure GDA0003105298410000121
Nk为目标个数,
Figure GDA0003105298410000122
表示第i个目标在k时刻的状态值;量测值为
Figure GDA0003105298410000123
Mk为量测个数,
Figure GDA0003105298410000124
表示k时刻传感器接收到的第j个量测量;
采用随机集
Figure GDA0003105298410000125
表示k时刻目标的状态,预先设定第i个目标状态向量为
Figure GDA0003105298410000126
其动态方程具体如下:
Figure GDA0003105298410000127
式(1)中,Fk为目标的动态转移矩阵,
Figure GDA0003105298410000128
是协方差为Qk的过程噪声,可将Fk作为线性高斯模型,采用普通的卡尔曼滤波算法对目标进行跟踪,当Fk为非线性模型时,采用扩展卡尔曼滤波算法思想对目标进行跟踪;
在本发明基于分段RTS的概率假设密度滤波平滑方法中,Fk为线性高斯模型;
Figure GDA0003105298410000129
为协方差为Qk的过程噪声;每个目标的动态转移方程采用的都是同一个模型并且它们之间是相互独立的。
传感器的量测集为
Figure GDA00031052984100001210
是由传感器观测k时刻的真实目标的运动状态产生的数据信息集合以及由杂波产生的信息集合之和组成的,第j个目标的状态产生的量测信息
Figure GDA00031052984100001211
由公式(2)确定:
Figure GDA00031052984100001212
式(2)中,Hk表示目标量测矩阵,
Figure GDA00031052984100001213
表示量测噪声且协方差为Rk
在观测目标量测的同时,能观测到杂波信息,每一时刻杂波的数目服从一个随机变量为β的泊松分布,此处的β为杂波率,因此,在k时刻传感器的量测集Zk具体模型如下:
Figure GDA00031052984100001214
式(3)中,Zc,k为k时刻的杂波集;
步骤2、根据目标可能的初始的起始位置,计算多目标的初始概率假设密度;
初始概率假设密度建模如下:
Figure GDA0003105298410000131
式(4)中,Jk表示初始时刻高斯项个数,
Figure GDA0003105298410000132
表示初始时刻第j个高斯项的权值,
Figure GDA0003105298410000133
为初始时刻第j个高斯项的均值,
Figure GDA0003105298410000134
为初始时刻第j个高斯项的协方差;
步骤3、设置分段长度L,由步骤2得到的目标初始概率假设密度以及步骤1得到的量测集合,利用动态方程对目标位置进行估计,具体如下:
步骤3.1、经步骤2计算得到初始概率假设密度后,根据k-1采样时刻的概率假设密度,预测出k时刻的概率假设密度,具体按照如下步骤实施:
步骤3.1.1、在k时刻,分别预测新生目标集的概率假设密度、衍生目标集的概率假设密度、幸存目标集的概率假设密度;
步骤3.1.2、经步骤3.1.1预测得到新生目标集、衍生目标集以及幸存目标集后,再根据公式(5)预测出基于概率假设密度的高斯分布的总个数:
Jk|k-1=Jγ+Jβ+Jk-1|k-1; (5)
式(5)中,Jγ为新生目标的高斯项个数;Jβ为衍生目标的高斯项个数;Jk-1|k-1为幸存目标的高斯项个数;
步骤3.1.3、根据步骤3.1.1和步骤3.1.2的结果,预测出k时刻的概率假设密度,具体预测模型如下:
Figure GDA0003105298410000135
可得到新生目标集的概率假设密度:
Figure GDA0003105298410000141
预测衍生目标集在k时刻的概率假设密度:
Figure GDA0003105298410000142
预测幸存目标集在k时刻时的概率假设密度:
Figure GDA0003105298410000143
式(6)、(7)、(8)、(9)中,PS,k表示的是目标幸存概率;下标γ、β和S分别表示新生目标、衍生目标以及幸存目标的分量,ω、m以及P下标出现的k|k-1表示为k-1时刻到k时刻的一步预测对应的高斯项的权重、均值以及协方差。
步骤3.2、经步骤1得到传感器的量测集合,使用自适应椭球门限技术剔除量测中的杂波,具体按照如下步骤实施:
步骤3.2.1、根据步骤1传感器量测模型(公式(2)),采用下式计算第i个观测值和第j个高斯项的残差向量:
Figure GDA0003105298410000144
式(10)中,ε(ij)表示残差向量;
步骤3.2.2、根据下式计算残差向量对应的协方差矩阵:
Figure GDA0003105298410000145
式(11)中,
Figure GDA0003105298410000146
为第j个预测值的协方差矩阵;
步骤3.2.3、根据步骤3.2.1和步骤3.2.2计算椭球门限判别式,具体公式为:
Figure GDA0003105298410000147
Figure GDA0003105298410000151
式(12)、(13)中,
Figure GDA0003105298410000152
表示k时刻第j个高斯项对应的门限,Pg表示正确的量测落入门限
Figure GDA0003105298410000153
内的概率,nz表示观测空间维数,β表示杂波密度函数;
步骤3.3、根据步骤3.1预测得到的k时刻的概率假设密度,利用3.2步骤中处理过的量测值进行更新,具体步骤为:
步骤3.3.1、更新k时刻的概率假设密度:
Figure GDA0003105298410000154
式(14)中,PD,k表示目标的检测概率,vk|k-1表示由步骤3.1得到的k时刻目标预测概率假设密度,(1-PD,k)vk|k-1(x)用于计算漏检目标的情况,vD,k(x;z)用于计算检测到的目标的情况;
步骤3.3.2、vD,k(x;z)用于计算检测到目标的情况,对vD,k(x;z)建模,得到如下高斯形式:
Figure GDA0003105298410000155
式中
Figure GDA0003105298410000156
Figure GDA0003105298410000157
Figure GDA0003105298410000158
Figure GDA0003105298410000159
Figure GDA00031052984100001510
其中式(16)中,
Figure GDA00031052984100001511
表示步骤3.1得到的k时刻目标预测的权值,κk表示k时刻杂波强度,其计算公式为κk(z)=λvu(z),λ表示单位面积杂波点的平均个数,v表示检测区域面积,u(·)表示在观测区域内杂波是服从均匀分布,式(20)中,
Figure GDA0003105298410000161
表示表示滤波增益,式(19)中,I表示单位矩阵。
通过上式可获得更新后目标相对应的权值,均值以及协方差。
步骤3.4、将步骤3.3处理后,对所得到的所有更新后的高斯项的权值、均值及协方差进行判断及合并;
步骤3.5、对步骤3.4处理后的高斯项进行修剪与合并,具体按照如下方法实施:
对于权值小于修剪阈值的高斯项进行剪枝操作,直接除去该高斯项,修剪阈值设置为0.00005时效果较好;
对于分步性非常接近的高斯项采取直接合并为一个高斯分布,一般选取合并门限为4时效果较好;
步骤4、经步骤3完成对目标位置估计后,保存当前时刻目标总的权值、均值以及协方差;
步骤5、对步骤4得到的目标估计进行航迹-估计关联,同时判断是否满足设置的分段长度,若不满足,返回步骤3,将步骤4得到的当前时刻目标总的权值、均值以及协方差作为下一时刻步骤3中所需要的目标初始权值、均值以及协方差;若满足,执行步骤6。本步骤具体按照如下步骤实施:
步骤5.1、进行航迹初始化。建立初始航迹库并设置航迹的间断步数阈值,其中初始航迹的条数等于初始时刻的目标个数,各个航迹的初始位置为各个目标的初始位置;
步骤5.2、采用匈牙利算法进行配对。根据k-1时刻已形成的航迹库可得到Lk-1条航迹末端点的状态值为
Figure GDA0003105298410000162
由于目标运动具有连续性,可根据目标运动方程获得k时刻各条航迹尾端点对应的预测值,记为集合
Figure GDA0003105298410000171
由步骤3得到k时刻目标状态估计值记为集合
Figure GDA0003105298410000172
对两个集合元素采用匈牙利算法配对,具体如下:
步骤5.2.1、计算步骤5.2中集合B和集合C中所有元素相互之间的距离,并将其作为效益矩阵,判断l与Nk之间的关系,利用匈牙利算法进行指派;
步骤5.2.2、如果l=Nk,由步骤5.2.1计算结果可直接进行配对;
步骤5.2.3、如果l>Nk,根据集合C中元素个数配对,对集合B中没有配对的预测值
Figure GDA0003105298410000173
认为其对应的第i条航迹在k时刻是间断的,并将其作为有效航迹
Figure GDA0003105298410000174
(i<l)保留,以便进行下一时刻配对;
步骤5.2.4、如果l<Nk,令n=Nk-l,根据集合B中元素个数配对,对集合C中n个没有配对的状态估计值xk,将其作为起点,建立n条新航迹
Figure GDA0003105298410000175
(n=1,2,...n,参与下一时刻配对;
步骤5.3、进行航迹-估计关联。设置距离阈值dth,计算已配对元素的马氏距离,若该值小于dth,则进行关联;设置航迹的连续性阈值cnum,由于目标对应的航迹应具有一定的连续性,若航迹持续时间过短,则可将该航迹剔除,具体过程为:
步骤5.3.1、对步骤5.2计算得到两个集合中已配对元素
Figure GDA0003105298410000176
(i≤l)与
Figure GDA0003105298410000177
(j≤Nk),计算其马氏距离,将该距离的平方记为d;
步骤5.3.2、对步骤5.3.1计算得到的距离d,判断该值是否位于χ2分布相应的置信区间内,若d小于预设距离阈值dth,则进行关联,即将k时刻的状态估计值
Figure GDA0003105298410000178
(j≤Nk)联结到航迹
Figure GDA0003105298410000179
末端,即形成航迹
Figure GDA00031052984100001710
否则将其作为起点,建立新航迹
Figure GDA00031052984100001711
(r=1,2,...),且r≤Nk,并将其作为有效航迹参与下一时刻配对;
步骤5.3.3、根据设置的连续性阈值cnum,对步骤5.2结束后形成的航迹Ω进行裁剪,由于目标对应的航迹在一段时间内具有连续性,如果一条已形成的航迹持续时间过短,就认为该航迹是由于发生虚假目标估计形成的,将其看作无效航迹予以剔除,设置的连续性阈值cnum=3效果较好;
步骤6、当满足设置的分段长度L时,对步骤5得到的各个航迹分别进行RTS平滑,返回步骤3,将步骤4得到的当前时刻目标总的权值、均值以及协方差作为下一时刻步骤3中所需要的目标初始权值、均值以及协方差,经多次循环后最终实现对目标状态的估计,具体按照如下公式计算:
Figure GDA0003105298410000181
Figure GDA0003105298410000182
Figure GDA0003105298410000183
Figure GDA0003105298410000184
Figure GDA0003105298410000185
式(24)、(25)中、
Figure GDA0003105298410000186
Figure GDA0003105298410000187
是k时刻第j个高斯分量平滑估计的均值和方差;式(21)、(22)中、
Figure GDA0003105298410000188
Figure GDA0003105298410000189
是步骤3得到的k时刻滤波结果的均值和方差;式(24)、(25)中、
Figure GDA00031052984100001810
Figure GDA00031052984100001811
是k+1时刻预测得到的均值和方差,
Figure GDA00031052984100001812
Figure GDA00031052984100001813
是步骤3得到的k+1时刻滤波结果的均值和方差,也是平滑的初始值;式(23)中、
Figure GDA00031052984100001814
是k时刻的平滑增益;
步骤3~5为一次循环过程,用于得到分段长度内关联后的各条航迹,步骤3~6为一次循环过程,用于得到分段长度内目标的平滑结果,程序循环至目标结束移动后结束。
通过仿真实验验证本发明基于分段RTS的概率假设密度滤波平滑方法相比于概率假设密度滤波方法对于目标状态估计的精确性,同时比较分段长度、检测率pD,k以及杂波个数λ对本发明性能的影响;
假设在[-100m,100m]×[-100m,100m]的二维平面监控区域内,有4个目标在二维场景做匀速运动,并且目标的运动状态是不确定的。目标状态向量为
Figure GDA0003105298410000191
其中(x,y)为目标的位置信息,
Figure GDA0003105298410000192
为目标的速度信息,实验描述的所有算法目标的运动模型均为线性高斯模型,采样周期T=1s,时间为40s,过程噪声服从高斯分布为
Figure GDA0003105298410000193
σ1=0.5,σ2=0.1,量测噪声服从高斯分布为
Figure GDA0003105298410000194
σv=0.5,其状态方程和量测方程为:
Figure GDA0003105298410000195
Figure GDA0003105298410000196
zk表示k时刻的量测向量。目标的存活概率pS,k=0.99,OSPA距离参数c=100,p=2,高斯项的修剪阈值τ=10-5,权值阈值ωth=0.5,允许最大的高斯分量个数J_max=100。采用匈牙利算法进行航迹-估计关联,航迹的连续性阈值cnum=3,航迹的间断步数阈值为3,距离阈值dth在χ2分布90%的置信区间内,传感器的检测概率pD,k=0.98,杂波个数为5。
单次运行实验结果如图1、2所示,从图中可知,基于RTS的概率假设密度滤波平滑方法与概率假设密度滤波方法相比,有效减小了OSPA距离。但在第8时刻,OSPA距离显著变大,造成该现象的原因是进行PHD数据关联时有目标丢失现象,而在其它时刻基于RTS的概率假设密度滤波平滑方法均好于或略低于未平滑的滤波方法。
多次运行的实验结果如图3-8所示,对不同的分段长度分别进行100次蒙特卡洛仿真实验,从结果可知,分段长度对本发明基于分段RTS的概率假设密度滤波平滑方法影响不大,且PHD-RTS平滑效果大都好于PHD-PW-RTS,但随着分段长度的增加,平滑误差趋于常数,而不管分段长度如何选择,本发明PHD-PW-RTS的平滑效果总是优于未平滑的滤波结果。
为验证分段长度对于本发明基于分段RTS的概率假设密度滤波平滑方法的影响,在不同分段长度下,分别进行100次蒙特卡洛实验,计算它们的OSPA距离,实验数据如表1所示,差值代表的是PHD-PW-RTS与PHD-RTS之间的OSPA距离之差。理论上,随着分段长度的增加,OSPA的距离会越来越小,最后趋于常数。实际从表1数据可得,当分段长度为1时,OSPA差值较大,而当长度为2、3时OSPA距离会越来越小,随后OSPA距离会有所增大,但变化幅度不大,因此,在选取分段长度时,以2、3为宜。
表1多次运行本发明方法的OSPA距离对比
Figure GDA0003105298410000201
为验证检测率对于本发明基于分段RTS的概率假设密度滤波平滑方法的影响,依次改变检测率pD,k的值,计算它们之间的OSPA距离,实验数据如表2所示,表中数值代表不同检测率下PHD-PW-RTS与PHD-RTS之间的OSPA距离之差。从表2数据可以看出,当检测率为0.75、0.8、0.85和0.9时,PHD-PW-RTS比PHD-RTS平滑效果要好,其原因是,当检测率较低时,标准的PHD滤波效果会显著降低,PHD-RTS要根据滤波结果运算,会用到全部过去,现在和未来的观测值,这样会产生较大的误差,OSPA距离会随之变大,而PHD-PW-RTS只用到分段时间段内的观测值,与PHD-RTS相比误差较小,平滑结果会略好,但对于分段平滑的效果影响不显著。当检测率较大时会有好的滤波结果,PHD-RTS平滑效果比PHD-PW-RTS好,但对于平滑几乎无影响,因此,检测率对于本发明基于分段RTS的概率假设密度滤波平滑方法的影响不大。
表2不同检测率下本发明方法的OSPA距离对比
Figure GDA0003105298410000211
为验证杂波个数对于本发明基于分段RTS的概率假设密度滤波平滑方法的影响,依次改变杂波个数λ,计算不同杂波数下本发明基于分段RTS的概率假设密度滤波平滑方法的OSPA距离,实验数据如表3所示,表中数值代表不同杂波个数下PHD-PW-RTS与PHD-RTS之间的OSPA距离之差。从表中数据可知,随着杂波个数的增加,OSPA距离变化幅度不大,因此,可以得到,杂波个数对于本发明基于分段RTS的概率假设密度滤波平滑方法几乎没有影响。
表3不同杂波个数下本发明方法的OSPA距离对比
Figure GDA0003105298410000212

Claims (1)

1.基于分段RTS的概率假设密度滤波平滑方法,其特征在于,具体按照以下步骤实施:
步骤1、由传感器观测k时刻的真实目标的运动状态产生的数据信息集合以及由杂波产生的信息集合之和组成传感器的量测集Zk,在k时刻传感器的量测集Zk模型为:
Figure FDA0003163864170000011
上式中Zc,k为k时刻的杂波集,Nk为目标个数,
Figure FDA0003163864170000012
表示第i个目标在k时刻的状态值,
Figure FDA0003163864170000013
表示k时刻传感器接收到的第j个量测量:
Figure FDA0003163864170000014
其中,Hk表示目标量测矩阵,
Figure FDA0003163864170000015
表示量测噪声且协方差为Rk
步骤2、根据目标可能的初始的起始位置,计算多目标的初始概率假设密度;初始概率假设密度建模如下:
Figure FDA0003163864170000016
上式中Jk表示初始时刻高斯项个数,
Figure FDA0003163864170000017
表示初始时刻第j个高斯项的权值,
Figure FDA0003163864170000018
为初始时刻第j个高斯项的均值,
Figure FDA0003163864170000019
为初始时刻第j个高斯项的协方差;
步骤3、设置分段长度L,由步骤2得到的目标初始概率假设密度以及步骤1得到的量测集合,利用动态方程对目标位置进行估计;
其中,采用随机集
Figure FDA00031638641700000110
表示k时刻目标的状态,预先设定第i个目标状态向量为
Figure FDA00031638641700000111
其动态方程具体如下:
Figure FDA00031638641700000112
式(1)中,Fk为目标的动态转移矩阵,
Figure FDA0003163864170000021
是协方差为Qk的过程噪声,可将Fk作为线性高斯模型,采用普通的卡尔曼滤波算法对目标进行跟踪,当Fk为非线性模型时,采用扩展卡尔曼滤波算法思想对目标进行跟踪;
步骤3具体按照以下步骤实施:
步骤3.1、经步骤2计算得到初始概率假设密度后,根据k-1采样时刻的概率假设密度,预测出k时刻的概率假设密度;
所述步骤3.1具体按照以下步骤实施:
步骤3.1.1、在k时刻,分别预测新生目标集的概率假设密度、衍生目标集的概率假设密度、幸存目标集的概率假设密度;
步骤3.1.2、经步骤3.1.1预测得到新生目标集、衍生目标集以及幸存目标集后,再预测出基于概率假设密度的高斯分布的总个数:
Jk|k-1=Jγ+Jβ+Jk-1|k-1
式中,Jγ为新生目标的高斯项个数;Jβ为衍生目标的高斯项个数;Jk-1|k-1为幸存目标的高斯项个数;
步骤3.1.3、根据步骤3.1.1和步骤3.1.2的结果,预测出k时刻的概率假设密度,具体预测模型如下:
Figure FDA0003163864170000022
可得到新生目标集的概率假设密度:
Figure FDA0003163864170000023
预测衍生目标集在k时刻的概率假设密度:
Figure FDA0003163864170000024
预测幸存目标集在k时刻时的概率假设密度:
Figure FDA0003163864170000031
其中,PS,k表示的是目标幸存概率;下标γ、β和S分别表示新生目标、衍生目标以及幸存目标的分量,ω、m以及P下标中的k|k-1表示为k-1时刻到k时刻的一步预测对应的高斯项的权重、均值以及协方差;
步骤3.2、经步骤1得到传感器的量测集合,使用自适应椭球门限技术剔除量测中的杂波;
所述步骤3.2具体按照以下步骤实施:
步骤3.2.1、根据步骤1传感器量测模型,计算第i个观测值和第j个高斯项的残差向量,具体按照以下方法实施:
Figure FDA0003163864170000032
其中ε(ij)表示残差向量;
步骤3.2.2、计算残差向量对应的协方差矩阵,具体按照以下方法实施:
Figure FDA0003163864170000033
上式中
Figure FDA0003163864170000034
为第j个预测值的协方差矩阵;
步骤3.2.3、根据步骤3.2.1和步骤3.2.2计算椭球门限判别式,具体按照以下方法实施:
Figure FDA0003163864170000035
Figure FDA0003163864170000036
其中
Figure FDA0003163864170000037
表示k时刻第j个高斯项对应的门限,Pg表示正确的量测落入门限
Figure FDA0003163864170000038
内的概率,nz表示观测空间维数,β表示杂波密度函数;
步骤3.3、根据步骤3.1预测得到的k时刻的概率假设密度,利用3.2步骤中处理过的量测值进行更新;
所述步骤3.3具体按照以下步骤实施:
步骤3.3.1、更新k时刻的概率假设密度:
Figure FDA0003163864170000041
式中,PD,k表示目标的检测概率,vk|k-1表示由步骤3.1得到的k时刻目标预测概率假设密度,(1-PD,k)vk|k-1(x)用于计算漏检目标的情况,vD,k(x;z)用于计算检测到的目标的情况;
步骤3.3.2、vD,k(x;z)用于计算检测到目标的情况,对vD,k(x;z)建模,得到如下高斯形式:
Figure FDA0003163864170000042
式中
Figure FDA0003163864170000043
Figure FDA0003163864170000044
Figure FDA0003163864170000045
Figure FDA0003163864170000046
Figure FDA0003163864170000047
其中
Figure FDA0003163864170000048
表示步骤3.1得到的k时刻目标预测的权值,κk表示k时刻杂波强度,其计算公式为κk(z)=λvu(z),λ表示单位面积杂波点的平均个数,v表示检测区域面积,u(·)表示在观测区域内杂波是服从均匀分布,
Figure FDA0003163864170000049
表示滤波增益,I表示单位矩阵;
步骤3.4、将步骤3.3处理后,对所得到的所有更新后的高斯项的权值、均值及协方差进行判断及合并;
步骤3.5、对步骤3.4处理后的高斯项进行修剪与合并;
步骤4、经步骤3完成对目标位置估计后,保存当前时刻目标总的权值、均值、以及协方差;
步骤5、对步骤4得到的目标估计进行航迹-估计关联,同时判断是否满足设置的分段长度,若不满足,返回步骤3,将步骤4得到的当前时刻目标总的权值、均值以及协方差作为下一时刻步骤3中所需要的目标初始权值、均值以及协方差,若满足,执行步骤6;其中,分段长度为2或3;
所述步骤5具体按照以下步骤实施:
步骤5.1、进行航迹初始化;建立初始航迹库并设置航迹的间断步数阈值,其中初始航迹的条数等于初始时刻的目标个数,各个航迹的初始位置为各个目标的初始位置;
步骤5.2、采用匈牙利算法进行配对;根据k-1时刻已形成的航迹库可得到Lk-1条航迹末端点的状态值为
Figure FDA0003163864170000051
由于目标运动具有连续性,可根据目标运动方程获得k时刻各条航迹尾端点对应的预测值,记为集合
Figure FDA0003163864170000052
由步骤3得到k时刻目标状态估计值记为集合
Figure FDA0003163864170000053
对两个集合元素采用匈牙利算法配对;
步骤5.3、进行航迹-估计关联;设置距离阈值dth,计算已配对元素的马氏距离,若该值小于dth,则进行关联;设置航迹的连续性阈值cnum,由于目标对应的航迹应具有一定的连续性,若航迹持续时间过短,则可将该航迹剔除;
所述步骤5.2和步骤5.3具体按照以下步骤实施:
步骤5.2.1、计算步骤5.2中集合B和集合C中所有元素相互之间的距离,并将其作为效益矩阵,判断l与Nk之间的关系,利用匈牙利算法进行指派;
步骤5.2.2、如果l=Nk,由步骤5.2.1计算结果可直接进行配对;
步骤5.2.3、如果l>Nk,根据集合C中元素个数配对,对集合B中没有配对的预测值
Figure FDA0003163864170000061
认为其对应的第i条航迹在k时刻是间断的,并将其作为有效航迹
Figure FDA0003163864170000062
保留,以便进行下一时刻配对;
步骤5.2.4、如果l<Nk,令n=Nk-l,根据集合B中元素个数配对,对集合C中n个没有配对的状态估计值xk,将其作为起点,建立n条新航迹
Figure FDA0003163864170000063
参与下一时刻配对;
步骤5.3.1、对步骤5.2计算得到两个集合中已配对元素
Figure FDA0003163864170000064
Figure FDA0003163864170000065
计算其马氏距离,将该距离的平方记为d;
步骤5.3.2、对步骤5.3.1计算得到的距离d,判断该值是否位于χ2分布相应的置信区间内,若d小于预设距离阈值dth,则进行关联,即将k时刻的状态估计值
Figure FDA0003163864170000066
联结到航迹
Figure FDA0003163864170000067
末端,即形成航迹
Figure FDA0003163864170000068
否则将其作为起点,建立新航迹
Figure FDA0003163864170000069
且r≤Nk,并将其作为有效航迹参与下一时刻配对;
步骤5.3.3、根据设置的连续性阈值cnum,对步骤5.2结束后形成的航迹Ω进行裁剪,由于目标对应的航迹在一段时间内具有连续性,如果一条已形成的航迹持续时间过短,就认为该航迹是由于发生虚假目标估计形成的,将其看作无效航迹予以剔除,设置的连续性阈值cnum=3效果较好;
步骤6、当满足设置的分段长度L时,对步骤5得到的各个航迹分别进行RTS平滑,返回步骤3,将步骤4得到的当前时刻目标总的权值、均值以及协方差作为下一时刻步骤3中所需要的目标初始权值、均值以及协方差,经多次循环后最终实现对目标状态的估计;
其中,步骤3~5为一次循环过程,用于得到分段长度内关联后的各条航迹,步骤3~6为一次循环过程,用于得到分段长度内目标的平滑结果,程序循环至目标结束移动后结束;
所述步骤6具体按照以下步骤实施:
对步骤5得到的各个航迹的滤波结果分别采用RTS进行平滑,具体按照如下方法实施:
Figure FDA0003163864170000071
Figure FDA0003163864170000072
Figure FDA0003163864170000073
Figure FDA0003163864170000074
Figure FDA0003163864170000075
其中,
Figure FDA0003163864170000076
Figure FDA0003163864170000077
是k时刻第j个高斯分量平滑估计的均值和方差;
Figure FDA0003163864170000078
Figure FDA0003163864170000079
是步骤3得到的k时刻滤波结果的均值和方差;
Figure FDA00031638641700000710
Figure FDA00031638641700000711
是k+1时刻预测得到的均值和方差;
Figure FDA00031638641700000712
Figure FDA00031638641700000713
是步骤3得到的k+1时刻滤波结果的均值和方差,也是平滑的初始值;
Figure FDA00031638641700000714
是k时刻的平滑增益。
CN201810373957.9A 2018-04-24 2018-04-24 基于分段rts的概率假设密度滤波平滑方法 Expired - Fee Related CN108717702B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810373957.9A CN108717702B (zh) 2018-04-24 2018-04-24 基于分段rts的概率假设密度滤波平滑方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810373957.9A CN108717702B (zh) 2018-04-24 2018-04-24 基于分段rts的概率假设密度滤波平滑方法

Publications (2)

Publication Number Publication Date
CN108717702A CN108717702A (zh) 2018-10-30
CN108717702B true CN108717702B (zh) 2021-08-31

Family

ID=63899099

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810373957.9A Expired - Fee Related CN108717702B (zh) 2018-04-24 2018-04-24 基于分段rts的概率假设密度滤波平滑方法

Country Status (1)

Country Link
CN (1) CN108717702B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109525220B (zh) * 2018-12-10 2019-08-30 中国人民解放军国防科技大学 具有航迹关联和提取能力的高斯混合cphd滤波方法
CN111504327B (zh) * 2020-04-30 2023-10-27 江苏理工学院 一种基于航迹平滑技术的广义标签多伯努利多目标跟踪方法
CN111811515B (zh) * 2020-07-03 2022-10-04 浙江工业大学 一种基于高斯混合概率假设密度滤波器的多目标航迹提取方法
CN113156279B (zh) * 2021-04-09 2023-01-17 江苏大学 一种基于概率假设密度滤波器的配电柜局部放电定位方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103644910A (zh) * 2013-11-22 2014-03-19 哈尔滨工程大学 基于分段rts平滑算法的个人自主导航系统定位方法
CN103729637A (zh) * 2013-12-31 2014-04-16 西安工程大学 基于容积卡尔曼滤波的扩展目标概率假设密度滤波方法
CN104019816A (zh) * 2014-05-30 2014-09-03 西北工业大学 基于全局时空相关的概率假设密度滤波器航迹提取方法
CN104778358A (zh) * 2015-04-09 2015-07-15 西安工程大学 多传感器存在监测区域部分重叠的扩展目标跟踪方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150170536A1 (en) * 2013-12-18 2015-06-18 William Marsh Rice University Time-Varying Learning and Content Analytics Via Sparse Factor Analysis
CN106022340A (zh) * 2016-05-17 2016-10-12 南京理工大学 一种改进的高斯混合势概率假设密度滤波方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103644910A (zh) * 2013-11-22 2014-03-19 哈尔滨工程大学 基于分段rts平滑算法的个人自主导航系统定位方法
CN103729637A (zh) * 2013-12-31 2014-04-16 西安工程大学 基于容积卡尔曼滤波的扩展目标概率假设密度滤波方法
CN104019816A (zh) * 2014-05-30 2014-09-03 西北工业大学 基于全局时空相关的概率假设密度滤波器航迹提取方法
CN104778358A (zh) * 2015-04-09 2015-07-15 西安工程大学 多传感器存在监测区域部分重叠的扩展目标跟踪方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
A real-time fusion algorithm for asynchronous sensor system with PHD filter;Guchong Li et al.;《2017 International Conference on Control, Automation and Information Sciences (ICCAIS)》;20171218;134-139 *
一种状态与杂波相关条件下的GM-CPHD算法;马丽丽 等;《系统仿真学报》;20160731;第28卷(第7期);1637-1643 *
基于分段RTS平滑的凸组合航迹融合算法;陈金广 等;《计算机科学》;20100430;第37卷(第4期);175-178 *

Also Published As

Publication number Publication date
CN108717702A (zh) 2018-10-30

Similar Documents

Publication Publication Date Title
CN108717702B (zh) 基于分段rts的概率假设密度滤波平滑方法
CN109886305B (zh) 一种基于gm-phd滤波的多传感器非顺序量测异步融合方法
CN110542885B (zh) 一种复杂交通环境下的毫米波雷达目标跟踪方法
CN107402381B (zh) 一种迭代自适应的多机动目标跟踪方法
CN105182291B (zh) 自适应目标新生强度的phd平滑器的多目标跟踪方法
CN110320512A (zh) 一种基于带标签的gm-phd平滑滤波多目标跟踪方法
CN110596693B (zh) 一种迭代更新的多传感器gmphd自适应融合方法
CN108344981B (zh) 面向杂波的多传感器异步检测tsbf多目标跟踪方法
Wang et al. Fuzzy-control-based particle filter for maneuvering target tracking
CN110780269B (zh) 自适应新生强度下基于gm-phd滤波器的显式多目标跟踪方法
CN109214432B (zh) 一种多传感器多目标联合检测、跟踪与分类方法
CN113673565B (zh) 多传感器gm-phd自适应序贯融合多目标跟踪方法
CN111679251A (zh) 一种基于雷达红外双模融合的抗雷达型干扰方法
CN116148837A (zh) 非均匀杂波背景下稳健多传感器多目标跟踪方法
CN107219519B (zh) 连发火炮弹道曲线拟合方法
Previtali et al. PTracking: distributed multi-agent multi-object tracking through multi-clustered particle filtering
Iter et al. Target tracking with kalman filtering, knn and lstms
CN116630370A (zh) 多模型pbp-tpmb机动扩展目标跟踪方法
CN107330468B (zh) 基于切尔诺夫融合准则的多传感器分布式数据融合方法
Fletcher et al. A comparison of existence-based multitarget trackers for multistatic sonar
CN111328015B (zh) 一种基于Fisher信息距离的无线传感器网络目标跟踪方法
CN115220002A (zh) 一种固定单站的多目标数据关联跟踪方法和相关装置
CN111652150A (zh) 一种红外抗干扰跟踪方法
Tian et al. A robust tracking method focusing on target fluctuation and maneuver characteristics
Li et al. Robust indoor target tracking based on track matching

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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20210831

CF01 Termination of patent right due to non-payment of annual fee