[发明专利]一种基于遗传粒子滤波算法的水下目标跟踪定位方法

摘要

本发明公开了一种基于遗传粒子滤波算法的水下目标跟踪定位方法包括以下步骤：(1)部署水下目标跟踪定位系统：在水域内安装m个水听器，在跟踪定位目标上安装超声波换能器和水压深度计；(2)在水域内建立三维坐标系，获取水听器坐标(x_j,y_j,z_j)、跟踪定位目标与m个水听器之间的测量距离s_j、定位目标的深度h，其中j∈(1,2,...,m)，表示水听器序号；(3)根据跟踪定位目标与水听器之间的测量距离建立测量方程；(4)应用遗传粒子滤波算法对水下目标进行跟踪定位，即预测跟踪定位目标在k时刻的坐标值。与现有技术相比，该方法具有较高的稳定性和定位精度。

主权项

1.一种基于遗传粒子滤波算法的水下目标跟踪定位方法，其特征在于，包括以下步骤：(1)部署水下目标跟踪定位系统：在水域内安装m个水听器，在跟踪定位目标上安装超声波换能器和水压深度计；(2)在水域内建立三维坐标系，获取水听器坐标(x_j,y_j,z_j)、跟踪定位目标与m个水听器之间的测量距离s_j、目标的深度h，其中j∈(1,2,...,m)，表示水听器序号；记跟踪定位目标在k时刻的坐标值为X_k＝(x_k,y_k,h)；(3)根据跟踪定位目标与水听器之间的测量距离建立k时刻测量方程：其中表示k时刻目标与第j个水听器之间的测量距离，为k时刻目标与第j个水听器之间的实际距离，为k时刻测量时引入的噪声，是方差为σ²的高斯白噪声；(4)应用遗传粒子滤波算法对水下目标进行跟踪定位，即预测跟踪定位目标在k时刻的坐标值；步骤(4)具体包括如下步骤：(41)算法参数初始化：定义k时刻适应度函数：其中为预测测量距离；定义S_0,k＝{S₀,S₁,…,S_k}，X_1,k＝{X₁,X₂,…,X_k}为到k时刻所有测量和状态量集合；以前一时刻的估计结果作为初始状态，根据先验概率在目标坐标值取值范围内采样，得到一个初始的N点目标坐标粒子集其中每个粒子表示跟踪定位目标的一个可能坐标值，i为粒子序号；令每个粒子权值的初始值为1/N，重采样门限为N_th＝N/2；(42)在k时刻进行重要性采样，得到k时刻的目标坐标粒子集其中表示k时刻目标坐标粒子集中的第i个粒子，即k时刻跟踪定位目标的一个可能坐标值；为此粒子权值；(43)判断是否要重采样：如果则进行重采样；否则粒子集即为预测粒子集；(44)如果需要重采样，对粒子集重采样获得预测粒子集其中表示k时刻目标坐标粒子集中的第i个粒子的预测值，为此粒子权值；(45)根据预测粒子集计算跟踪定位目标坐标在k时刻的预测坐标值(46)若跟踪定位未完成则进行状态更新，跳转到步骤(41)预测下一时刻的坐标值。