produce_mes3.m

多目标跟踪 (三维)-算法matlab编制

%用于航迹起始测试程序(模拟产生用于航迹起始的多目标量测信息)

model_try;
M=7;
vmin=0;
vmax=50;
measurement=[];
mes_total=[];

u1=[-100 -400]';%跟踪空间左下顶点 
u2=[400  300]';%跟踪空间右上顶点
arg=0.0002*(500*700);%跟踪空间内期望虚警数目
target_total=3;%目标个数
x1=[30 3 10 4]';
x2=[20 4 20 3]';
x3=[80 -4 50 -3]';
%x4=[70 -3 40 -3]';
x=[x1 x2 x3];
xyreal=[];
for i=1:M
    noise_process=[];
    noise_mea=[];
    for s=1:target_total
       q=all_q(s).now;
       temp=normrnd([0 0]',diag(q));
       temp1=normrnd([0 0]',diag(r));
       noise_process=[noise_process temp];
       noise_mea=[noise_mea temp1];
    end
    x=fai*x+g*noise_process;
    xyreal=[xyreal x];
    mes=h*x+noise_mea;
    measurement=[measurement mes];
    
    mf=poissrnd(arg);%
    if mf>25
      % mf=25;%限制杂波数不超过,just for simulation
    end
    mes_total(i)=mf+target_total;
    for j=1:mf
       false_alarm=unifrnd(u1,u2); %在监视空域内产生服从均匀分布的虚警
       measurement=[measurement false_alarm];%产生虚警   错误量测在跟踪门内服从均匀分布
    end
end
save measurement3 measurement;
save mes_total3 mes_total;
save xyreal3 xyreal;