aoa_tracking_programme_612.asv

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

% schid=3;

for lp1=110:160
    
    lp1
%     x_v=[x_v;lp1];
     nTs=[nTs;lp1*win_l*Ts+(win_l/2)*Ts];
%        nn=[nn;lp1*win_l+1];
     X_s = X( sp_t + lp1 * win_l+ 1 : sp_t + lp1 * win_l + win_l , : );
     
     Xs_fft =fft(X_s,num1);
     Xh_fft=Xs_fft(1:num1/2,1);
     Xh_fft=abs(Xh_fft);
     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= -1000:50:1000
          
          X_s = X( sp_t + lp1 * win_l+ 1+lp4 : sp_t + lp1 * win_l + win_l +lp4, : );