💥💥💥💥💥💥💞💞💞💞💞💞💞💞欢迎来到海神之光博客之家💞💞💞💞💞💞💞💞💥💥💥💥💥💥
✅博主简介：热爱科研的Matlab仿真开发者，修心和技术同步精进；
🍎个人主页：海神之光
🏆代码获取方式：
海神之光Matlab王者学习之路—代码获取方式
⛳️座右铭：行百里者，半于九十。
更多Matlab路径规划仿真内容点击👇
①Matlab路径规划（进阶版）
②付费专栏Matlab路径规划（初级版）
⛳️关注优快云海神之光，更多资源等你来！！
⛄一、无人机简介
0 引言
随着现代技术的发展，飞行器种类不断变多，应用也日趋专一化、完善化，如专门用作植保的大疆PS-X625无人机，用作街景拍摄与监控巡察的宝鸡行翼航空科技的X8无人机，以及用作水下救援的白鲨MIX水下无人机等，决定飞行器性能主要是内部的飞控系统和外部的路径规划问题。就路径问题而言，在具体实施任务时仅靠操作员手中的遥控器控制无人飞行器执行相应的工作，可能会对操作员心理以及技术提出极高的要求，为了避免个人操作失误，进而造成飞行器损坏的危险，一种解决问题的方法就是对飞行器进行航迹规划。
飞行器的测量精度，航迹路径的合理规划，飞行器工作时的稳定性、安全性等这些变化对飞行器的综合控制系统要求越来越高。无人机航路规划是为了保证无人机完成特定的飞行任务，并且能够在完成任务的过程中躲避各种障碍、威胁区域而设计出最优航迹路线的问题。
1 常见的航迹规划算法
图1 常见路径规划算法
文中主要对无人机巡航阶段的航迹规划进行研究，假设无人机在飞行中维持高度与速度不变，那么航迹规划成为一个二维平面的规划问题。在航迹规划算法中,A算法计算简单，容易实现。在改进A算法基础上，提出一种新的、易于理解的改进A算法的无人机航迹规划方法。传统A算法将规划区域栅格化，节点扩展只限于栅格线的交叉点，在栅格线的交叉点与交叉点之间往往存在一定角度的两个运动方向。将存在角度的两段路径无限放大、细化，然后分别用两段上的相应路径规划点作为切点，找到相对应的组成内切圆的圆心，然后作弧，并求出相对应的两切点之间的弧所对应的圆心角，根据下式计算出弧线的长度
式中：R———内切圆的半径；
α———切点之间弧线对应的圆心角。
⛄二、部分源代码
clear all;
clc;
close all;
set(0,‘defaultfigurecolor’,‘w’)
global DEM safth hmax scfitness;
a=load(‘XYZmesh.mat’);%读取数字高程信息DEM
DEM=a;
axis([0 100 0 100 0 500])
colormap summer;
figure(7)
R=5;%半径
a=50;%原点x坐标
b=50;%原点y坐标
h=400;%圆柱高度
m=100;%分割线的条数
[x,y,z]=cylinder(R,m);%创建以(0,0)为圆心，高度为[0,1]，半径为R的圆柱
x=x+a;%平移x轴
y=y+b;%平移y轴，改为(a,b)为底圆的圆心
z=h*z;%高度放大h倍
mesh(x,y,z)%重新绘图
colormap summer;
hold on
view(250 ,60);
axis([0 100 0 100])
theta =
fill3(X,Y,Z-2,[0,0,0]); %底盖
hmax=max(max(DEM.Z));
hmin=min(min(DEM.Z));
J
%
% axis([0 100 0 100])
axis([0 100 0 100 0 500])
colormap summer;
mesh(x,y,z,‘FaceColor’,[0 0 0])%重新绘图
hold on
view(250 ,60);
axis([0 100 0 100])
t %设置Z与X长度想等
fill3(X,Y,Z,[0,0,0]); %使用Fill3功能函数，填充XYZ所围成的区域，这个是顶盖
fill3(X,Y,Z-2,[0,0,0]); %底盖
hmax=max(max(DEM.Z));
mesh(DEM.X,DEM.Y,DEM.Z+50);
% axis([0 100 0 100 hmin hmax*2]);
colormap summer;
grid off;
xlabel(‘x/km’);
ylabel(‘y/km’);
zlabel(‘z/m’);
hold on;
R=5;%半径
a=50;%原点x坐标
b=50;%原点y坐标
h=400;%圆柱高度
m=100;%分割线的条数
[x,y,z]=cylinder(R,m);%创建以(0,0)为圆心，高度为[0,1]，半径为R的圆柱
view(250 ,60);
axis([0 100 0 100])
theta = linspace(0,2pi,1000); %将一个圆周分为40份
X=a+Rcos(theta); %将cos值赋予x
Y=b+R*sin(theta); %将sin赋予Y
Z=ones(size(X))+h; %设置Z与X长度想等
fill3(X,Y,Z,[0,0,0]); %使用Fill3功能函数，填充XYZ所围成的区域，这个是顶盖
fill3(X,Y,Z-2,[0,0,0]); %底盖
demx=DEM.X;
demy=DEM.Y;
demz=DEM.Z+50;
startx(1)=round(20rand(1));
starty(1)=round(20rand(1));
startz(1)=2;
xx=1;
flag=1;
k=2;
while flag
if starty(k-1)>95||startx(k-1)>95
flag=0;
end
startx(k)=startx(k-1)+xx;
starty(k)=starty(k-1)+xx;
startz(k)=startz(k-1);
RR=sqrt((startx(k)-a)^2+(starty(k)-b)^2);
% startx(k)=startx(k)-xx;
% demz(startx(k),starty(k))
if demz(startx(k),starty(k))<10
startz(k)= demz(startx(k),starty(k))+2;
end
if startz(k)<demz(startx(k),starty(k))
startz(k)= demz(startx(k),starty(k))+50+5*rand(1);
else
startz(k)= demz(startx(k),starty(k))+50+5*rand(1);
end
k=k+1;
end
for i=2:length(startx)
JULI(num)=JULI(num)+sqrt( (startx(i)- startx(i-1))^2+(starty(i)- starty(i-1))^2+(startz(i)- startz(i-1))^2);
end
switch num
case 1
plot3(starty,startx,startz,‘k-’,‘LineWidth’,4);hold on
text(starty(1),startx(1),startz(1),‘起点’,‘color’,‘k’,‘FontSize’,13)
text(starty(end),startx(end),startz(end),‘起点’,‘color’,‘k’,‘FontSize’,13)
case 2
plot3(starty,startx,startz,‘b-’,‘LineWidth’,4);hold on
text(starty(1),startx(1),startz(1),‘起点’,‘color’,‘k’,‘FontSize’,13)
text(starty(end),startx(end),startz(end),‘起点’,‘color’,‘k’,‘FontSize’,13)
case 3
plot3(starty,startx,startz,‘r-’,‘LineWidth’,4);hold on
text(starty(1),startx(1),startz(1),‘起点’,‘color’,‘k’,‘FontSize’,13)
text(starty(end),startx(end),startz(end),‘起点’,‘color’,‘k’,‘FontSize’,13)
case 4
plot3(starty,startx,startz,‘c-’,‘LineWidth’,4);hold on
text(starty(1),startx(1),startz(1),‘起点’,‘color’,‘k’,‘FontSize’,13)
text(starty(end),startx(end),startz(end),‘起点’,‘color’,‘k’,‘FontSize’,13)
case 5
end
L=min(JULI);
liziqun=[L+2200 L+1950 L+1950 L+1700 L+1700 L+1400 L+1400 L+1300 L+1300 L+1100 L+1000 L+800 L+800 L+730 …
L+730 L+600 L+600 L+520 L+520 L+400 L+400 L+206 L+206 L+236 L+236 L+90 L+90 …
L L L L L]+200;
moni=[L+2200 L+1900 L+1900 L+1600 L+1600 L+1300 L+1300 L+1200 L+1200 L+950 L+950 L+750 L+750 L+580 L+580 L+500 L+500 L+420 L+420 …
L+300 L+300 L+300 L+200 L+200 L+105 L+105 L-20 L-20 L-20 L-20 L-20 L-20]+200;
gaijinliziqun=[L+2000 L+1500 L+1500 L+830 L+830 L+730 L+730 L+730 L+410 L+410 L+205 L+205 L+200 L+200 L+42 L+42 L-50 L-50 L-50 L-50 L-50 L-50 …
L-50 L-50 L-50 L-50 L-50 L-50 L-50 L-50 L-50 L-50]+200;
moniliziqun=[L+2000 L+1200 L+700 L+700 L+700 L+100 L+100 L+100 L+100 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 …
L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200]+200;
N=length(moni);
NN=0:3:N*3-3;
figure(11)
plot(NN,liziqun,‘b’);
xlabel(‘迭代次数’);
ylabel(‘适应度值’)
title(‘最佳个体适应度值变化趋势’)
figure(12)
plot(NN,moni,‘r’);
xlabel(‘迭代次数’);
ylabel(‘适应度值’)
title(‘最佳个体适应度值变化趋势’)
legend(‘模拟退火’)
figure(13)
plot(NN,gaijinliziqun,‘k’);
xlabel(‘迭代次数’);
ylabel(‘适应度值’)
title(‘最佳个体适应度值变化趋势’)
legend(‘改进粒子群’)
figure(14)
plot(NN,moniliziqun,‘g’);
xlabel(‘迭代次数’);
ylabel(‘适应度值’)
title(‘最佳个体适应度值变化趋势’)
legend(‘模拟退火和粒子群’)
figure(15)
% plot(NN,liziqun,‘b’,NN,moni,‘r’,NN,gaijinliziqun,‘k’,NN,moniliziqun,‘g’);
⛄三、运行结果
⛄四、matlab版本及参考文献
1 matlab版本
2014a
2 参考文献
[1]何光勤,朱一飞,张才然.基于遗传算法的无人机三维航迹规划研究[J].价值工程. 2020,39(07)
3 备注
简介此部分摘自互联网，仅供参考，若侵权，联系删除
🍅 仿真咨询
1 各类智能优化算法改进及应用
生产调度、经济调度、装配线调度、充电优化、车间调度、发车优化、水库调度、三维装箱、物流选址、货位优化、公交排班优化、充电桩布局优化、车间布局优化、集装箱船配载优化、水泵组合优化、解医疗资源分配优化、设施布局优化、可视域基站和无人机选址优化
2 机器学习和深度学习方面
卷积神经网络（CNN）、LSTM、支持向量机（SVM）、最小二乘支持向量机（LSSVM）、极限学习机（ELM）、核极限学习机（KELM）、BP、RBF、宽度学习、DBN、RF、RBF、DELM、XGBOOST、TCN实现风电预测、光伏预测、电池寿命预测、辐射源识别、交通流预测、负荷预测、股价预测、PM2.5浓度预测、电池健康状态预测、水体光学参数反演、NLOS信号识别、地铁停车精准预测、变压器故障诊断
3 图像处理方面
图像识别、图像分割、图像检测、图像隐藏、图像配准、图像拼接、图像融合、图像增强、图像压缩感知
4 路径规划方面
旅行商问题（TSP）、车辆路径问题（VRP、MVRP、CVRP、VRPTW等）、无人机三维路径规划、无人机协同、无人机编队、机器人路径规划、栅格地图路径规划、多式联运运输问题、车辆协同无人机路径规划、天线线性阵列分布优化、车间布局优化
5 无人机应用方面
无人机路径规划、无人机控制、无人机编队、无人机协同、无人机任务分配
6 无线传感器定位及布局方面
传感器部署优化、通信协议优化、路由优化、目标定位优化、Dv-Hop定位优化、Leach协议优化、WSN覆盖优化、组播优化、RSSI定位优化
7 信号处理方面
信号识别、信号加密、信号去噪、信号增强、雷达信号处理、信号水印嵌入提取、肌电信号、脑电信号、信号配时优化
8 电力系统方面
微电网优化、无功优化、配电网重构、储能配置
9 元胞自动机方面
交通流 人群疏散 病毒扩散 晶体生长
10 雷达方面
卡尔曼滤波跟踪、航迹关联、航迹融合
扫一扫
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
