clc; % \u00a0清空命令窗口\nclear; % \u00a0清空工作区变量\n\nVm = 750; % \u00a0速度\nVt = 600; % \u00a0目标速度\nr0 = 1000; % \u00a0距离\nq0 = 90; % \u00a0初始角度\nx = 0; % \u00a0初始位置x坐标\ny = 0; % \u00a0初始位置y坐标\nX = 0; % \u00a0目标位置x坐标\nY = 1000; % \u00a0目标位置y坐标\nx1= 0; % \u00a0相对位置x坐标\ntime = 0; % \u00a0初始时间\ninterval = 0.01; % \u00a0时间间隔\nD = [time;q0]; % \u00a0存储时间和角度的矩阵\nDD = [D' x y 0 1000 0]; % \u00a0存储所有数据的矩阵\nwhile(x<=X)\n\tD = [time;atand((Y-y)/(X-x))]; % \u00a0计算角度\n\n\tx = x + Vmcosd(D(2))interval; % \u00a0计算新的位置x坐标\n\ty = y + Vmsind(D(2))interval; % \u00a0计算新的位置y坐标\n\tX = X + 600interval; % \u00a0计算新的目标位置x坐标\n\n\tx1 = x1 + (Vmcosd(D(2))-600)*interval; % \u00a0计算相对位置x坐标\n\n\tDD = [DD;D' x y X Y x1]; % \u00a0将新的数据添加到DD矩阵中\n\ttime = time + interval; % \u00a0更新时间\n\nend\nfigure(1); % \u00a0创建第一个图像窗口\nplot(DD(:,3),DD(:,4),'LineWidth',1.5);hold on; % \u00a0绘制位置x和位置y的曲线\nplot(DD(:,5),DD(:,6),'r','LineWidth',1.5); % \u00a0绘制目标位置x和目标位置y的曲线\n\nfigure(2); % \u00a0创建第二个图像窗口\nplot(DD(:,7),DD(:,4),'LineWidth',1.5);hold on; % \u00a0绘制相对位置x和位置y的曲线\n% plot(DD(:,5),DD(:,6),'r','LineWidth',1.5); % \u00a0绘制目标位置x和目标位置y的曲线


原文地址: http://www.cveoy.top/t/topic/pFnW 著作权归作者所有。请勿转载和采集!

免费AI点我,无需注册和登录