基于粒子滤波算法的方位跟踪方法研究

周 彤，宋立臣

(大连测控技术研究所，辽宁 大连 116013)

0 引 言

在舰船水下辐射噪声测量的过程中，安全、可靠地引导被测目标通过测量区域，并保证被测目标与测量系统之间的有效距离以满足测试需求是极其重要的，也是一直关心的问题。现有的被测目标引导方法，往往依靠单一导航信标配合测距系统实现，通常仅提供被测目标与导航信标之间的单点距离信息，缺乏方位信息，使得目标实际航行轨迹与试验要求轨迹有一定的偏差，造成测量单程无效，从而降低了测试效率，延长了试验时间[1]。

目前方位估计算法的通常假设目标在观测时间内为静止状态，即静态方位算法，同时采用大计算量和多快拍数的批处理形式进行方位估计[2]。然而在实际情况下，目标通常为运动状态，批处理方式的静态方位估计方法不适用于实时连续跟踪。同时，静态方位估计方法是互不相关地估计2个连续时刻的方位信息，并没有考虑到2个连续时刻状态的关联性，进而造成动态方位估计偏差较大。随着对运动目标的测向精确度和实时处理的要求越来越高，静态方位估计算法已不能满足日益增长的需求，因此研究适用于动态目标的方位跟踪算法成了一个新趋势。本文将静态方位估计中的MUSIC算法和粒子滤波跟踪算法相结合，既提高了方位估计的精度更减小了计算量以适用于对目标的实时方位跟踪。

1 AVS 和 MUSIC 方位估计算法

1.1 AVS 接收信号模型

通常在实际应用中矢量水听器接收的水下目标辐射声场为平面波声场，因此假设声源为平面波。则矢量水听器接收的声压和振速的关系为

实际应用中处理的信号为离散信号，一般采用快拍数对每时刻数据进行批处理。假设快拍数为N在k时刻的声源信号为

接收信号包含方位角和俯仰角信息，进而可以对数据进行方位估计。

1.2 MUSIC 方位估计

MUSIC算法作为子空间特征分解相关算法的代表，实现了方位估计技术向高分辨的发展。MUSIC算法的核心思想是利用数据的自相关矩阵的内在结构特性，将数据的协方差矩阵分解为和阵列流形一致的信号子空间，以及与信号子空间正交的噪声子空间，并利用2个子空间的正交性，通过对谱峰进行搜索来估计信源的方位。

工程实际中，为提高信号处理的精度，采用多快拍数的观测数据。设快拍数为L，则接收数据的自相关矩阵可表示为

其中，G为与噪声相关的特征值矩阵对应的噪声子空间。

因此，通过谱估计式（11）的峰值搜索估计和峰值相对应的角度值即为入射的方向信息。

在信噪比（SNR）相对较高的噪声环境中，MUSIC方法能够通过如图1所示的尖锐峰值来呈现声源DOA。声源真实方位为（20.5°，40.5°），然而，当SNR低时，峰值可能失真并且估计的DOA可能远离真实位置，如图2所示。

图1 MUSIC 方法 DOA 估计性能 SNR=10 dBFig.1 DOA estimated performance based on the MUSIC algorithm SNR=10 dB

图2 MUSIC 方法 DOA 估计性能 SNR=-10 dBFig.2 DOA estimated performance based on the MUSIC algorithm SNR=-10 dB

2 基于粒子滤波算法的方位跟踪方法

为了给出DOA跟踪问题的总体框架，首先定义状态空间模型。假设目标声源当前方位为，并以（rad/s）的速度移动。因此，目标声源的状态可以由当前方位和运动速度构成，即。采用匀速模型CV（Constant Velocity）模拟单信源的方位角度变化情况[5]，DOA的运动速度为常数。则状态空间模型为

矢量水听器的输出矩阵是天然的观测模型，即为式（7）。采用基于递归方式的贝叶斯重要性采样，并以预测和更新的方式实现状态估计[6]。

因此粒子权重在算法的滤波性能上具有重要的作用。当粒子接近真实位置时，粒子的似然函数具有较大的权重，则为了让粒子在更新时使权重大的粒子能够在重采样时取代权重小的粒子，由式（20）可知似然函数的确定是算法性能的关键。假设测量的过程噪声为高斯噪声，则似然函数的最大似然估计为[9]

似然函数的主瓣通常比较平缓，尤其在低信噪比的条件下，因此不能有效的通过权重衡量真实状态周围的粒子并且可能出现虚假峰值。同时当快拍数很大时，将会导致粒子的权重接近于0，进而导致对粒子的权重估计失效。

因此引入MUSIC方法作为似然函数，即

则似然函数被重塑，以增强在高似然区域采样粒子的权重。这一步非常重要，因为它能够帮助后续重采样算法更有效地选择和复制粒子。

给出最终PF-MUSIC方法的流程为

步骤1 初始化：采用随机方法估计初始角度，从均匀分布中采样，粒子数为N，。初始化各粒子权重为。

步骤7 令k=k+1，重复步骤2～步骤7。直到k＞T时，终止计算。

3 方位跟踪方法性能验证分析

3.1 仿真分析方位跟踪方法性能

图3 SNR=10 条件下的方位跟踪Fig.3 DOA tracking under the condition of SNR=10 dB

图3 给出了MUSIC方法和PF-MUSIC跟踪方法的DOA跟踪性能。MUSIC方法的性能在多个时间步长处，DOA估计结果远离真实轨迹。然而，PF-MUSIC方法能够结合来自声源的动力学模型的时间信息以及来自当前测量时刻的空间信息，从而能够一致地跟踪声源方位。它能始终锁定声源，并呈现令人满意的DOA跟踪。另外，虽然初始DOA对于PF-MUSIC方法是未知的并且被假定为均匀分布，但PF-MUSIC跟踪方法能够快速地收敛到真实轨迹。

为了充分评估跟踪性能，采用50次蒙特卡罗平均模拟均方根误差（RMSE）。如果绝对误差小于1°，则被认为是正确的估计。图4给出不同SNR下对RMSE的影响。采用从-10 dB～0 dB 的不同 SNR，以 2 dB的增量产生噪声环境。

由于结合了时间信息，所提出的PF-MUSIC跟踪算法在估计DOA方面比MUISC方位方法执行得更好。PF-MUSIC跟踪算法即使在非常低的SNR环境下（例如，SNR=-10 dB），依然能够保持对声源DOA的锁定。同时，PF-MUSIC方法不需要对角度进行三维搜索，在计算量上远低于MUSIC方法，更适用于对目标的实时方位跟踪的需求。

图4 不同快拍数和 SNR 下的 RMSEFig.4 RMSE under the conditions of different snapshots and SNR

3.2 海上试验验证

2017年8月，在大连海域水深60 m区域，试验验证实时方位跟踪方法的性能。信标的导航信号为4 kHz的单频CW脉冲信号，脉冲周期为T=2 s。水下目标和导航信标正横距离大于100 m，则声场可视为平面波声场。

为验证方位跟踪方法的实际性能，这里采用短基线方位方法作为对比方案。分别在目标首部和尾部各安装2个接收器，用以接收导航信标信号。基线长度为 53 m。

试验所采用的矢量水听器为二维球型，典型的矢量水听器接收的声压及振速的功率谱如图5所示。

短基线和PF-MUSIC方法的跟踪效果如图6所示。

可知PF-MUSIC方法的方位跟踪效果良好，并且与短基线方位相比曲线更平滑，适用于水下目标的实时方位跟踪。同时，仅需在舰船上加装单矢量水听器即可满足测试要求，更适用于工程实际。

4 结 语

将粒子滤波算法和MUSIC方法相结合，应用于矢量水听器接收的水下运动目标数据的处理，有效地对运动目标的方位进行跟踪。采用CV模型对声源运动状态进行建模，将MUSIC方法的估计函数作为粒子滤波算法中的似然函数，有效改进了在低信噪比条件下的跟踪性能。通过结合时间和空间信息，PF-MUSIC跟踪方法在二维DOA跟踪中优于传统的MUSIC方法，并且不需要空间搜索降低了计算量，适用于对目标的实时跟踪，同时在较低信噪比的条件下也能够获得较好的精度，对水下目标的实时方位跟踪上有较好的应用前景。

图5 矢量水听器接收声压和振速信号的频谱Fig.5 Spectrums of Sound pressure and vibration speed received by the vector hydrophone

图6 方位跟踪效果Fig.6 The effect of DOA tracking