realroad.m

目标跟踪中经常用到的一种运动目标轨迹描述

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;