matrix_solve.m

对运动声目标进行航迹跟踪

 function [Yw,Aw,Sw] = matrix_solve( Xs_fft,id_v,thite)
 
d_a=0.04;
vs=345;
L=6;
fs=48e3;
num1=1024;
f_s=fs/num1;
id_l=length(id_v);

          Sw=[];
          Yw=[];
          Aw=[]; 
          
   for lp2 = 1:id_l
         Xw=Xs_fft(id_v(lp2),:).';
         Yw=[Yw;Xw];
         
         fk=id_v(lp2)*f_s;
         af=steering_f(fk,d_a,vs,L,thite);
         Se=inv(af'*af)*af'*Xw;
         Af=zeros(id_l*L,1);
         Af((lp2-1)*L+1:(lp2-1)*L+L,:)=af;
         Aw=[Aw Af];
         Sw=[Sw;Se];
         
     end