clc; % 清除命令窗口内容 clear; % 清除所有变量

Vm = 750; % 机器人的速度 Vt = 600; % 无人机的速度 r0 = 1000; % 无人机和机器人的初始距离 q0 = 90; % 无人机的初始高度 x = 0; % 机器人在x轴上的位置 y = 0; % 机器人在y轴上的位置 X = 0; % 无人机在x轴上的位置 Y = 1000; % 无人机在y轴上的位置 x1= 0; % 机器人与无人机在x轴上的相对位置 time = 0; % 时间 interval = 0.01; % 时间间隔 D = [time;q0]; % 无人机高度随时间的变化 DD = [D' x y 0 1000 0]; % 保存数据

while(y<=Y) D = [time;q0]; % 无人机高度随时间的变化

x = x + Vm*0.8*interval; % 机器人在x轴上的位置变化
y = y + Vm*0.6*interval; % 机器人在y轴上的位置变化
X = X + 600*interval; % 无人机在x轴上的位置变化

x1 = x1 + (Vm*0.8-600)*interval; % 机器人与无人机在x轴上的相对位置变化

DD = [DD;D' x y X Y x1]; % 保存数据
time = time + interval; % 时间增加

end

figure(1); plot(DD(:,3),DD(:,4),'LineWidth',1.5); % 绘制机器人和无人机的轨迹 hold on; plot(DD(:,5),DD(:,6),'r','LineWidth',1.5); % 绘制无人机的轨迹

figure(2); plot(DD(:,7),DD(:,4),'LineWidth',1.5); % 绘制机器人和无人机在x轴上的相对位置随时间的变化 hold on; % plot(DD(:,5),DD(:,6),'r','LineWidth',1.5); % 绘制无人机的轨

clc;clear;Vm = 750;Vt = 600;r0 = 1000;q0 = 90;x = 0;y = 0;X = 0;Y = 1000;x1= 0;time = 0;interval = 001;D = time;q0;DD = D x y 0 1000 0;whiley=Y D = time;q0; x = x + Vm08interval; y = y +

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

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