doublefrequzeonesource.m

矢量水听器倍频窄波束算法 原创 对传统的波束响应进行的改进算法

%单个声源进行电子旋转，确定DOA
%倍频窄波束算法
clc
clear
%设置单个声源的角度
theta0=300;
theta=theta0*pi/180;
%设置声源频率
f=500;

N=500;
Fs=5000;
n=0:N-1;
t=n/Fs;
s0=cos(2*pi*f*t);

steer=[1 cos(theta) sin(theta)];

s=steer'*s0;

vx=s(2,:);vy=s(3,:);p=s(1,:);
fai=0:(3*pi/180):2*pi;
NN=length(fai);
Y=zeros(1,NN-1);

for i=0:3:357
vc1=vx*cos(i*pi/180)+vy*sin(i*pi/180);
vc2=vx*cos(i*pi/180+30*pi/180)+vy*sin(i*pi/180+30*pi/180);
I1=(p+vc1).*vc1;I2=(p+vc2).*vc2;
    yout=xcorr(I1,I2);
Y(1,(i+3)/3)=max(yout);
end
X=0:3:357;stem(X,Y)
figure
polar(X/180,Y)

    
% theta=270*pi/180;
% fai=0:3*pi/180:2*pi;
% n=length(fai);
% y=zeros(1,n);
% 
% fai=0:3*pi/180:2*pi;
% yout=cos((theta-fai)/2).^2.*cos((theta-fai-30*pi/180)/2).^2.*cos(theta-fai).*cos(theta-fai-30*pi/180);
% polar(fai,yout)