发明名称 基于多模粒子滤波和数据关联的机动微弱目标检测前跟踪方法
摘要 本发明公开了一种基于多模粒子滤波和数据关联的机动微弱目标检测前跟踪方法,属于雷达数据处理领域。本发明提出的方法立足于解决低信噪比情况下的机动微弱目标检测与跟踪问题,在实现对机动微弱目标检测同时提供目标航迹信息,并有效消除目标信噪比低、机动大造成的目标漏检问题。本发明的方法主要包括以下步骤:(1)利用多模粒子滤波得到各时刻的目标状态和状态协方差估计;(2)将多模粒子滤波的结果重新定义为量测值,利用“状态估计-航迹”数据关联给出目标航迹信息。本发明克服了基于多模粒子滤波的机动微弱目标检测前跟踪方法的局限性,通过有效降低漏检概率,进而保证目标航迹的连续性,同时本发明具有结构简单、易于硬件实现等优点,因此具有较强的工程应用价值和推广前景。
申请公布号 CN102621542A 申请公布日期 2012.08.01
申请号 CN201210106254.2 申请日期 2012.04.02
申请人 中国人民解放军海军航空工程学院 发明人 王国宏;谭顺成;贾舒宜;于洪波;关成斌
分类号 G01S13/66(2006.01)I 主分类号 G01S13/66(2006.01)I
代理机构 代理人
主权项 1.基于多模粒子滤波和数据关联的机动微弱目标检测前跟踪方法,其特征包括以下步骤:步骤1:变量初始化K是总仿真时间;T是雷达扫描周期;N是滤波器采用的粒子数;SNR是目标信噪比;I<sub>mim</sub>和I<sub>max</sub>是目标可能的最小和最大强度;v<sub>min</sub>和v<sub>max</sub>是目标可能的最小和最大速度;γ是目标存在判决门限;<img file="FSA00000699913600011.GIF" wi="309" he="63" />是目标初始运动模式η<sub>0</sub>是目标初始存在概率;L×H表示雷达监测区域的大小;∏<sub>e</sub>是目标存在状态概率转移矩阵;∏<sub>m</sub>是目标运动模式概率转移矩阵;Q<sub>k</sub>是过程噪声协方差;步骤2:令k=0,进行粒子初始化,得到初始粒子集<img file="FSA00000699913600012.GIF" wi="285" he="86" />其中,<img file="FSA00000699913600013.GIF" wi="377" he="83" /><img file="FSA00000699913600014.GIF" wi="503" he="84" />包含目标的位置<img file="FSA00000699913600015.GIF" wi="179" he="75" />速度<img file="FSA00000699913600016.GIF" wi="151" he="76" />和强度<img file="FSA00000699913600017.GIF" wi="35" he="53" />信息,<img file="FSA00000699913600018.GIF" wi="31" he="53" />是目标运动模式变量,<img file="FSA00000699913600019.GIF" wi="47" he="53" />是目标存在状态变量,i=1,2,…,N(1)令i=1;(2)目标位置初始化<maths num="0001"><![CDATA[<math><mrow><msubsup><mi>x</mi><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><mi>L</mi><mo>&times;</mo><mi>rand</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0002"><![CDATA[<math><mrow><msubsup><mi>y</mi><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><mi>H</mi><mo>&times;</mo><mi>rand</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths>rand(1)表示按照均匀分布产生一个[0,1]区间上的随机数;(3)目标速度初始化<maths num="0003"><![CDATA[<math><mrow><msubsup><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><msub><mi>v</mi><mi>min</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>v</mi><mi>max</mi></msub><mo>-</mo><msub><mi>v</mi><mi>min</mi></msub><mo>)</mo></mrow><mo>&times;</mo><mi>rand</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0004"><![CDATA[<math><mrow><msubsup><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><msub><mi>v</mi><mi>min</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>v</mi><mi>max</mi></msub><mo>-</mo><msub><mi>v</mi><mi>min</mi></msub><mo>)</mo></mrow><mo>&times;</mo><mi>rand</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>(4)目标强度初始化<maths num="0005"><![CDATA[<math><mrow><msubsup><mi>I</mi><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><msub><mi>I</mi><mi>min</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>I</mi><mi>max</mi></msub><mo>-</mo><msub><mi>I</mi><mi>min</mi></msub><mo>)</mo></mrow><mo>&times;</mo><mi>rand</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>(5)根据目标初始运动模式概率<img file="FSA00000699913600022.GIF" wi="57" he="50" />初始化目标运动模式变量<img file="FSA00000699913600023.GIF" wi="58" he="52" />(6)根据目标初始存在概率η<sub>0</sub>初始化目标存在状态变量<img file="FSA00000699913600024.GIF" wi="70" he="53" />(7)粒子权重初始化<maths num="0006"><![CDATA[<math><mrow><msubsup><mi>w</mi><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><mfrac><mn>1</mn><mi>N</mi></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths>(8)令i=i+1,若i≤N,转(2);步骤3:令k=k+1,获得k时刻的雷达量测将雷达接收到的信号进行A/D变换,得到k时刻的雷达量测<maths num="0007"><![CDATA[<math><mrow><msub><mi>z</mi><mi>k</mi></msub><mo>{</mo><msubsup><mi>z</mi><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mo>|</mo><mi>p</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>m</mi><mo>;</mo><mi>q</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>n</mi><mo>}</mo><mo>,</mo></mrow></math>]]></maths>送雷达数据处理计算机;步骤4:对初始粒子集进行预测,得到粒子集<img file="FSA00000699913600027.GIF" wi="337" he="85" />其中,<img file="FSA00000699913600028.GIF" wi="544" he="83" />(1)令i=1;(2)根据前一时刻的目标存在状态变量<img file="FSA00000699913600029.GIF" wi="77" he="54" />和目标存在状态概率转移矩阵∏<sub>e</sub>预测当前时刻目标存在状态变量<img file="FSA000006999136000210.GIF" wi="119" he="58" />(3)若<img file="FSA000006999136000211.GIF" wi="159" he="53" />且<img file="FSA000006999136000212.GIF" wi="193" he="58" />利用方程(1)-方程(5)生成粒子状态<img file="FSA000006999136000213.GIF" wi="123" he="58" />并根据<img file="FSA000006999136000214.GIF" wi="42" he="39" />随机生成目标运动模式变量<img file="FSA000006999136000215.GIF" wi="103" he="58" />(4)若<img file="FSA000006999136000216.GIF" wi="149" he="52" />且<img file="FSA000006999136000217.GIF" wi="193" he="58" />根据前一时刻的目标运动模式变量<img file="FSA000006999136000218.GIF" wi="57" he="53" />和目标运动模式概率转移矩阵∏<sub>m</sub>预测当前时刻目标运动模式变量<img file="FSA000006999136000219.GIF" wi="105" he="58" />(5)根据<img file="FSA000006999136000220.GIF" wi="82" he="58" />选择目标状态状态转移矩阵,其中<maths num="0008"><![CDATA[<math><mrow><msubsup><mi>F</mi><mi>k</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow></math>]]></maths>对应于目标匀速直线运动(CV模型)<maths num="0009"><![CDATA[<math><mrow><msubsup><mi>F</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mfrac><mrow><mi>sin</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mrow><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mfrac><mrow><mn>1</mn><mo>-</mo><mi>cos</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mrow><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup></mfrac></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mfrac><mrow><mn>1</mn><mo>-</mo><mi>cos</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mrow><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup></mfrac></mtd><mtd><mn>1</mn></mtd><mtd><mfrac><mrow><mi>sin</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mrow><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup></mfrac></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mrow><mo>(</mo><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mi>T</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths>j=2,3(8)对应于目标坐标转动(CT模型),其中<maths num="0010"><![CDATA[<math><mrow><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msubsup><mo>=</mo><mfrac><msub><mrow><mo>-</mo><mi>&alpha;</mi></mrow><mi>m</mi></msub><msqrt><msup><mrow><mo>(</mo><msubsup><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mn>2</mn></msup></msqrt></mfrac><mo>,</mo></mrow></math>]]></maths><maths num="0011"><![CDATA[<math><mrow><msubsup><mi>&Omega;</mi><mi>k</mi><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></msubsup><mo>=</mo><mfrac><msub><mi>&alpha;</mi><mi>m</mi></msub><msqrt><msup><mrow><mo>(</mo><msubsup><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mn>2</mn></msup></msqrt></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow></math>]]></maths>分别对应于顺时针坐标转动和逆时针坐标转动,α<sub>m</sub>>0是一个典型的机动加速度;(6)根据目标运动模式变量<img file="FSA00000699913600033.GIF" wi="104" he="58" />选择相应的状态转移方程,对粒子i的状态进行一步预测<maths num="0012"><![CDATA[<math><mrow><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>=</mo><msubsup><mi>F</mi><mi>k</mi><mrow><mo>(</mo><msub><mi>r</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow></msubsup><msubsup><mi>x</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>+</mo><msub><mi>v</mi><mi>k</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,v<sub>k</sub>为过程噪声,其噪声协方差为Q<sub>k</sub>;(7)令i=i+1,若i≤N,转(2);步骤5:利用当前时刻的量测对粒子权重进行更新(1)令i=1;(2)确定似然区域的范围<maths num="0013"><![CDATA[<math><mrow><msub><mi>C</mi><mi>p</mi></msub><mrow><mo>(</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mo>=</mo><mo>{</mo><msub><mi>p</mi><mn>0</mn></msub><mo>-</mo><mi>s</mi><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msub><mi>p</mi><mn>0</mn></msub><mo>-</mo><mn>1</mn><mo>,</mo><msub><mi>p</mi><mn>0</mn></msub><mo>,</mo><msub><mi>p</mi><mn>0</mn></msub><mo>+</mo><mn>1</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msub><mi>p</mi><mn>0</mn></msub><mo>+</mo><mi>s</mi><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0014"><![CDATA[<math><mrow><msub><mi>C</mi><mi>q</mi></msub><mrow><mo>(</mo><msubsup><mi>y</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mo>=</mo><mo>{</mo><msub><mi>q</mi><mn>0</mn></msub><mo>-</mo><mi>s</mi><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msub><mi>q</mi><mn>0</mn></msub><mo>-</mo><mn>1</mn><mo>,</mo><msub><mi>q</mi><mn>0</mn></msub><mo>,</mo><msub><mi>q</mi><mn>0</mn></msub><mo>+</mo><mn>1</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msub><mi>q</mi><mn>0</mn></msub><mo>+</mo><mi>s</mi><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,p<sub>0</sub>表示最接近状态矢量元素<img file="FSA00000699913600037.GIF" wi="290" he="58" />的整数,q<sub>0</sub>表示最接近状态矢量元素<img file="FSA00000699913600038.GIF" wi="297" he="59" />的整数,s为预设参数;(3)粒子权重更新<maths num="0015"><![CDATA[<math><mrow><msubsup><mi>w</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><munder><mi>&Pi;</mi><mrow><mi>p</mi><mo>&Element;</mo><msub><mi>C</mi><mi>p</mi></msub><mrow><mo>(</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow></mrow></munder><munder><mi>&Pi;</mi><mrow><mi>q</mi><mo>&Element;</mo><msub><mi>C</mi><mi>q</mi></msub><mrow><mo>(</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow></mrow></munder><mi>l</mi><mrow><mo>(</mo><msubsup><mi>z</mi><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mo>|</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow></mtd><mtd><msubsup><mi>E</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>=</mo><mn>1</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><msubsup><mi>E</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>=</mo><mn>0</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中<maths num="0016"><![CDATA[<math><mrow><mi>l</mi><mrow><mo>(</mo><msubsup><mi>z</mi><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mo>|</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mo>=</mo><mi>exp</mi><mo>{</mo><mo>-</mo><mfrac><mrow><msubsup><mi>h</mi><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mrow><mo>(</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mrow><mo>(</mo><msubsup><mi>h</mi><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mrow><mo>(</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mo>-</mo><msubsup><mrow><mn>2</mn><mi>z</mi></mrow><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mo>)</mo></mrow></mrow><msup><mrow><mn>2</mn><mi>&sigma;</mi></mrow><mn>2</mn></msup></mfrac><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0017"><![CDATA[<math><mrow><msubsup><mi>h</mi><mi>k</mi><mrow><mo>(</mo><mi>p</mi><mo>,</mo><mi>q</mi><mo>)</mo></mrow></msubsup><mrow><mo>(</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&Delta;</mi><mi>x</mi></msub><msub><mi>&Delta;</mi><mi>y</mi></msub><msubsup><mi>I</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup></mrow><mrow><mn>2</mn><mi>&pi;</mi><msup><mi>&Sigma;</mi><mn>2</mn></msup></mrow></mfrac><mi>exp</mi><mo>{</mo><mo>-</mo><mfrac><mrow><msup><mrow><mo>(</mo><msub><mi>p&Delta;</mi><mi>x</mi></msub><mo>-</mo><msubsup><mi>x</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>q&Delta;</mi><mi>y</mi></msub><mo>-</mo><msubsup><mi>y</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mo>)</mo></mrow><mn>2</mn></msup></mrow><mrow><mn>2</mn><msup><mi>&Sigma;</mi><mn>2</mn></msup></mrow></mfrac><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>15</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,σ<sup>2</sup>为量测噪声协方差,Δ<sub>x</sub>和Δ<sub>y</sub>表示传感器分辨率,∑表示传感器模糊斑点数;(4)令i=i+1,若i≤N,转(2);(5)权重归一化<maths num="0018"><![CDATA[<math><mrow><msubsup><mi>w</mi><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><mfrac><msubsup><mi>w</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mrow><munderover><mi>&Sigma;</mi><mrow><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><msubsup><mi>w</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>j</mi></msubsup></mrow></mfrac><mo>,</mo></mrow></math>]]></maths>i=1,2,…,N    (16)步骤6:重采样对权重更新后的粒子集<img file="FSA00000699913600042.GIF" wi="249" he="85" />进行重采样<maths num="0019"><![CDATA[<math><mrow><msubsup><mrow><mo>{</mo><msubsup><mi>y</mi><mi>k</mi><mi>l</mi></msubsup><mo>,</mo><mrow><mo>(</mo><mn>1</mn><mo>/</mo><mi>N</mi><mo>)</mo></mrow><mo>}</mo></mrow><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><mo>=</mo><mi>resample</mi><msubsup><mrow><mo>{</mo><msubsup><mi>y</mi><mrow><mi>k</mi><mo>|</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><msubsup><mi>w</mi><mi>k</mi><mi>l</mi></msubsup><mo>}</mo></mrow><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow></math>]]></maths>得到k时刻的粒子集<img file="FSA00000699913600044.GIF" wi="288" he="85" />其中<img file="FSA00000699913600045.GIF" wi="378" he="83" />步骤7:目标状态和状态协方差估计(1)计算目标存在概率<maths num="0020"><![CDATA[<math><mrow><msub><mover><mi>P</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><mfrac><mn>1</mn><mi>N</mi></mfrac><munderover><mi>&Sigma;</mi><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><msubsup><mi>E</mi><mi>k</mi><mi>l</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>16</mn><mo>)</mo></mrow></mrow></math>]]></maths>(2)若<img file="FSA00000699913600047.GIF" wi="146" he="65" />进行目标状态估计<maths num="0021"><![CDATA[<math><mrow><msub><mover><mi>x</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><mfrac><mrow><munderover><mi>&Sigma;</mi><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><msubsup><mi>x</mi><mi>k</mi><mi>l</mi></msubsup><msubsup><mi>E</mi><mi>k</mi><mi>l</mi></msubsup></mrow><mrow><munderover><mi>&Sigma;</mi><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><msubsup><mi>E</mi><mi>k</mi><mi>l</mi></msubsup></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>19</mn><mo>)</mo></mrow></mrow></math>]]></maths>和状态协方差估计<maths num="0022"><![CDATA[<math><mrow><msub><mover><mi>B</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><mfrac><mn>1</mn><mi>N</mi></mfrac><munderover><mi>&Sigma;</mi><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><mrow><mo>(</mo><msub><mover><mi>x</mi><mo>^</mo></mover><mi>k</mi></msub><mo>-</mo><msubsup><mi>x</mi><mi>k</mi><mi>l</mi></msubsup><mo>)</mo></mrow><msup><mrow><mo>(</mo><msub><mover><mi>x</mi><mo>^</mo></mover><mi>k</mi></msub><mo>-</mo><msubsup><mi>x</mi><mi>k</mi><mi>l</mi></msubsup><mo>)</mo></mrow><mi>T</mi></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>20</mn><mo>)</mo></mrow></mrow></math>]]></maths>步骤8:“状态估计-航迹”数据关联(1)如果当前时刻不存在目标状态估计<img file="FSA000006999136000410.GIF" wi="201" he="65" />转(4);(2)将目标状态估计<img file="FSA000006999136000411.GIF" wi="44" he="55" />等效为新的量测值,状态协方差估计<img file="FSA000006999136000412.GIF" wi="51" he="65" />等效为量测误差;(3)若当前时刻不存在目标航迹,将新量测作为航迹头,利用m/n逻辑法进行航迹起始;否则,利用新量测对目标航迹τ<sub>k-1</sub>或τ′<sub>k-1</sub>进行更新,得到更新的航迹τ<sub>k</sub>,转步骤9;(4)如果当前时刻存在目标航迹τ<sub>k-1</sub>或τ′<sub>k-1</sub>,若已经连续3个时刻不存在目标状态估计,输出航迹τ<sub>k-3</sub>并删除航迹τ′<sub>k-1</sub>;否则,对τ<sub>k-1</sub>或τ′<sub>k-1</sub>进行一步预测,得到预测τ′<sub>k</sub>;步骤9:重复步骤3~步骤8,直至雷达关机。
地址 264001 山东省烟台市二马路188号科研部