trajectory1.m

来自「雷达数据处理的重要模型算法之一」· M 代码 · 共 13 行

T=1;
XX=[10e3,200,0,20e3,100,0]';
t1=30/T;
[X(:,1:t1),Z(:,1:t1),z(:,1:t1)]=contant_v(XX,30);%30s匀速 (t:0-30)
t2=t1+40/T;
[X(:,t1+1:t2),Z(:,t1+1:t2),z(:,t1+1:t2)]=turn_left(X(:,t1),40);%10s左转弯  (t:30-55)
t3=t2+30/T;
[X(:,t2+1:t3),Z(:,t2+1:t3),z(:,t2+1:t3)]=contant_v(X(:,t2),30);%30s匀速  (t:55-85)
figure(1);
plot(X(1,:),X(4,:),'k');
xlabel('时间（秒）');ylabel('位移（米）');
title('环境三');