aoa_tracking_programme_6121.asv

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

% Q_thite=Q(1,:);
% Q_qq=Q(2,:);
% Q_fai=Q(3,:);
% 
% n_fai = sqrt(Q_fai)*randn(1,Samnum);
% fai = n_fai;
% 
% qq = sqrt(Q_qq)*randn(1,Samnum);
% 
% 
% thite = sqrt(Q_thite)*randn(1,Samnum);
% 
% xx(1,:) = thite;
% xx(2,:) = qq;
% xx(3,:) = fai; 
% xx=zeros(3,Samnum);
% xu=zeros(3,Samnum);
% q=zeros(1,Samnum);
% initVar=0.5;
% % SAMPLE FROM THE PRIOR:
% % =====================
% xx(1,:) = sqrt(initVar)*randn(1,Samnum);
% xx(2,:) = sqrt(initVar)*randn(1,Samnum);
% xx(3,:) = sqrt(initVar)*randn(1,Samnum);
xe=[];
thiti=[];
% schid=3;

for lp1=80:150
    
    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);