test_f_confirm2.m

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

k=3;
t=0.5;
%mes_start=[10 10 10]';
a0=[100 10 0.1 2 0 0 0 0 0]';
p0=eye(9);
mes_total=5;
measurement=[1 1 1;2 2 2;15 15 15;20 20 20;5 5 5]';
%vmin=0;
%vmax=50;
r=eye(3);
yz2=100000;