一、部分代码

close all
clear 
clc
rng('default');
%% 载入数据
data.S=[50,950,12];     %起点位置 横坐标与纵坐标需为50的倍数
data.E=[950,50,1]; %终点点位置 横坐标与纵坐标需为50的倍数
data.Obstacle=xlsread('data1.xls');
data.numObstacles=length(data.Obstacle(:,1));
%% 画图
figure
hold on
plot(curve,'r','LineWidth',2)
xlabel('迭代次数')
ylabel('路径长度')
legend(str);
[~,result]=fobj(Best_pos);
drawPc(result,option,data,str)
result.path(:,1)=result.path(:,1).*data.unit(1);
result.path(:,2)=result.path(:,2).*data.unit(2);
result.path(:,3)=result.path(:,3).*data.unit(3);
%% 显示路径信息
fprintf("路径坐标:\n");
display(result.path)
fprintf("路径长度:%f\n",result.fit);

二、部分结果

路径坐标:

  50  950  12

  100  900  11

  100  850  11

  100  800  10

  150  750   9

  200  700   8

  250  650   7

  250  600   7

  250  550   7

  250  500   7

  250  450   7

  300  400   6

  350  400   6

  400  350   5

  450  350   5

  500  350   5

  550  300   5

  600  300   5

  650  300   5

  700  250   4

  750  200   4

  800  150   3

  850  100   2

  900  100   2

  950  50   1

路径长度:1448.608844

三、完整MATLAB代码

基于北方苍鹰优化算法NGO的复杂城市地形下无人机避障三维航迹规划，可以修改障碍物及起始点（Matlab代码）-CSDN博客

基于鹈鹕优化算法POA的复杂城市地形下无人机避障三维航迹规划，可以修改障碍物及起始点（Matlab代码）-CSDN博客

基于蛇优化算法SO的复杂城市地形下无人机避障三维航迹规划，可以修改障碍物及起始点（Matlab代码）-CSDN博客