aoa_tracking_programme_612.m

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

% % 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);
% 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=[];