rootmusic.m

music算法

%function [p]=Music(void)

f01=22;
f02=36;
N=1024;
s1=20*sin(f01*(1:N)/N);
s2=20*sin(f02*(1:N)/N);
% a=randn(1,N);
zeta1=pi/6;
zeta2=pi/3;
% s1=a.*cos(2*pi*f01*(1:N)/N);
% s2=a.*cos(2*pi* f02*(1:N)/N);
ss=[s1;s2];
a=[1,exp(-j*pi*sin(zeta1)),exp(-j*2*pi*sin(zeta1));1,exp(-j*pi*sin(zeta2)),exp(-j*2*pi*sin(zeta2))]';
xx=a*ss;
x=awgn(xx,10);
% gamma=1.5;
% noise=[sasd(1024,gamma),sasd(1024,gamma),sasd(1024,gamma)]';
% x=xx+noise;
rxx=x*x';
[u,sig,v]=svd(rxx);
  signalspace=u(:,1:2);
 noisespace=u(:,3);
vv=noisespace*noisespace';
% i=1;
% for zeta=0:pi/300:0.5*pi;
% a1=[1,exp(-j*pi*sin(zeta)),exp(-j*2*pi*sin(zeta))]';
% p(1,i)=1/(a1'*vv*a1); 
% i=i+1;
% end
% i=1:151;
% plot((i-1)*0.6,p(i));
% title('用MUSIC算法进行DOA估计');
% xlabel('DOA/degee');
% ylabel('Magnitude');
% grid on
z=sym('z','unreal');
%a1=[1,z^(-1),z^(-2)]';
%a2=a1';
%f=(a1'*vv*a1);
%q=solve('p','z');
p=sym2poly(z^4*[1,z^(-1),z^(-2)]*vv*[1;z^(-1);z^(-2)]);
z=roots(p);
z1=abs(abs(z)-ones(4,1));
[zb,ix]=sort(z1);
zn=z(ix);
zm=zn(1:4);
ww=angle(zm);
theta=asin(-ww/pi);
t=theta*180/pi;
%angle(q)