2-doa.txt

2维测向是doa估计中的一个非常重要的技术

close all
clc
M=4;
D=2;
kp=200;
l=2;
d=0.5*l;
w=[pi/3 pi/4]';
x(1)=0;y(1)=0;
x(2)=1;y(2)=0;
x(3)=0;y(3)=1;
x(4)=1;y(4)=1;
for i=1:4;
    x(i);y(i);
end
tt=[x(1) x(2) x(3) x(4)]';
ttt=[y(1) y(2) y(3) y(4)]';
a1=12;
b1=6;
a2=25;
b2=4;
rr=[a1 a2];
rrr=[b1 b2];
A=[exp(-j*2*pi*(x(1)*cos(rr*pi/180).*sin(rrr*pi/180)+x(2)*cos(rr*pi/180).*cos(rrr*pi/180))/l)
    exp(-j*2*pi*(x(2)*cos(rr*pi/180).*sin(rrr*pi/180)+y(2)*cos(rr*pi/180).*cos(rrr*pi/180))/l)
    exp(-j*2*pi*(x(3)*cos(rr*pi/180).*sin(rrr*pi/180)+y(3)*cos(rr*pi/180).*cos(rrr*pi/180))/l)
    exp(-j*2*pi*(x(4)*cos(rr*pi/180).*sin(rrr*pi/180)+y(4)*cos(rr*pi/180).*cos(rrr*pi/180))/l)
];
xxx=-0.5*(exp(j*w*[0:kp-1])-exp(-j*w*[0:kp-1]))/j;%仿真信号
x=A*xxx;%+randn(M,kp);
R=x*x';
[U S V]=svd(R);
En=U(:,l+1:M);
a=[0:1:36]*pi/180;
b=[0:0.25:9]*pi/180;
   for n1=1:length(a);
  n2=1:length(b);
A_search=[exp(-j*2*pi*(x(1)*cos(a(n1))*sin(b(n2))+y(1)*cos(a(n1)).*cos(b(n2)))/l),
          exp(-j*2*pi*(x(2)*cos(a(n1))*sin(b(n2))+y(2)*cos(a(n1))*cos(b(n2)))/l),
          exp(-j*2*pi*(x(3)*cos(a(n1))*sin(b(n2))+y(3)*cos(a(n1))*cos(b(n2)))/l),
          exp(-j*2*pi*(x(4)*cos(a(n1))*sin(b(n2))+y(4)*cos(a(n1))*cos(b(n2)))/l)
      ];
 WW=A_search'*En*En'*A_search;
 p_music=abs(1\WW);   
 end
 h1=0:1:36;
 h2=0:0.25:9;
 plot3(h1,h2,10*log10(p_music/max(p_music)));
 xlabel('x');
 ylabel('y');
 zlabel('z');
     grid