专利摘要
本发明提供一种基于多维拟合的多目标跟踪方法,该方法包括以下步骤:1)对待跟踪目标的位置通过高斯牛顿算法得到多个目标的DOA测试值,并对该测试值采用预测门限检验,2)采用卡尔曼滤波器对第一阶段的测试值进行平滑处理。本发明很大程度上减少了多目标跟踪问题中的计算量大的问题,并且能处理多目标位置出现交叉的跟踪问题。
权利要求
1.一种基于多维拟合的多目标跟踪方法,其特征在于,所述基于多维拟合的多目标跟踪方法包括:
通过高斯牛顿算法对待跟踪目标的位置进行计算得到多个目标的DOA测试值,并对该测试值采用预测门限检验;
采用卡尔曼滤波器对所述DOA测试值进行平滑处理;
所述基于多维拟合的多目标跟踪方法还包括以下步骤:
批量输入M个目标在k-1时刻的状态向量
根据
将所述预测DOA值
根据第k时刻的模型误差方差估计值
计算第t时刻的模型误差协方差矩阵
计算卡尔曼滤波器增益
更新k时刻的状态向量
提取状态向量
计算
所述采用高斯牛顿算法求得测试值
计算一阶偏导向量r:
其中,Tr(·)表示矩阵的迹,Π
计算二阶偏导矩阵H:
其中,i,j表示矩阵的行与列的序号,[H]
计算残差向量Δη=H
若满足不等式Δη
2.根据权利要求1所述的一种基于多维拟合的多目标跟踪方法,其特征在于,所述系统从k-1时刻到k时刻的状态转移矩阵F为:
3.根据权利要求2所述的一种基于多维拟合的多目标跟踪方法,其特征在于,所述的Δη
4.根据权利要求3所述的一种基于多维拟合的多目标跟踪方法,其特征在于,所述e
5.根据权利要求4所述的一种基于多维拟合的多目标跟踪方法,其特征在于,所述ε
说明书
技术领域
本发明涉及一种多目标跟踪方法,特别是涉及一种基于多维拟合的多目标跟踪方法。
背景技术
多个移动目标的DOA(direction-of-arrival,DOA,来波方向)跟踪方法一直以来是信号处理的热点问题。针对此问题以往的DOA跟踪算法是假设目标的方向在短时间窗内不随时间变化下用经典的基于子空间的DOA估计算法去估计信源方位,如利用最小二乘算法、牛顿法、最大似然算法,利用前一时刻的位置信息去估计下一时刻的位置信息以跟踪运动信源的DOA。但这些方法都难以避开“数据关联”的难题,即处理两个连续时间不同信号间的DOA估计,因此,这些方法都有着计算复杂度大的问题。
发明内容
鉴于以上所述现有技术的缺点,本发明的目的在于提供一种基于多维拟合的多目标跟踪方法,用于解决现有技术中计算复杂度大的问题。
为实现上述目的及其他相关目的,本发明提供一种基于多维拟合的多目标跟踪方法,所述基于多维拟合的多目标跟踪方法包括:
通过高斯牛顿算法对待跟踪目标的位置进行计算得到多个目标的DOA测试值,并对该测试值采用预测门限检验;
采用卡尔曼滤波器对所述DOA测试值进行平滑处理;
所述基于多维拟合的多目标跟踪方法还包括以下步骤:
批量输入 个目标在 时刻的状态向量 和模型误差协方差矩阵 , ;
根据 预测 时刻的状态向量 ,提取所述状态向量 的第一个元素作为预测DOA值 , ,其中 表示系统从
将所述预测DOA值 作为初始值,采用高斯牛顿算法求得测试值 ;
根据第
计算第
计算卡尔曼滤波器增益 , 表示测量矩阵C的共轭转置, 表示
更新
提取状态向量 的第一个元素作为第 时刻的DOA估计值 ;
计算 用于下次迭代;
所述采用高斯牛顿算法求得测试值 具体包括:
计算一阶偏导向量 :
,
其中, 表示矩阵的迹, 为信号子空间投影算子,R表示阵列信号的二阶协方差矩阵, ;
计算二阶偏导矩阵 :
其中,
计算残差向量 , 表示矩阵H的逆;
若满足不等式 ,则更新 ,否则 , 为预设阈值,S表示残差协方差矩阵, 表示误差向量的第
可选地,所述系统从
,T是跟踪的时间间隔,即每隔T秒,跟踪一次目标的方位信息。
可选地,所述的 服从自由度为1的 分布。
可选地,所述 服从均值为0,方差为 的高斯分布。
可选地,所述 服从均值为0,方差为 的高斯分布。
如上所述,本发明的一种基于多维拟合的多目标跟踪方法,主要用于改善现有多目标跟踪算法的复杂度大和准确度低的问题,特别用于解决运动的目标状态交叉时现有算法无法正确检测目标信息的问题。具有以下有益效果:
本发明提高了现有多目标跟踪算法的准确度并减少计算量;当运动的目标状态交叉时本算法能正确预测目标位置。
附图说明
图1为本发明所述方法的流程图;
图2为待跟踪目标的DOA运动图;
图3为本发明算法的跟踪结果图;
图4为传统MUSIC算法的跟踪结果图。
具体实施方式
以下通过特定的具体实例说明本发明的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本发明的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。
需要说明的是,以下实施例中所提供的图示仅以示意方式说明本发明的基本构想,遂图式中仅显示与本发明中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制,其实际实施时各组件的型态、数量及比例可为一种随意的改变,且其组件布局型态也可能更为复杂。
本技术领域技术人员可以理解,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且排除像这里一样定义,不会用理想化或过于正式的含义来解释。
具体地,请参阅图1,本发明提供一种基于多维拟合的多目标跟踪方法,包括以下步骤:
(1)批量输入 个目标在 时刻的状态向量 和模型误差协方差矩阵为 , ;所述模型是卡尔曼滤波器的目标动态模型。
(2)根据 预测 时刻的状态向量 ,提取状态向量 的第一个元素作为预测DOA值 , ;
(3)将步骤(2)中的预测DOA值 作为初始值,采用高斯牛顿算法求测试值 ,具体算法流程如图2所示。
(3.1)计算一阶偏导向量 :
,
其中, 表示矩阵的迹, 为信号子空间投影算子, 表示二阶偏导矩阵 的第
(3.2)计算二阶偏导矩阵 :
(3.3)计算残差向量 , 表示矩阵H的逆;
所述的残差向量 可以通过以下方法获得:
多维子空间的拟合问题为: ,其中 为信号子空间投影算子, 表示阵列天线接受的信号。
对上式展开,
其中 表示在第 个时间周期 , 内信号 的协方差矩阵,其中 。
由于 随第 个元素 相关,对上式求得一阶导数和二阶导数, 分别表示误差向量 的第
另一方面,对 进行二阶泰勒展开,
, 表示第m个目标的DOA信息。
对上式求导得,
。
令 得,
将 一阶导数和二阶导数带入上式并舍去二阶偏导项得,
由 ,可得 ,其中,
;
, 。
(3.4)若满足不等式 ,则更新 ,否则 ;
(4)根据第
(5)计算第
(6)计算卡尔曼滤波器增益 , 表示测量矩阵C的共轭转置, 表示k时刻的残差协方差矩阵;其中 ;
(7)更新
(8)提取状态向量 的第一个元素作为第 时刻的DOA估计值 ;
(9)计算 用于下次迭代。
为目标个数; 表示矩阵的迹; 表示系统从 时刻到 时刻的状态转移矩阵; 为 时刻的残差协方差矩阵; 为预设阈值; 的表示模型误差方差估计值; 表示样本的数量; 表示当前状态与预测状态之间的差值; 表示测量误差的方差估计值; 表示测量误差; 表示测量矩阵。
本发明提供一种基于多维拟合的多目标跟踪方法,所要解决的技术问题主要用于改善当前现有多目标跟踪算法的复杂度和准确度。本发明将此问题分为两个阶段,第一阶段对待跟踪目标的位置通过高斯牛顿算法得到多个目标的DOA测试值,并对该测试值采用预测门限检验,第二阶段采用卡尔曼滤波器对第一阶段的测试值进行平滑处理。本发明很大程度上减少了多目标跟踪问题中的计算量大的问题,并且能处理多目标位置出现交叉的跟踪问题。
于本实施例中,步骤(1)中第 个信源在
于本实施例中,步骤(2)中 ,T是跟踪的时间间隔。
于本实施例中,步骤(3)中 服从自由度为1的 分布,故 的选择由自由度为1,置信度为 的 分布表得到,一般有 。
于本实施例中,步骤(4) 服从均值为0,方差为 的高斯分布,根据 得到估计值 。
于本实施例中,步骤(4) 服从均值为0,方差为 的高斯分布,其中 ,根据 得到估计值 。
于本实施例中,选取如下迭代初始值,其中初始值 和 由高斯牛顿算法求出,而 , , , 。
表示第
至于 的初始值由于卡尔曼滤波器更新DOA估计值时会延迟一步,为简单起见,将其初始值设置为0,而模型仿真结果显示卡尔曼滤波器能够迅速收敛和跟踪DOA估计值。 的初始值 ,将 带入 得 , 初始值为 ,其中 , 设置为任意小的两个正数。
上述实施例仅例示性说明本发明的原理及其功效,而非用于限制本发明。任何熟悉此技术的人士皆可在不违背本发明的精神及范畴下,对上述实施例进行修饰或改变。因此,举凡所属技术领域中具有通常知识者在未脱离本发明所揭示的精神与技术思想下所完成的一切等效修饰或改变,仍应由本发明的权利要求所涵盖。
一种基于多维拟合的多目标跟踪方法专利购买费用说明
Q:办理专利转让的流程及所需资料
A:专利权人变更需要办理著录项目变更手续,有代理机构的,变更手续应当由代理机构办理。
1:专利变更应当使用专利局统一制作的“著录项目变更申报书”提出。
2:按规定缴纳著录项目变更手续费。
3:同时提交相关证明文件原件。
4:专利权转移的,变更后的专利权人委托新专利代理机构的,应当提交变更后的全体专利申请人签字或者盖章的委托书。
Q:专利著录项目变更费用如何缴交
A:(1)直接到国家知识产权局受理大厅收费窗口缴纳,(2)通过代办处缴纳,(3)通过邮局或者银行汇款,更多缴纳方式
Q:专利转让变更,多久能出结果
A:著录项目变更请求书递交后,一般1-2个月左右就会收到通知,国家知识产权局会下达《转让手续合格通知书》。
动态评分
0.0