uesprit.m

一般的esprit算法好的时间比较大

function doa = uesprit( x,d,N )

X=x.';
J1=[eye(N-1) zeros(N-1,1)];   % (N-1)*N
J2=[zeros(N-1,1) eye(N-1)];

Qn=unitary(N).';
Qn_1=unitary(N-1).';

Y=Qn'*X;

[U S V]=svd([real(Y) imag(Y)]);
Es=U(:,1:d);

K1=real(Qn_1'*J2*Qn);
K2=imag(Qn_1'*J2*Qn);

Lu1=K1*Es;
Lu2=K2*Es;
fai=pinv(Lu1)*Lu2;
omeig=eig(fai);

mue=2*atan(omeig);
u=mue/pi;
if(u<0)
    u=-u;
elseif(u>0)
    u=1-u;
end

theta=asin(u)*180/pi;
doa=theta;