function RealRoad()
%軌跡描述  目標跟蹤中經常用到的一種運動目標軌跡描述
%假設目標在三維空間運動,始置為(1600,2700,5400),運動速度為200m/s。
%前20s內目標做勻速直線飛行，俯仰角為45度，方位角也為45度。
%20s以后以法向10g的加速度在X-Y平面內做圓周運動，至80s飛行結束。

t1=0:0.1:20

    
x1=200*cos(pi/4)*cos(pi/4)*t1+1600;
y1=200*cos(pi/4)*sin(pi/4)*t1+2700;
z1=200*sin(pi/4)*t1+5400;

hold on

t2=20:0.1:80
x2=2000-1000*2^0.5+2000*cos(2^0.5/20*(t2-20-5*2^0.5/2*pi))+1600;
y2=2000+1000*2^0.5+2000*sin(2^0.5/20*(t2-20-5*2^0.5/2*pi))+2700;
z2=200*sin(pi/4)*t2+5400;

x=[x1,x2];
y=[y1,y2];
z=[z1,z2];
t=[t1,t2];
plot3(x,y,z);
grid on;