[发明专利]一种基于水声信号卡尔曼滤波的超短基线定位方法

摘要

一种基于水声信号卡尔曼滤波的超短基线定位方法，涉及高精度的超短基水下定位方法。本发明是为了有效解决由于水下声信号传播过程中的噪声影响，导致定位精度较低的问题。本发明所述的一种基于水声信号卡尔曼滤波的超短基线定位方法，首先基于超短基线三角形基阵，获取三路声信号的波形；然后建立对应的系统方程和观测方程，用卡尔曼滤波算法对信号进行降噪处理，并获取处理后的信号间的相位差；最后将获得的相位差带入超短基线定位系统的数学模型中，解算出高精度的定位结果。

主权项

1.一种基于水声信号卡尔曼滤波的超短基线定位方法，其特征在于所述方法包括以下步骤：步骤一、系统建立超短基线定位基元阵列，并进行初始化，三个阵元排列成等腰直角三角形，阵元间距d＝0.5λ，其中λ为声波波长，λ＝80mm；步骤二、定位目标发射原始信号设定原始信号初相位幅值A＝0.5，信号频率f₀＝13.5kHz，角频率ω＝2πf₀，水下声速c＝1500m/s，相邻阵元间距d＝40mm，采样频率f_c＝200kHz，脉冲宽度t_s＝5ms；步骤三、基阵阵元接收来自定位目标的水声信号，并对水声信号进行采样，得到采样序列S(k)＝{s1,s2,s3,…,sk,…,sn}，然后按照公式(1)对采样序列归一化处理，得到信号u(k)＝{u1,u2,u3,…,uk,…,un}，其中k为正整数，且1≤k≤n，n为采样点数，且10≤n≤10000，在本系统中n＝3000；uk＝sk/(max(S(k))‑min(S(k)))    (1)步骤四、系统基于卡尔曼滤波算法，建立系统线性模型，如公式(2)所示，Xk＝H*Xk‑1+G*Wk，uk＝H*Xk    (2)式中k为离散时间，Xk、uk、Wk分别为系统在k时刻的状态值、观测值和白噪声值，量测系数H＝1，k值初始化为1；步骤五、系统建立基于卡尔曼滤波的时间更新方程和状态更新方程，如公式(3)和(4)所示：时间更新方程：状态更新方程：其中为k时刻的状态变量值，为由k‑1时刻的状态变量所得到的k时刻的预测值；A＝1为作用在X_k‑1上的状态变换系数；表示k‑1时刻的控制变量值，本系统中为0；B＝0为作用在控制向量上的1×1输入控制系数；H＝1为观测模型系数，把真实状态空间映射成观测空间；P_k^‑为先验估计误差协方差值；P_k为后验估计误差协方差值，P₁＝0；Q＝0.1为过程激励噪声协方差系数；R＝0.25为过程噪声协方差系数；I＝1为常量；K为卡尔曼增益或混合因数；步骤六、系统结合公式(3)和公式(4)，以及步骤三中得到的信号u(k)，且1≤k≤n，得到k时刻的卡尔曼增益值K_k，状态方程结果和后验估计误差协方差值P_k；步骤七、系统更新变换k＝k+1，将步骤六中得到的卡尔曼增益值K_k，状态方程结果和后验估计误差协方差值P_k带入步骤五的公式(3)，得到k时刻的状态变量预测值和先验估计误差协方差值然后带入步骤五中公式(4)中，计算出k时刻的卡尔曼增益值K_k，状态方程结果和后验估计误差协方差值P_k；步骤八：系统判断k是否等于n，如果是，则执行步骤九；否则执行步骤七；步骤九、系统得到生成的系统状态变量序列设定适当的门限值G，本发明中，门限值G取值0.25，取中的第一个大于或等于G的点其中i为正整数，且1≤i≤n1,记u(k)中第i个点对应的时间值为t_i，根据公式(5)(6)计算出信号间的时延差Δt₁₂、Δt₁₃：Δt12＝t2‑t1  (5)Δt13＝t3‑t1   (6)步骤十、由信号时延差与相位差的关系求出对应的信号相位差根据超短基线系统的定位数学模型，得到目标的坐标(x，y)；步骤十一、判断超短基线定位任务是否完成，如果是，执行步骤十二；否则，执行步骤二；步骤十二、结束基于卡尔曼滤波算法的超短基线水下定位任务。