一种运动蛙人的跟踪方法
【技术领域】
[0001] 本发明属于一种目标状态估计方法，具体来说涉及一种运动蛙人的跟踪方法。
【背景技术】
[0002] 冷战时期，各国处在战争警戒状态，海上探测和防御的对象主要是敌对国家的舰 船和潜艇等大型目标。随着冷战的结束，特别是前苏联解体后，水下潜水技术发展迅速，蛙 人部队应运而生，所谓的蛙人（Diver)，就是担负着水下侦察、爆破和执行特殊作战任务的 军人，因他们携带的装备中有形似青蛙脚形状的游泳工具，所以称之为"蛙人"。由于蛙人目 标散射强度较弱，再加上蛙人的破坏活动具有显著的"非对称"优势，目前，利用蛙人进行恐 怖袭击成为恐怖主义分子进行恐怖活动的重要方式。
[0003] 近年来，国内外学者对水下蛙人的探测及识别进行了大量的研究；文献 1 (Anders Redningsby,1 Yaakov Bar-Shalom. Tracking of Divers in a Noisy Background Using a Bubble Model[C]. Signal and Data Processing of Small Targets, 2007) 针对开式蛙人呼吸形成气泡造成的干扰对数据关联的影响，对传统的概率数据关联 (PDA)算法进行了改进，但蛙人状态估计的运动模型采用的是传统的运动模型。文 献 2 (Dietmar Stiller, Bernd Niitzel. Detection and tracking of divers [C]. Underwater Defenc Technology. 2009)和文献 3 (Liu Xinke, Xiong Zhengxiang. Underwater Small Target Tracking Algorithm Based On Diver Detection Sonar Image Sequences[C]. International Conference on Industrial Control and Electronics Engineering:727-730. 2012)是借鉴载有机械推进装置的航行器类目标的运动模型估计蛙 人目标状态。上述方法建立的运动模型由于没有准确反映蛙人的运动特点，存在跟踪精度 低、稳定性差等缺点。
[0004] 文献 4(Ralf Siegfried. Ships，Protection against Diver Attacks[C]· Underwater Defence Technology. 2005)分析了蛙人目标与其他机械类目标在运动方式 的不同点：蛙人目标可在极短时间内实现运动方向的转换，且运动速度较低；机械类目标 在一段时间内基本上按照在某一方向进行较高速度的运动，且不会在较短时间进行速度切 换。文献5(陈旸.水下运动小目标探测与跟踪技术研究[D].中国科学院声学研究所硕士 学位论文：32-33,2011.)得到了水下蛙人具有"运动速率低、方向变化率高"的运动特点。
【发明内容】
[0005] 本发明的目的在于克服现有蛙人跟踪方法存在的跟踪精度低、稳定性差的缺点， 利用水下蛙人的"低运动速率、高方向变化率"的运动特点，提出了针对蛙人这一特定目标 的基于多运动方向模型的交互式融合的跟踪方法，实现蛙人目标状态更高精度、更稳定的 估计。
[0006] 为了实现上述目标，本发明提出了一种运动蛙人的跟踪方法，所述方法包括：
[0007] 步骤1)接收tk+1时刻蛙人状态的观测值；
[0008] 步骤2)建立tk时刻蛙人多方向运动的运动模型集；
[0009] 步骤3)根据所述运动模型集计算tk+1时刻每个运动模型的蛙人状态估计初值和 协方差估计初值；
[0010] 步骤4)将tk+1时刻每个运动模型的蛙人状态估计初值和协方差估计初值输入若 干个滤波器，结合t k+1时刻蛙人状态的观测值计算每个运动模型的蛙人状态估计及其协方 差估计；
[0011] 步骤5)根据的tk+1时刻每个运动模型的蛙人状态估计及其协方差估计更新t k+1时 刻每个运动模型的概率；
[0012] 步骤6)根据更新后的每个运动模型的概率对蛙人状态进行融合估计，得到tk+1时 刻蛙人状态的估计及其协方差的估计。
[0013] 上述技术方案中，所述步骤2)进一步包括：
[0014] tk时刻蛙人状态包括位置和速度,表示为X(k) = [x(k), y(k), vx(k), vy(k)],则tk 时刻蛙人的运动速度为（vx (k)，vy (k));在[tk，tk+1]时间区间内，蛙人运动可用8个方向、16 个匀速直线运动模型描述；所述8个方向中的每个方向的运动都包括了两个不同速度的匀 速直线运动，且两个速度值满足下式：
[0017] 运动模型1，3, 5, 7, 9, 11，13, 15的运动速度大小为vk _，运动模型 2, 4, 6, 8, 10, 12, 14, 16的运动速度大小为vk _ ;运动模型j对应的速度方向的角度值为 0 j。
[0018] 上述技术方案中，所述步骤3)进一步包括：
[0019] 步骤301)计算tk+1时刻运动模型j (j = 1··· 16)的预测概率；
[0020] tk+1时刻运动模型j (j = 1··· 16)的预测概率为：
[0022] 其中，π u为tk时刻运动模型i在tk+1时刻切换到运动模型j的概率：
[0024] μ i (k)为tk时刻运动模型i的概率；
[0025] 步骤302)计算运动模型j (j = 1··· 16)切换到其它运动模型i (i = 1··· 16)的输 入交互权重；
[0026] μ ； j (k+1 | k) = jt ； s μ ； (k) / μ s (k+1 | k) (3)
[0027] 步骤303)计算tk+1时刻运动模型j对应的蛙人状态估计初值；
[0028] 已知tk时刻对应于16个运动模型的16个蛙人状态估计为：
[0029] ^[ΛΛ?Α：), , /' = -·16 ： (1)
[0030] 对应的协方差估计是Pi (k);
[0031] tk+1时刻运动模型j对应的蛙人状态估计初值表示为：
[0035] 步骤304)根据上述建立的tk时刻蛙人多方向运动的运动模型集，预测运动模型j 在tk+1时刻的速度；
[0036] 运动模型j (j = 1··· 16)在tk+1时刻的速度为：
[0039] 步骤305)修正tk+1时刻运动模型j对应的蛙人状态估计初值；
[0040] 将公式（7)或（8)中的两个速度值替换蛙人状态估计初值中的两个速度分量，修 正tk+1时刻每个运动模型的蛙人状态估计初值，修正后的+ 为：
[0042] tk+1时刻模型j对应的蛙人状态的协方差估计初值为：
[0043]
[0044] 上述技术方案中，所述步骤4)中的滤波器为标准卡尔曼滤波器。
[0045] 上述技术方案中，所述步骤4)中滤波器的个数等于所述运动模集中运动模型的 个数。
[0046] 本发明的优点在于：
[0047] 1、本发明的方法提出了利用8个方向、16个运动模型组成的多方向运动模型集描 述蛙人运动，能够更加准确、稳健地反映蛙人这一特定目标的"低运动速率、高方向变化率" 的运动特点；
[0048] 2、本发明的方法根据蛙人运动"低速率"的特点，利用当前时刻速度的大小和方向 自适应地建立多方向运动模型，改善了运动模型集的适应性；
[0049] 3、本发明的方法在多方向运动模型的基础上，通过并行的滤波算法进行每个运动 模型下的蛙人状态估计，提高了滤波算法的运行速度，缩短了蛙人状态估计的时间，降低了 系统的复杂性；
[0050] 4、本发明的运动蛙人的跟踪方法具有跟踪精度高，稳定性强的特点。
【附图说明】
[0051] 图1为本发明的运动蛙人的跟踪方法的流程图；
[0052] 图2为本发明建立的蛙人多方向运动模型示意图；
[0053] 图3为本发明的方法与传统的基于单方向运动模型的交互跟踪算法的蛙人状态 估计对比图；
[0054] 图4为本发明的方法与传统的基于单方向运动模型的交互跟踪算法的蛙人状态 估计均方根误差对比图。
【具体实施方式】
[0055] 本发明在综合分析蛙人运动特点的基础上，建立了描述蛙人运动的多方向运动模 型集，并将该运动模型集融入到交互式多模型（IMM)算法，利用多组并行的滤波估计方法 实现多方向运动模型下的蛙人状态估计，最后根据更新后的模型概率对各模型的估计结果 进行融合处理完成蛙人状态的估计。
[0056] 下面结合附图和具体实施例对本发明做进一步的说明。
[0057] 本发明的方法基于以下假设：忽略高度信息，蛙人在二维平面内运动。
[0058] 如图1所示，一种运动蛙人的跟踪方法，所述方法包括：
[0059] 步骤1)通过声纳系统接收tk+1时刻蛙人状态的观测值；
[0060] 所述tk+1时刻蛙人状态的观测值为2(々+ 1) = ^(々+ 1),{(/: + 1：)為(_& + 1),兔,(& + 1)^
[0061] 步骤2)建立tk时刻蛙人多方向运动的运动模型集；
[0062] 基于蛙人的"低运动速率、高方向变化率"的运动特点，对蛙人的运动进行了如下 假设：在两相邻时刻之间，蛙人做匀速直线运动；而且蛙人向各个方向运动的切换概率相 等；
[0063] tk时刻蛙人状态包括位置和速度,表示为X (k) = [X (k)，y (k)，vx (k)，vy (k)],则tk 时刻蛙人的运动速度为（vx(k)，vy(k)) ;X(k)的初始值为巩时刻蛙人状态的观测值Z(k);
[0064] 如图2所示，在[tk，tk+1]时间区间内，蛙人运动可用8个方向、16个匀速直线运动 模型描述；所述8个方向中的每个方向的运动都包括了两个不同速度的匀速直线运动，且 两个速度值满足下式：
[0067] 运动模型1，3, 5, 7, 9, 11，13, 15的运动速度大小为vk _，运动模型 2, 4, 6, 8, 10, 12, 14, 16的运动速度大小为vk 以逆时针角度为正，运动模型j对应的速度 方向的角度值Θ i如表1所示：