fangweijiao_shengya.m

声强互谱方位估计-用于目标声源方位估计

%陈华伟　小论文仿真
%不同传感器尺寸、不同积分时间、不同信噪比情况下的对比
clc
clear
f=300;fs=5*f;d=1000;c=1500;%信号频率　采样频率　声学中心与声源的距离　声速
A=1;%信号幅度　可调
D=0.1;%矢量水听器声压传感器之间距离，可调
t=0:1/fs:0.5;%信号时间
fai0=2*pi*rand(1,length(t));
p=cos(2*pi*f*t);%初始相位未加上
deltat=d/c;%声压传播时间
theta=60*pi/180%方位角
p1=cos(2*pi*f*(t+deltat-D*cos(theta)/(2*c)));
p2=cos(2*pi*f*(t+deltat-D*sin(theta)/(2*c)));
p3=cos(2*pi*f*(t+deltat+D*cos(theta)/(2*c)));
p4=cos(2*pi*f*(t+deltat+D*sin(theta)/(2*c)));
p0=4*cos(2*pi*f*(t+deltat));
vx=p1-p3;
vy=p2-p4;
p01=hilbert(p0);
pvx=xcorr(vx,p01);
pvy=xcorr(vy,p01);
Ex=pvx*ones(1501,1);
Ey=pvy*ones(1501,1);
theta1=atan(pvy/pvx)