专利名称：目标-回波-道路网三元数据关联的道路目标多假设跟踪算法的制作方法
技术领域：
本发明涉及一种目标-回波-道路网三元数据关联的道路目标多假设跟踪算法，近年来，地面目标跟踪已逐渐成为军事领域的研究热点，一方面，由于地势、道路和交通堵塞的限制，地面目标可能经常起始、加速、减速、暂停或转向，即被估计状态可能显著改变。另一方面，当传感器未能获得完备量测时，会造成目标定位的模糊性。因此，需要能够综合更多先验信息的数据融合算法来提供更高精度的目标状态估计。本发明涉及一种目标-回波-道路网三元数据关联的道路目标多假设跟踪算法，属于地面目标跟踪领域。
背景技术：
由于地面目标的运动特性和环境复杂，杂波强、虚警率高等，这些因素使得数据关联任务的难度大大增加，多假设跟踪(MHT)被认为是处理复杂环境下多目标数据关联的有效方法。但常见的MHT算法由于假设分支数多而使得算法计算量较大。考虑到道路网是一种有发展前景的先验信息，尽管道路网会引起地面目标的强机动性，但也提供了目标状态的附加信息。现在已经有将道路信息综合到MHT框架下的一些研究成果。Jost Koller 和 Martin Ulmke 所著文献(Data Fusion For Ground MovingTarget Tracking.Aerospace Science and Technology.)将数字道路信息作为伪量测综合到MHT框架下，此方法是通过将道路划分为多个道路段，使得目标出现在多种可能的道路假设分支上，每一时刻都将生成更多的假设分支，大大增加了 MHT算法的计算复杂性。另夕卜，此算法没有利用道路约束信息对目标状态进行修正，未能使估计精度得到改善。综上所述，通过引入道路信息，已有算法未能改善道路目标跟踪精度，且每一时刻展开道路假设使得算法计算量明显上升。本发明利用道路信息对目标状态进行修正，来改善跟踪性能；对道路网中的目标展开多种道路假设，与普通多假设每拍保留多个分支的情况不同，同源目标竞争的关系使得道路假设最终只保留一个假设分支；由于状态投影使得目标相似度提高，本发明通过合并相似假设来降低算法计算量。发明目的本发明的目的针对道路目标跟踪中存在的目标归属不确定性问题，采用一种目标-回波-道路网三元数据关联的道路目标多假设跟踪(TER-MHT)方法，首先利用道路信息对目标状态进行投影修正，包括对道路变更引起的速度突变的修正，来改善跟踪性能；然后对道路网中的目标展开多种可能道路约束下的航迹假设；最后，根据状态投影使得目标相似度提高，可通过合并相似假设来降低算法计算量并提取目标航迹，从而实现目标-回波-道路网的三元数据关联下的道路目标跟踪，改善目标跟踪精度，为道路目标跟踪应用提供参考价值。
发明内容
为了实现上述发明目的，本发明以道路目标跟踪为应用背景，提出了一种目标-回波-道路网三元数据关联的道路目标多假设跟踪(TER-MHT)方案。本发明方案的优点:可以实现目标-回波-道路网的三元数据关联下的道路目标跟踪，改善目标跟踪精度，获得杂波环境下道路目标跟踪性能的有效提升，对于道路目标跟踪工程实际应用具有非常重要的意义。本发明中目标-回波-道路网三元数据关联的道路目标MHT方法包括以下步骤:第一步，在杂波环境下生成假设分支之后，综合道路网信息建立目标与道路的关联假设，即道路假设。所述的建立目标与道路的关联假设包括以下步骤:Al、以航迹预测位置为中心，给定椭圆关联区域，并通过X 2分布检验设计合理阈值；B1、定义候选道路集合，利用道路约束和关联区域确定落入关联区内的候选道路由此展开道路假设。第二步，利用道路信息对目标状态进行修正。所述的利用道路信息对目标状态进行修正包括以下步骤:A2、建立求解道路约束下目标状态估计问题的数学模型，并得到最优解表达式；B2、将每一时刻的目标状态代入上述获得的最优解表达式中求得投影后的目标修正状态；C2、利用推导出的适应于道路突变的目标预测速度及状态预测协方差修正准则对目标速度及状态方差进行修正，若道路不发生变更，则此修正准则对目标状态无影响。
第三步，对道路假设进行有效的假设管理。所述的对道路假设进行有效的假设管理包括以下步骤:A3、当获得每一时刻的道路假设权重后，利用同源目标的竞争来删除假设分支；B3、目标状态的投影修正使得每一时刻的航迹假设相似度显著提高，因此通过X 2检验来检测假设的相似性；C3、若两个假设满足相似性要求，则通过合并相似假设及其方差来减少假设分支。第四步，采用序列似然比检验法对目标航迹进行提取。所述的采用序列似然比检验法对目标航迹进行提取包括以下步骤:A4、考虑两种不同的假设，一种是量测集合只包含虚假量测，另一种是量测集合包含真实量测和虚警；B4、由所有未归一化的假设权重构造似然比函数；C4、给定合理的航迹检测概率来确定决策门限，进而判断航迹是维持、终结或者继续检验。本发明的有益效果是:本发明提出了一种目标-回波-道路网三元数据关联的道路目标多假设跟踪(TER-MHT)算法，在多假设框架下试图解决密集路网中的目标跟踪问题。本发明首先利用道路约束将目标状态投影到道路约束面上，并推导出适应于道路突变的目标预测速度及状态预测协方差修正准则，用于修正道路变更引起的目标速度突变问题，来获得更高的跟踪精度。针对密集道路网中的目标跟踪问题，目标状态投影具有不确定性，由此本发明借鉴多假设的思想，在目标面临多条道路的选择问题时，考虑展开道路约束下的航迹道路假设分支，并利用目标同源性对假设进行合并消减。
本发明考虑通过信息融合的手段将道路约束信息综合到MHT框架下，在不增加计算量的基础上，获取地面目标更高的跟踪精度。
图1为本发明算法框架流图；图2a为直行路跟踪中标准MHT和TER-MHT算法的X-方向位置误差对比，图2b为Y-方向位置误差对比，图2c为X-方向速度误差对比，图2d为Y-方向速度误差对比；图3a为标准MHT算法假设分支，图3b为TER-MHT算法假设分支，方框中为放大区域；图4a为转弯路跟踪中50次Monte Carlo仿真的标准MHT和TER-MHT算法的位置均方根误差对比，图4b为速度均方根误差对比；图5a为Y-型交叉路跟踪中TER-MHT算法的位置误差，图5b为速度误差。具体实施实例目标-回波-道路网三元数据关联使得假设分支的产生来源于两部分因素:杂波和道路目标归属的不确定性。标准MHT分支数多，弓丨入道路信息后，对道路网中的目标展开多种道路假设，而目标状态的投影修正使得同一时刻状态相似度提高，可以考虑通过X 2检验合并相似状态，来减少分支数目并改善跟踪精度。图1是本发明算法框架流图，下面根据流程图对本发明的具体实施方案作进一步的描述:航迹与道路的假设检 验以航迹预测位置(Up)为中心，给定椭圆关联区域，记为Ω:Ω= |χ|(λ--χ)Ρ^ (χ-χ)Γ <(I)其中i为目标状态估计，Px为对应协方差阵，ε为门限值，给定一定的置信度α，根据(x-1)-12分布，可设计合理阈值。为了确定落入关联区内的候选道路，定
义候选道路集合U如下:
U = ^m|{x|^4 ,x = j.ηΩ ^ 0|(Z )其中，m = 1，2，...，M e U为落入关联区的候选道路标号，Am和k为已知约束矩阵和向量。为此，我们建立了目标与道路m的关联假设。接下来，利用道路约束对目标估计状态进行投影修正。道路约束下的目标状态修正(I)目标状态估计的投影修正本文中，道路约束将为状态估计提供一定的先验信息，通过将目标状态估计投影到道路约束面上，来获取更高的跟踪精度。根据文献[13]可知k时刻状态估计的投影问题可描述为:xm = arg min {(x -1啡 f W (x-xk[k):Ax = b)CS)其中，为目标状态估计，Xm为约束状态估计，W为对称正定的投影矩阵，A和b分别为已知约束矩阵和向量，运用拉格朗日乘子法得到的等式约束问题的解如下:
权利要求
1.一种目标-回波-道路网三元数据关联的道路目标多假设跟踪算法，其特征在于步骤如下: 步骤1:在杂波环境下生成假设分支之后，综合道路网信息建立目标与道路的关联假设，即道路假设，步骤如下: Al、以航迹预测位置为中心，给定椭圆关联区域，并通过X2分布检验设计合理阈值； B1、定义候选道路集合，利用道路约束和关联区域确定落入关联区内的候选道路由此展开道路假设； 步骤2:利用道路信息对目标状态进行修正，步骤如下: A2、建立求解道路约束下目标状态估计问题的数学模型，并得到最优解表达式； B2、将每一时刻的目标状态代入上述获得的最优解表达式中求得投影后的目标修正状态； C2、利用推导出的适应于道路突变 的目标预测速度及状态预测协方差修正准则对目标速度及状态方差进行修正，若道路不发生变更，则此修正准则对目标状态无影响； 步骤3:对道路假设进行有效的假设管理，步骤如下: A3、当获得每一时刻的道路假设权重后，利用同源目标的竞争来删除假设分支； B3、目标状态的投影修正使得每一时刻的航迹假设相似度显著提高，因此通过X 2检验来检测假设的相似性； C3、若两个假设满足相似性要求，则通过合并相似假设及其方差来减少假设分支； 步骤4:采用序列似然比检验法对目标航迹进行提取，步骤如下: A4、考虑两种不同的假设，一种是量测集合只包含虚假量测，另一种是量测集合包含真实量测和虚警； B4、由所有未归一化的假设权重构造似然比函数； C4、给定合理的航迹检测概率来确定决策门限，进而判断航迹是维持、终结或者继续检验。
全文摘要
本发明涉及一种目标-回波-道路网三元数据关联的道路目标多假设跟踪算法，在多假设跟踪方法的基础上，首先利用道路信息对目标状态进行投影修正，包括对道路变更引起的速度突变的修正，来改善跟踪性能；然后对道路网中的目标展开多种可能道路约束下的航迹假设；最后，根据状态投影使得目标相似度提高，可通过合并相似假设来降低算法计算量并提取目标航迹。本发明方案可以实现目标-回波-道路网的三元数据关联下的道路目标跟踪，改善目标跟踪精度，获得杂波环境下道路目标跟踪性能的有效提升，对于道路目标跟踪应用具有非常重要的意义。
文档编号G06T7/20GK103247057SQ201310167248
公开日2013年8月14日 申请日期2013年5月8日 优先权日2013年5月8日
发明者梁彦, 王莉, 冯肖雪, 杨峰, 兰华, 焦连猛, 潘泉 申请人:西北工业大学