MATLABIMM交互多模型算法交互多模型算法

T=2;
M=5;  %蒙特卡洛循环次数
N=900/T;
N1=400/T;
N2=600/T;
N3=610/T;
N4=660/T;
Delta=100;

Rx=zeros（N1）;
Ry=zeros（N1）;
Zx=zeros（NM）;
Zy=zeros（NM）;

%产生真实轨迹
%1-延Y轴直线运动
t=2:T:400;
x0=2000+0*t‘;
y0=10000-15*t‘;

%2-慢转弯
t=402:T:600;
x1=x0（N1）+0.075*（（t‘-400）.^2）/2;
y1=y0（N1）-15*（t‘-400）+0.075*（（t‘-400）.^2）/2;

%3-匀速
t=602:T:610;
vx=0.075*（600-400）;
x2=x1（N2-N1）+vx*（t‘-600）;
y2=y1（N2-N1）+0*（t‘-600）;

%4-快转弯
t=612:T:660;
x3=x2（N3-N2）+vx*（t‘-610）-0.3*（（t‘-610）.^2）/2;
y3=y2（N3-N2）-0.3*（