www.gusucode.com > 有关交互多模型matlab实现算法,仿真场景可以自己设计 > code/create_data1.m
%生成真实状态和量测 %初始状态 N=200; X00=[1000 100 0]'; X=X00; %第一阶段:10秒CV运动 X0=X00; N1=10; X1=CV(T,N1,X0); X=[X X1]; %第二阶段:10秒CA,a=10 X0=X1(:,N1); X0(3)=10; N1=10; X1=C_A(T,N1,X0); X=[X X1]; %第三阶段:10秒CA,a=-20 X0=X1(:,N1); X0(3)=-20; N1=10; X1=C_A(T,N1,X0); X=[X X1]; %第四阶段:10秒CA,a=20 X0=X1(:,N1); X0(3)=20; N1=10; X1=C_A(T,N1,X0); X=[X X1]; %第五阶段:20秒CV X0=X1(:,N1); X0(3)=0; N1=20; X1=CV(T,N1,X0); X=[X X1]; %第六阶段:20秒CA,a=-20 X0=X1(:,N1); X0(3)=-20; N1=20; X1=C_A(T,N1,X0); X=[X X1]; %第六阶段:20秒CA,a=-40 X0=X1(:,N1); X0(3)=-40; N1=20; X1=C_A(T,N1,X0); X=[X X1]; %第七阶段:100秒CV X0=X1(:,N1); X0(3)=0; N1=100; X1=CV(T,N1,X0); X=[X X1];