aoa_tracking_programme_6121.asv

来自「对运动声目标进行航迹跟踪」· ASV 代码 · 共 193 行 · 第 1/5 页

     Xh_fft=Xh_fft.^2;
     max_v=max(Xh_fft);
     Xh_fft=Xh_fft./max_v;
    
     id_v=search_index(Xh_fft,d_lim)
     id_l=length(id_v);
      Jc=[];
          for sita=-90:90
    
         Js=0;
      
        
          for lp3=1:id_l
         
              
              
%          Rw=zeros(L,L);
%          lp_num=0;
%         for lp4= -100:25:100
%           
%           X_s = X( sp_t + lp1 * win_l+ 1+lp4 : sp_t + lp1 * win_l + win_l +lp4, : );
%           Xs_fft=fft(X_s,num1);
%           Xw=Xs_fft(id_v(lp3),:).';
%           Rw=Rw+Xw*Xw';
%           lp_num=lp_num+1;
%          end
%          
%          Rw=Rw/lp_num;
%        
              
          fk=id_v(lp3)*f_s;
          Xw=Xs_fft(id_v(lp3),:).';
          Dw=steering_f(fk,d_a,vs,L,sita);
          Pw=Dw*inv(Dw'*Dw)*Dw';
          Rw=Xw*Xw';
          Js=Js+trace(Pw*Rw);
         
       end