发明名称 一种具有固定滑窗-OSPA距离航迹关联方法
摘要 本发明涉及一种具有固定滑窗-OSPA距离航迹关联方法,本发明通过把局部航迹描述为一个集合,引入目标航迹集合之间的OSPA距离评价判断两个局部航迹是否属于同一航迹。设计引入上三角分块矩阵和航迹关联矩阵方法完成各个传感器航迹之间的两两匹配过程,再次基础上,进一步设计了具有固定滑窗的递推OSPA航迹距离计算方法。本发明建议的OSPA距离不仅可以有效关联相同航迹,而且可以有效应对航迹交叉、航迹分叉和航迹异步问题。通过与加权航迹关联方法、独立序贯航迹关联方法比较,说明本发明在关联精度、航迹异步问题上具有的独特优势。
申请公布号 CN102608568B 申请公布日期 2014.01.29
申请号 CN201210047321.8 申请日期 2012.02.28
申请人 杭州电子科技大学 发明人 刘伟峰;文成林
分类号 G01S5/00(2006.01)I 主分类号 G01S5/00(2006.01)I
代理机构 杭州求是专利事务所有限公司 33200 代理人 杜军
主权项 1.一种具有固定滑窗-OSPA距离航迹关联方法,其特征在于该方法包括以下步骤:步骤(1)估计目标航迹;依据各个传感器的观测数据,估计获取目标的各个传感器航迹,航迹估计采用通常的目标跟踪方法;步骤(2)构造目标航迹集合;目标在各个时刻的估计状态点,按照时间顺序获得传感器航迹集合;把每个目标航迹看作为一个元素个数可变的集合,假设总的传感器个数为S,对应的集合为:<img file="FDA00003470583800011.GIF" wi="600" he="93" />其中j表示第j个传感器,其中第n<sub>j</sub>条航迹集合<img file="FDA00003470583800012.GIF" wi="104" he="93" />定义如下:<img file="FDA00003470583800013.GIF" wi="418" he="89" />其中<img file="FDA00003470583800014.GIF" wi="220" he="84" />是第j个传感器的第n<sub>j</sub>条航迹从第1到k时刻的航迹状态;步骤(3)计算多传感器航迹之间OSPA距离;传感器j获得t<sub>j</sub>个目标估计航迹<img file="FDA00003470583800015.GIF" wi="218" he="94" />从这些航迹中获取目标航迹个数和估计融合后的航迹;采用集合间最小OSPA距离来评价航迹之间的关联程度,OSPA距离越小,两个目标关联度越大,第i个传感器的第n<sub>i</sub>条航迹<img file="FDA00003470583800016.GIF" wi="86" he="86" />与第i个传感器的第m<sub>i</sub>条目标航迹<img file="FDA00003470583800017.GIF" wi="125" he="88" />其中<img file="FDA00003470583800018.GIF" wi="394" he="86" />是第i个传感器的第m<sub>i</sub>条目标航迹,两条航迹之间的OSPA距离的具体计算公式如下:<img file="FDA00003470583800019.GIF" wi="1660" he="152" /><img file="FDA000034705838000110.GIF" wi="1123" he="94" /><img file="FDA00003470583800021.GIF" wi="1173" he="180" /><img file="FDA00003470583800022.GIF" wi="1151" he="195" />其中π(i)表示第i排列方式;M,N分别表示第k个时刻集合<img file="FDA00003470583800023.GIF" wi="188" he="93" />中航迹的条数,即真实目标航迹条数M和估计目标航迹条数N,L<sub>p</sub>(□,□)是L<sub>p</sub>范数,定义如下:<img file="FDA00003470583800024.GIF" wi="778" he="139" />其中L是向量<img file="FDA00003470583800025.GIF" wi="74" he="86" />的维数;在计算OSPA距离基础之上,采用固定滑窗方法,这样可以减少时间上的累计计算量<img file="FDA00003470583800026.GIF" wi="306" he="87" /><img file="FDA00003470583800027.GIF" wi="1386" he="294" />其中<img file="FDA00003470583800028.GIF" wi="76" he="84" />表示采用宽度为W的固定滑窗OSPA距离,<img file="FDA00003470583800029.GIF" wi="583" he="88" />α<sub>k</sub>,β<sub>k</sub>是OSPA距离权重,分别表示当前滑窗的OSPA距离权重和历史OSPA距离权重,如果看重历史航迹的影响,那么,可以增大权重β<sub>k</sub>,减少α<sub>k</sub>;否则,减少历史权重β<sub>k</sub>影响;步骤(4)选择航迹关联阈值;首先选择阈值r,阈值r设定在<img file="FDA000034705838000210.GIF" wi="182" he="61" />范围内,其中<img file="FDA000034705838000211.GIF" wi="35" he="45" />是平均跟踪误差,c是上边的水平参数,也可通过仿真实验选择一定的阈值r,大于阈值r的航迹属于不同航迹,小于r的属于同一条航迹;步骤(5)获得航迹距离矩阵和关系矩阵;首先获得的航迹OSPA距离矩阵<img file="FDA000034705838000212.GIF" wi="178" he="71" />任意航迹集合距离用D<sub>k</sub>(·,·)来表示,假设传感器个数为S,各个传感器对应的目标个数分别为{t<sub>1</sub>,…,t<sub>S</sub>},整个航迹OSPA距离矩阵用如下的分块矩阵描述:<maths num="0001"><![CDATA[<math><mrow><msubsup><mi>M</mi><mi>k</mi><mo>&perp;</mo></msubsup><mrow><mo>(</mo><mi>S</mi><mo>)</mo></mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mi>O</mi></mtd><mtd><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mn>1,2</mn><mo>)</mo></mrow></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mn>1</mn><mo>,</mo><mi>S</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>O</mi></mtd><mtd><mi>O</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mi>O</mi></mtd><mtd><mi>O</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>S</mi><mo>-</mo><mn>1</mn><mo>,</mo><mi>S</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>O</mi></mtd><mtd><mi>O</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mi>O</mi></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中<maths num="0002"><![CDATA[<math><mrow><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>i</mi><mo>,</mo><mi>j</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd></mtd><mtd><mn>1</mn></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>t</mi><mi>j</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><msub><mi>d</mi><mi>k</mi></msub><mrow><mo>(</mo><msub><mi>i</mi><mn>1</mn></msub><mo>,</mo><msub><mi>j</mi><mn>1</mn></msub><mo>)</mo></mrow></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>d</mi><mi>k</mi></msub><mrow><mo>(</mo><msub><mi>i</mi><mn>1</mn></msub><mo>,</mo><msub><mi>t</mi><mi>j</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><msub><mi>t</mi><mi>i</mi></msub></mtd><mtd><msub><mi>d</mi><mi>k</mi></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>,</mo><msub><mi>j</mi><mn>1</mn></msub><mo>)</mo></mrow></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>d</mi><mi>k</mi></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>,</mo><msub><mi>t</mi><mi>j</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中d<sub>k</sub>(t<sub>i</sub>,t<sub>j</sub>)表示航迹传感器i的第t<sub>i</sub>条航迹和传感器t<sub>j</sub>的第t<sub>j</sub>条航迹之间的OSPA距离;其次,获取如下航迹关系矩阵<img file="FDA00003470583800035.GIF" wi="129" he="67" />基础上,可以进行航迹个数的统计:<maths num="0003"><![CDATA[<math><mrow><msubsup><mi>R</mi><mi>k</mi><mo>&perp;</mo></msubsup><mrow><mo>(</mo><mi>S</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>O</mi></mtd><mtd><mi>&delta;</mi><mo>[</mo><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mn>1,2</mn><mo>)</mo></mrow><mo>&lt;</mo><mi>r</mi><mo>]</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mi>&delta;</mi><mo>[</mo><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mn>1</mn><mo>,</mo><mi>S</mi><mo>)</mo></mrow><mo>&lt;</mo><mi>r</mi><mo>]</mo></mtd></mtr><mtr><mtd><mi>O</mi></mtd><mtd><mi>O</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mi>O</mi></mtd><mtd><mi>O</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mi>&delta;</mi><mo>[</mo><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>S</mi><mo>-</mo><mn>1</mn><mo>,</mo><mi>S</mi><mo>)</mo></mrow><mo>&lt;</mo><mi>r</mi><mo>]</mo></mtd></mtr><mtr><mtd><mi>O</mi></mtd><mtd><mi>O</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mi>O</mi></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中δ[If true]=1,δ[If false]=0;步骤(6)统计航迹个数;依据关联关系,就可以统计获得总的航迹条数:同一行所有列为1的航迹属于同一个目标,需要进行关联,对所有1-S行遍历一次,所有行具有非0元素的算为一个目标航迹,具有非零元素行不进行统计,获得航迹个数:<maths num="0004"><![CDATA[<math><mrow><msub><mi>T</mi><mi>k</mi></msub><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>S</mi></munderover><mo>{</mo><munderover><mi>&Sigma;</mi><mrow><mi>j</mi><mo>=</mo><mi>i</mi><mo>+</mo><mn>1</mn></mrow><mi>S</mi></munderover><mi>&delta;</mi><mo>[</mo><msub><mi>D</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>i</mi><mo>,</mo><mi>j</mi><mo>)</mo></mrow><mo>&lt;</mo><mi>r</mi><mo>]</mo><mo>></mo><mn>0</mn><mo>}</mo></mrow></math>]]></maths>其中T<sub>k</sub>是最终获得的目标航迹条数。
地址 310018 浙江省杭州市下沙高教园区2号大街