model_try.m

雷达目标跟踪matlab源程序 希望对大家能够有所帮助

t=1;
model_number=6;
fai=[1 t t^2/2 0 0 0 0 0 0;
     0 1 t 0 0 0 0 0 0;
     0 0 1 0 0 0 0 0 0;
     0 0 0 1 t t^2/2 0 0 0;
     0 0 0 0 1 t 0 0 0;
     0 0 0 0 0 1 0 0 0;
     0 0 0 0 0 0 1 t t^2/2;
     0 0 0 0 0 0 0 1 t;
     0 0 0 0 0 0 0 0 1]; %matrix 9*9
g=[t^2/2 0 0;
   t 0 0;
   1 0 0;
   0 t^2/2 0;
   0 t 0;
   0 1 0;
   0 0 t^2/2;
   0 0 t;
   0 0 1];%状态噪声加权矩阵,matrix 9*3
h=[1 0 0 0 0 0 0 0 0;
   0 0 0 1 0 0 0 0 0;
   0 0 0 0 0 0 1 0 0];
q=[0.75 0 0;0 0.75 0;0 0 0.75];
all_q(1).now=[0.75 0 0;0 0.75 0;0 0 0.75];
all_q(2).now=[1.5 0 0;0 1.5 0;0 0 1.5];
all_q(3).now=[2.5 0 0;0 2.5 0;0 0 2.5];

 
r=[1 0 0;0 1 0;0 0 1];%3*3 量测噪声 
vmin=0;%设定的最小速度
vmax=50;%设定的最大速度
MarkoProb=zeros(6)+1/6;