testimmjpda.m

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

state_dm=9;
target_no=2;
flag=0;
prob=[0.2, 0.3,0.22,0.25,0.36,0.35,0.58,0.48,0.69,0.58,0.66,0.54];
mes=[32.264,12.894,0;24.016,23.798,0;77.194,47.136,0;1.8942,-346.27,0;314.32,-176.08,0;275.51,-9.0171,0;367.85,-234.7,0;-14.179,-246.48,0;-14.741,-209.7,0;154.74,-199.57,0;119.26,-311.49,0;58.041,-122.69,0]';
mes_total=12;
x1=[32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942]';
p1=[32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;...
    32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;...
    32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942];
x2=[32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.894]';
p2=[32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;...
    32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;...
    32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942;32.264,23.798,1.8942,32.264,23.798,1.8942,32.264,23.798,1.8942];    
[x_jpda,p_jpda,x_immjpda,p_immjpda]=f_immjpda(state_dm,target_no,flag,prob,mes,mes_total,x1,p1,x2,p2)