%初始狀態
N=200;
X00=[0 100 40]';
X=X00;
%以下是目標運動真實狀態



%第二階段：20秒CA，a＝40
X0=X00;
X0(3)=40;
N1=20;
X1=C_A(T,N1,X0);
X=[X X1];

%第二階段：180秒CV
X0=X1(:,N1);
X0(3)=0;
N1=180;
X1=CV(T,N1,X0);
X=[X X1];

% i=1:21;
% j=21:200;
% 
% plot(X(1,i),X(1,i),'r*',X(1,j),X(1,j),'b');