create_data1.m

来自「有关交互多模型matlab实现算法」· M 代码 · 共 63 行

%生成真实状态和量测
%初始状态
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];