aoa_tracking_programme_6121.asv

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

win_l=9600;
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=-11;
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];
% % samnum=100;
% 
% xu1=sqrt(xuvar(1))*randn(1);
% xu2=sqrt(xuvar(2))*randn(1);
% xu3=sqrt(xuvar(3))*randn(1);
% xu=[xu1;xu2;xu3];
% xu = inital_states(ini_xu,xuvar,samnum);
% xu = inital_states(samnum,xuvar);