一种基于道路网的机动目标跟踪算法制造技术

本发明专利技术提供了一种基于道路网的机动目标跟踪算法，借助先验道路信息库，给出一种利用道路信息实现的跟踪算法模型自适应策略，采用变结构的多模型方法实现地面多机动目标跟踪，可以提高机动目标跟踪的状态估计精度，降低目标跟丢率，同时避免固定多模型算法采用过多模型带来的计算负担，大大减少运行时间，本方案在地面目标跟踪问题上有其实用价值。

【技术实现步骤摘要】
一种基于道路网的机动目标跟踪算法
本专利技术属于目标跟踪领域，涉及一种基于道路网的机动目标跟踪算法，具体涉及一种利用道路信息辅助地面目标跟踪的变结构多模型概率假设密度算法。
技术介绍
地面目标跟踪在军事和民用领域有极为广阔的应用前景。地面目标具有运动能力强、运动状态多的特点，基于单模型的滤波器无法满足对其机动的跟踪，传统的方法是利用多模型滤波方法，例如交互式多模型-多假设跟踪算法和交互式多模型-联合概率数据关联算法对地面目标进行跟踪。然而，这种固定模型集算法的性能很大程度上取决于它使用的模型集，为了覆盖目标的全部运动，要求运动模型集中包含目标所有可能的运动模型，并且所有模型在整个跟踪过程中都有效，这一方面导致了计算量的增加，另一方面过多模型的竞争还可能导致目标估计精度的降低。考虑到地面目标的运动受到道路和地形条件的限制，基于道路地理信息辅助的地面目标跟踪算法被提出。该类方法根据道路信息调整目标运动模型，每一跟踪时刻在目标所有可能的运动模型中选择与当前目标真实运动状态匹配的模型子集进行跟踪滤波。这种变模型的结构解决了固定模型方法模型过多的问题，但是该方法依然是基于以数据关联为核心的经典本文档来自技高网...

【技术保护点】
一种基于道路网的机动目标跟踪算法，其特征在于，包括以下步骤：A.构建道路信息库；B.基于道路信息库的地面目标跟踪：B‑1.根据道路信息库确定总目标运动模型集

【技术特征摘要】
1.一种基于道路网的机动目标跟踪算法，其特征在于，包括以下步骤：A.构建道路信息库；B.基于道路信息库的地面目标跟踪：B-1.根据道路信息库确定总目标运动模型集其中，Nr为总模型集的模型个数，每一个运动模型Mp包括该模型的状态转移矩阵Fp和过程噪声协方差矩阵Qp的信息，确定各模型间的模型转移概率矩阵[πpq]，其中p＝1，2，..，Nr，q＝1，2，..，Nr；B-2.初始化，令观测时刻k＝0，即为初始时刻；定义初始时刻的目标后验强度D0(x)为：其中，j＝1，2，...，J0，J0为初始时刻的目标后验强度的高斯分量数，表示均值为协方差矩阵为的高斯分布，和分别为高斯分量j的权重、均值和协方差矩阵，为初始时刻目标个数期望值；B-3.对总目标运动模型集中的每一个运动模型分别定义一个GMPHD滤波器，将每个GMPHD滤波器初始时刻的目标后验强度函数D0，p(x)都取为D0(x)，即：其中，D0，p(x)为基于模型Mp(p＝1，2，..，Nr)定义的GMPHD滤波器的初始目标后验强度函数；B-4.对高斯分量标号j(j＝1，2，..，J0)，定义模型标记向量其中，(p＝1，2，..，Nr，j＝1，2，..，J0)定义为为k＝0时刻标号为j的高斯分量的当前运动模型子集，作为初始时刻，各标号高斯分量的当前运动模型子集(j＝1，2，..，J0)取为总目标运动模型集M，从而对j＝1，2，..，J0，模型标记向量都为全1向量[1，1，...，1]；B-5.对每个高斯分量标号j(j＝1，2，..，J0)，定义模型权重向量其中，(p＝1，2，..，Nr，j＝1，2，..，J0)为模型p在当前运动模型子集中的模型概率(如果模型p不在模型集合中，其概率为0)，作为初始时刻，各标号高斯分量的当前运动模型子集(j＝1，2，..，J0)取为总目标运动模型集M且当前运动模型子集中各模型概率取相等，从而对j＝1，2，..，J0，模型权重向量都为C.令k＝k+1，即为计算下一时刻；D.假设k-1时刻，即k时刻的前一时刻，基于模型Mp定义的GMPHD滤波器(p＝1，2，..，Nr)的目标后验强度函数Dk-1，p(x)如下：其中，j＝1，2，...，Jk-1，Jk-1为k-1时刻目标后验强度的高斯分量数，表示均值为协方差矩阵为的高斯分布，和分别为滤波器后验强度函数的第j个高斯分量的权重、均值和协方差矩阵；假设k-1时刻各高斯分量标号j＝1～Jk-1对应的模型标记向量和模型权重向量分别为和其中，(p＝1，2，..，Nr，j＝1，2，..，Jk-1)定义为：为k-1时刻标号为j的高斯分量的当前运动模型子集，(p＝1，2，..，Nr，j＝1，2，..，Jk-1)为模型p在模型集合中的模型概率；k-1时刻Nr个滤波器的目标后验强度函数组成的集合记为k-1时刻的后验强度函数集合{Dk-1(x)}，其中，{Dk-1(x)}表示集合具体步骤如下：D-1.新生目标强度确定：新生目标强度为高斯和形式：其中，j＝1，2，...，Jγ，k，Jγ，k为新生目标强度的高斯分量数，表示均值为协方差矩阵为的高斯分布，和分别为各高斯分量的权重、均值和协方差矩阵，新生目标强度的具体参数一般事先已经给定；定义新生目标各高斯分量j＝1，2，..，Jγ，k的模型标记向量和模型权重向量分别为和其中，(p＝1，2，..，Nr，j＝1，2，..，Jγ，k)定义为：为新生目标强度标号为j的高斯分量的当前运动模型子集，(p＝1，2，..，Nr，j＝1，2，..，Jγ，k)为模型p在模型集合中的模型概率；对新生目标，各标号高斯分量的当前运动模型子集(j＝1，2，..，Jγ，k)取为总目标运动模型集M且当前运动模型子集中各模型概率取相等，从而对j＝1，2，..，Jγ，k，模型标记向量都为全1向量[1，1，...，1]，模型权重向量都为D-2.运动模型集确定：对j＝1，2，..，Jk-1，根据k-1时刻标号j的模型权重向量得到最大模型权重对应的运动模型取运动模型的状态转移矩阵对基于运动模型的滤波器的目标后验强度中第j个高斯分量进行一步预测，判定预测值在步骤A-1所述数字地图中的坐标，并根据步骤A-2确定的“区域-区域运动模型集”关系得到预测坐标所在区域的预设目标运动模型集，将其作为k时刻标号j对应的当前运动模型子集，记为根据计算模型标记向量具体为将的项置1，其余清0，其中，j＝1，2，...，Jk-1，p＝1，2，..，Nr。对k时刻新生目标强度Dγ，k(x)的各高斯分量j＝1～Jγ，k，判定其均值在步骤A-1所述数字地图中的坐标，并根据A-2确定的“区域-区域运动模型集”关系得到均值坐标所在区域的预设目标运动模型集，将其作为标号为j的新生目标高斯分量在时刻k对应的当前运动模型子集，记为根据对运动模型标记向量进行更新，具体为将的项置1，其余清0，其中，j＝1，2，...，Jγ，k，p＝1，2，..，Nr；D-3.模型混合概率初始化：根据步骤D-2的模型标记向量(j＝1，2，...，Jk-1)和k-1时刻的模型权重向量(j＝1，2，...，Jk-1)，计算各高斯分量在k时刻模型为q(q＝1，2，..，Nr)的情况下k-1时刻模型为p(p＝1，2，..，Nr)的概率规则为：如果则其中，为k时刻模型q的模型权重，计算公式为如果则其中，j＝1，2，..，Jk-1，p＝1，2，..，Nr，q＝1，2，..，Nr。以上步骤后，对标号j的权重(q＝1，2，..，Nr)进行归一化，令归一化结果构成模型权重向量其中，q＝1，2，..，Nr，j＝1，2，...，Jk-1。同理，对新生目标强度Dγ，k(x)的各高斯分量分别计算更新模型权重向量其中，j＝1，2，...，Jγ，k，具体操作类似，不再细述；D-4.混合条件PHD初始化：计算k时刻滤波器(q＝1，2，..，Nr)的重初始化目标强度其中其中，表示均值为协方差矩阵为的高斯分布，和分别为重初始化目标强度高斯分量j的权重、均值和协方差矩阵，计算规则为，如果模型标记向量中，则如果则和取全零矩阵，其中，q＝1，2，..，Nr，j＝1，2，...，Jk-1；D-5.条件PHD预测：计算k时刻滤波器(q＝1，2，..，Nr)的预测强度函数Dk|k-1，q(x)Dk|k-1，q(x)＝Ds，k|k-...

【专利技术属性】
技术研发人员：解梅，苏星霖，叶茂权，秦方，
申请(专利权)人：电子科技大学，
类型：发明
国别省市：四川,51