clc
clear all

%產生兩個信號,并且確定兩個角度
signal_number=2;
n1=1:0.1:1024;
signal_1=100*cos(2*pi*200/4000*n1);
signal_2=100*cos(2*pi*200/4000*n1+pi/2);
angle_1=pi*45/180;
angle_2=pi*50/180;

%采樣
sample_number=1024;%采樣點數 
n2=1:sample_number; 
signal_1=signal_1(n2);
signal_2=signal_2(n2);
S=[signal_1;signal_2]

%確定導向矢量以及接收信號
array_number=4
t=0.34;%距離除以波長
i=sqrt(-1); 
j=i;
delay_1=[j*2*pi*t*cos(angle_1);
       j*2*pi*t*cos(angle_1-pi/2);
       j*2*pi*t*cos(angle_1-pi);
       j*2*pi*t*cos(angle_1-3*pi/2)];
delay_2=[j*2*pi*t*cos(angle_2);
       j*2*pi*t*cos(angle_2-pi/2);
       j*2*pi*t*cos(angle_2-pi);
       j*2*pi*t*cos(angle_2-3*pi/2)]; 
delay=[delay_1,delay_2]   
A=exp(delay); %導向矢量
X=A*S; %接收信號 

%確定協方差矩陣以及對協方差矩陣進行分解 
cov=X*X'/sample_number;%協方差矩陣 
[V,D]=eig(cov); 
noise_space=V(:,1:array_number-signal_number);%確定噪聲子空間

%設置最后要求的方向矢量函數
degree=0:1:360
angle=degree*pi/180; %線性信號角度范圍 
A_value=[j*2*pi*t*cos(angle);
       j*2*pi*t*cos(angle-pi/2);
       j*2*pi*t*cos(angle-pi);
       j*2*pi*t*cos(angle-3*pi/2)];
A_value=exp(A_value);  

%計算空間譜函數 
for n3=1:length(angle)
doa(n3)=1.0/(A_value(:,n3)'*noise_space*noise_space'*A_value(:,n3)); 
end

%做出空間譜圖
semilogy(degree,doa); %y軸對數坐標曲線 
title('MUSIC Spectyum'); %圖表標題，x軸y軸標簽及范圍 
xlabel('Angle(deg)'); 
ylabel('Spectrum'); 
axis([0 360 0.1 1e3]); 
grid;