aoa_tracking_programme_612.m

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

num_s=1/Ts;
X_l=size(X,1);
win_l=4800;
lp_n=fix(X_l/win_l);

sp_t=0;
num1=1024;

f_s=fs/num1;

d_a=0.04;
vs=345;
L=size(X,2);

X_fft=[];
thita=[];
nTs=[];

d_lim=-6;
d_lim=10^(d_lim/10);
x_v=[];
% Q=[0.1;0.1;0.1];
% Samnum =100;             % Number of samples;
% xx=zeros(3,Samnum);
% xu=zeros(3,Samnum);
% q=zeros(1,Samnum);

% SAMPLE FROM THE PRIOR:
% =====================
% T=9600*1/4800e3;
% 
% xuvar=[1;1;1];
% % ini_xu=[-22;200;45];