base_esprit_1_tls.m

ESPRIT方法的两种实现

function Fre_Est=Base_Esprit_1_TLS(x,p,num)
N=length(x);
r=xcorr(x)/N;
R_xx=zeros(p,p);
R_xy=zeros(p,p);
for m=0:p-1
    R_xx(m+1,:)=r(N+m:-1:N+m-p+1);
	R_xy(m+1,:)=r(N+m-1:-1:N+m-p);
end 
[u,s,v]=svd(R_xx);
d=diag(s);
e=0.993;
for rank=1:p
    ratio=sqrt(sum(d(1:rank).^2)/sum(d.^2));
    if ratio>e
       break;
    else 
        continue 
    end 
end
rank=2*rank;
m=mean(diag(s(rank+1:end,rank+1:end)));
s=s-m*eye(p);
C_xx=u*s*v.';
z=[zeros(1,p);eye(p-1,p)];
C_xy=R_xy-m*z;
s_1=s(1:rank,1:rank);
s_1=s_1-v(p,1);
u_1=u(:,1:rank);
v_1=v(:,1:rank);
C_xy_1=u_1.'*C_xy*v_1;
v=eig(s_1,C_xy_1);
frequency=abs(angle(v)/2/pi);
Fre_Est=Find_Numble(frequency,num);