%單個聲源進行電子旋轉(zhuǎn)，確定DOA
%倍頻窄波束算法
clc
clear
%設(shè)置單個聲源的角度
theta0=300;
theta=theta0*pi/180;
%設(shè)置聲源頻率
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)