%生成真實(shí)狀態(tài)和量測(cè)
%初始狀態(tài)
N=200;
X00=[1000 100 0]';
X=X00;
%第一階段：10秒CV運(yùn)動(dòng)
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];