代码拉取完成,页面将自动刷新
function[X,Y] = TrueRoute(Ts,offtime)
%产生真实航迹[X,Y],并在真实坐标系下绘制
%Ts为gps观测周期,每隔Ts时间得到一个观测数据
%offtime为仿真的时间,车速大概为0-8m/S,微电子学院大楼的环绕距离大约400m,按车速1m/s来走,时间为400s
if nargin>2
error('输入的变量过多,请检查');
end
x=zeros(offtime,1);
y=zeros(offtime,1);
X=zeros(ceil(offtime/Ts),1);
Y=zeros(ceil(offtime/Ts),1);
% t=0:100s,速度vx,vy为沿着x轴和y轴的分量(m/s)
x0=50;
y0=50;
vx=1;%速度为1m/s,先沿着x轴
vy=0;
for t=1:100
x(t)=x0+vx*t;
y(t)=y0+vy*t;
end
% t=100:200s,速度vx,vy为沿着x轴和y轴的分量(m/s)
vx=0;%速度为1m/s,先沿着x轴
vy=1;
for t=0:100
x(t+101)=x(100)+vx*t;
y(t+101)=y(100)+vy*t;
end
% t=200:300s,速度vx,vy为沿着x轴和y轴的分量(m/s)
vx=-1;%速度为1m/s,先沿着x轴
vy=0;
for t=0:100
x(t+201)=x(201)+vx*t;
y(t+201)=y(201)+vy*t;
end
% t=300:400s,速度vx,vy为沿着x轴和y轴的分量(m/s)
vx=0;%速度为1m/s,先沿着x轴
vy=-1;
for t=0:100
x(t+301)=x(301)+vx*t;
y(t+301)=y(301)+vy*t;
end
% 得到观测数据
for n=0:Ts:offtime
X(n/Ts+1)=x(n+1);
Y(n/Ts+1)=y(n+1);
end
% %显示真实轨迹
% plot(X,Y,'LineWidth',2),axis([0 200 0 200]),grid on;
% legend('目标真实航迹');
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。