tic
  %  the  data of signal
clear;
format short;
c=3*10.^8;
L=8;
N=128*2;
fm1=0.25;%fc1=0.275;
fm2=0.32;%fc2=0.349;
Km1=0.025;
Km2=0.033;
Phia1=0;
Phia2=0;
f0=0.32;
lamta=c/f0;
len=lamta/2;
%len=1/2;
P1=10*pi/180;
P2=20*pi/180;
snr1=-10;
snr2=-10;
Amp1=sqrt(2*10^(snr1/10));
Amp2=sqrt(2*10^(snr2/10));
t=1:N;
sig1=Amp1.*exp(j*2*pi*(Km1/2*(t.^2)/N+fm1*t+Phia1));
f1=1*Km1*t/N+fm1;
sig2=Amp2.*exp(j*2*pi*(Km2/2*(t.^2)/N+fm2*t+Phia2));
f2=1*Km2*t/N+fm2;

s=[sig1;sig2];

 
  for i=1:N;
  l=1:L;  
  x1=exp(j*2*pi*(len*f1(1,i)*(l-1)*sin(P1))/c);
  x2=exp(j*2*pi*(len*f2(1,i)*(l-1)*sin(P2))/c);
 
  a1=x1.';
  a2=x2.';
  a=[a1,a2];
  S(:,i)=a*s(:,i);
  end
  %a=[a1.';a2.'];
   
 noise=randn(L,N)+j*randn(L,N);
 
 z=S+noise;
 sig1=z(1,:);
 %**************** 信號1頻率參數 ********************
 [gamma1,r1,atom1]=mp_f_K(N,sig1);  
 gamma1
 %**************** 信號2頻率參數 ********************
 sig2=sig1-r1*atom1;
 [gamma2,r2,atom2]=mp_f_K(N,sig2);  
 gamma2
%**************** 信號1DOA ********************
 doa_range1=[0 90 1];
 doa_doa1=mp_doa(z,len,gamma1,doa_range1)
 
 doa_range2=[doa_doa1-1 doa_doa1+1 0.01];
 doa_1=mp_doa(z,len,gamma1,doa_range2)
 %**************** 信號2DOA ********************
 doa_range1=[0 90 1];
 doa_doa2=mp_doa(z,len,gamma2,doa_range1)
 
 doa_range2=[doa_doa2-1 doa_doa2+1 0.01];
 doa_2=mp_doa(z,len,gamma2,doa_range2)
 
 toc