发明名称 基于动态重采样粒子滤波的雷达目标跟踪方法
摘要 本发明提出一种基于动态重采样粒子滤波的雷达目标跟踪方法,采用动态重采样算法动态地确定参与重采样的粒子个数,实现粒子退化和粒子贫化的有效折中,保证了重采样前后粒子集所表示的分布相同。本发明在重采样开始时,将归一化权重代入计算N<sub>eff</sub>(0)值,若N<sub>eff</sub>(0)<N<sub>th</sub>,表明粒子退化问题比较严重,需要重采样;每轮只随机选取一个粒子进行重采样,然后计算当前粒子‑权重对集的N<sub>eff</sub>(k)值,直至满足N<sub>eff</sub>(k)≥N<sub>th</sub>;为了避免在每轮针对一个粒子重采样后对残余粒子集中所有粒子进行权重更新导致的计算量巨大的问题,本发明采用二分法针对k<sub>m</sub>个粒子进行重采样实现了快速动态重采样,极大地提高了该算法的效率。
申请公布号 CN106056632A 申请公布日期 2016.10.26
申请号 CN201610397295.X 申请日期 2016.06.07
申请人 西北工业大学 发明人 左军毅;颜斌华;王宏伟;仲于江
分类号 G06T7/20(2006.01)I 主分类号 G06T7/20(2006.01)I
代理机构 西北工业大学专利中心 61204 代理人 陈星
主权项 一种基于动态重采样粒子滤波的雷达目标跟踪方法,其特征在于:包括以下步骤:步骤1:建立粒子‑权重对集并初始化:<maths num="0001"><math><![CDATA[<mrow><mo>&lsqb;</mo><msubsup><mrow><mo>{</mo><mrow><mo>(</mo><msubsup><mi>x</mi><mi>t</mi><mrow><mo>(</mo><mi>j</mi><mo>*</mo><mo>)</mo></mrow></msubsup><mo>,</mo><msubsup><mi>&pi;</mi><mi>t</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><mo>)</mo></mrow><mo>}</mo></mrow><mrow><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><mo>&rsqb;</mo><mo>=</mo><mi>D</mi><mi>Re</mi><mi>s</mi><mi>a</mi><mi>m</mi><mi>p</mi><mi>l</mi><mi>e</mi><mo>&lsqb;</mo><msubsup><mrow><mo>{</mo><mrow><mo>(</mo><msubsup><mi>x</mi><mi>t</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></msubsup><mo>,</mo><msubsup><mi>&pi;</mi><mi>t</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></msubsup><mo>)</mo></mrow><mo>}</mo></mrow><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><mo>&rsqb;</mo></mrow>]]></math><img file="FDA0001011518690000011.GIF" wi="1100" he="87" /></maths>其中<img file="FDA0001011518690000012.GIF" wi="93" he="71" />表示被跟踪目标在t时刻的坐标,上标j表示第j个粒子,<img file="FDA0001011518690000013.GIF" wi="78" he="70" />表示t时刻第j个粒子的权重,N表示粒子总数量;令k=0,<img file="FDA0001011518690000014.GIF" wi="487" he="71" />步骤2:对Φ<sub>0</sub>(N,t)中的元素按权重由大到小排序,设置Φ<sub>1</sub>(N‑k,t)=Φ<sub>0</sub>(N,t),<img file="FDA0001011518690000015.GIF" wi="232" he="55" />l(0)=1;并根据<maths num="0002"><math><![CDATA[<mrow><msub><mi>N</mi><mrow><mi>e</mi><mi>f</mi><mi>f</mi></mrow></msub><mo>&ap;</mo><mfrac><mn>1</mn><mrow><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><mrow><mo>(</mo><msup><msub><mi>&pi;</mi><mi>t</mi></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></msup><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac></mrow>]]></math><img file="FDA0001011518690000016.GIF" wi="366" he="135" /></maths>计算N<sub>eff</sub>(k),其中N<sub>eff</sub>(k)表示第k时刻有效样本容量;步骤3:动态重采样:判断公式N<sub>eff</sub>(k)<N<sub>th</sub>是否成立,N<sub>th</sub>为阈值参数;当公式成立时:从Φ<sub>1</sub>(N‑k,t)中将第N‑k个粒子‑权重对淘汰;计算被淘汰的粒子权重:<img file="FDA0001011518690000017.GIF" wi="394" he="62" />计算由第k+1轮重采样引起的权重修正系数<maths num="0003"><math><![CDATA[<mrow><mi>&gamma;</mi><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mi>N</mi><mo>-</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mrow><mi>N</mi><mo>-</mo><mi>k</mi><mo>-</mo><msubsup><mi>N&pi;</mi><mi>t</mi><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mi>k</mi><mo>)</mo></mrow></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0001011518690000018.GIF" wi="558" he="134" /></maths>根据<maths num="0004"><math><![CDATA[<mrow><msub><mi>N</mi><mrow><mi>e</mi><mi>f</mi><mi>f</mi></mrow></msub><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>&gamma;</mi><mn>2</mn></msup><mo>(</mo><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow><mo>)</mo><msub><mi>N</mi><mrow><mi>e</mi><mi>f</mi><mi>f</mi></mrow></msub><msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>-</mo><msup><mi>&gamma;</mi><mn>2</mn></msup><mo>(</mo><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow><mo>)</mo><msubsup><mi>&pi;</mi><mi>t</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow></msubsup><msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><mfrac><mrow><mn>1</mn><mo>+</mo><mi>k</mi><mo>-</mo><msup><mi>&gamma;</mi><mn>2</mn></msup><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>k</mi></mrow><msup><mi>N</mi><mn>2</mn></msup></mfrac><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup></mrow>]]></math><img file="FDA0001011518690000019.GIF" wi="1285" he="127" /></maths>计算N<sub>eff</sub>(k+1);计算l(k+1)=l(k)γ(k+1);使用改进的二分法从<img file="FDA00010115186900000110.GIF" wi="251" he="63" />中生成新粒子<img file="FDA00010115186900000111.GIF" wi="92" he="60" />更新粒子‑权重对集:<img file="FDA00010115186900000112.GIF" wi="673" he="63" />循环本步骤,直至公式N<sub>eff</sub>(k)<N<sub>th</sub>不成立时,取k<sub>m</sub>=k,并进入步骤4;步骤4:更新残余粒子‑权重对集:对序号在1:N‑k<sub>m</sub>范围内的粒子进行权重更新<img file="FDA00010115186900000113.GIF" wi="297" he="63" />用<img file="FDA0001011518690000021.GIF" wi="110" he="63" />取代Φ<sub>1</sub>(N‑k<sub>m</sub>,t)中第i个粒子的权重;更新后的粒子‑权重对集表示为<img file="FDA0001011518690000022.GIF" wi="886" he="71" />步骤5:输出被跟踪目标位置状态估计<img file="FDA0001011518690000023.GIF" wi="291" he="107" />步骤6:判断是否达到设置的迭代次数n,若达到,则结束方法,否则令t=t+1并返回步骤2。
地址 710072 陕西省西安市友谊西路127号