【WPA三维路径规划】狼群算法无人机三维路径规划【含Matlab源码 2643期】

最新推荐文章于 2024-09-11 07:32:36 发布

Matlab武动乾坤

最新推荐文章于 2024-09-11 07:32:36 发布

阅读量80

点赞数

分类专栏： Matlab路径规划（进阶版）文章标签： matlab

本文链接：https://blog.csdn.net/KeepingMatlab/article/details/134550431

版权

Matlab路径规划（进阶版）专栏收录该内容

814 篇文章 35 订阅

订阅专栏

✅博主简介：热爱科研的Matlab仿真开发者，修心和技术同步精进，Matlab项目合作可私信。
🍎个人主页：海神之光
🏆代码获取方式：
海神之光Matlab王者学习之路—代码获取方式
⛳️座右铭：行百里者，半于九十。

⛄一、无人机简介

0 引言
随着现代技术的发展，飞行器种类不断变多，应用也日趋专一化、完善化，如专门用作植保的大疆PS-X625无人机，用作街景拍摄与监控巡察的宝鸡行翼航空科技的X8无人机，以及用作水下救援的白鲨MIX水下无人机等，决定飞行器性能主要是内部的飞控系统和外部的路径规划问题。就路径问题而言，在具体实施任务时仅靠操作员手中的遥控器控制无人飞行器执行相应的工作，可能会对操作员心理以及技术提出极高的要求，为了避免个人操作失误，进而造成飞行器损坏的危险，一种解决问题的方法就是对飞行器进行航迹规划。
飞行器的测量精度，航迹路径的合理规划，飞行器工作时的稳定性、安全性等这些变化对飞行器的综合控制系统要求越来越高。无人机航路规划是为了保证无人机完成特定的飞行任务，并且能够在完成任务的过程中躲避各种障碍、威胁区域而设计出最优航迹路线的问题。

1 常见的航迹规划算法
在这里插入图片描述
图1 常见路径规划算法
文中主要对无人机巡航阶段的航迹规划进行研究，假设无人机在飞行中维持高度与速度不变，那么航迹规划成为一个二维平面的规划问题。在航迹规划算法中,A算法计算简单，容易实现。在改进A算法基础上，提出一种新的、易于理解的改进A算法的无人机航迹规划方法。传统A算法将规划区域栅格化，节点扩展只限于栅格线的交叉点，在栅格线的交叉点与交叉点之间往往存在一定角度的两个运动方向。将存在角度的两段路径无限放大、细化，然后分别用两段上的相应路径规划点作为切点，找到相对应的组成内切圆的圆心，然后作弧，并求出相对应的两切点之间的弧所对应的圆心角，根据下式计算出弧线的长度
在这里插入图片描述
式中：R———内切圆的半径；
α———切点之间弧线对应的圆心角。

⛄二、狼群算法简介

1、狼群算法中的狼种类分为以下几种：
头狼、探狼、猛狼。

2、猎物分配规则：论功行赏，先强后弱。

3、狼群算法的主体构成：探狼游走、头狼召唤、猛狼围攻3种智能行为，“胜者为王”的头狼角逐规则和“优胜劣汰”的狼群更新规则。

Step1：在解空间中随机初始化狼群的空间坐标，依据目标函数值的大小角逐出人工头狼。
Step2：探狼开始随机游走搜索猎物，若发现某个位置的目标函数值大于头狼的目标函数值，将更新头狼位置，同时头狼发出召唤行为；若未发现，探狼继续游走直到达到最大游走次数，头狼在原本的位置发出召唤行为。
Step3：听到头狼召唤的猛狼以较大的步长快速向头狼奔袭，若奔袭途中猛狼的目标函数值大于头狼的目标函数值，则将对头狼位置进行更新；否则，猛狼将继续奔袭直到进入围攻范围。
Step4：靠近头狼的猛狼将联合探狼对猎物（把头狼位置视为猎物）进行围捕，围捕过程中若其他人工狼的目标函数值大于头狼的目标函数值，则对头狼位置进行更新，直到捕获猎物。
Step5：淘汰狼群中目标函数值较小的人工狼，并在解空间中随机生成新的人工狼，实现狼群的更新。
Step6：最后判断头狼的目标函数值是否达到精度要求或算法是否达到最大迭代次数。
在这里插入图片描述

⛄三、部分源代码

clc
clear
close all

%% 三维路径规划模型定义
startPos = [1, 1, 1];
goalPos = [100, 100, 10];

% 随机定义山峰地图
mapRange = [100,100,100]; % 地图长、宽、高范围
[X,Y,Z] = defMap(mapRange);

%% 初始参数设置
iterMax = 100; % 迭代次数
pointNum = 3; % 每一个粒子包含三个位置点
N = 100; % 狼群总数
alpha = 0.5; % 探狼比例因子
S_num = N * alpha; % 探狼数量
M_num = N - S_num ; % 猛狼数量
S = 20; % 步长因子
step_a = mapRange / S; % 游走步长
step_b = 2*step_a; % 奔袭步长
step_c = step_a/2; % 围捕步长
h = 20; % 游走方向数
d0 = 10; % 由奔袭转围攻的临界距离
T_max = 10; % 围攻最大次数
posBound = [[0,0,0]‘,mapRange’]; % 位置界限

%% 种群初始化
% 初始化一个空的粒子结构体
wolf = struct;
wolf.pos= [];
wolf.fitness = [];
wolf.path = [];
wolfs = repmat(wolf,N,1);
wolfs_s = repmat(wolf,S_num,1);
wolfs_m = repmat(wolf,M_num,1);

% 初始化每一代的最优粒子
wolf_header.fitness = inf;

% 狼群随机分布位置
for i = 1:N
% 粒子按照正态分布随机生成
wolfs(i).pos.x = unifrnd(posBound(1,1),posBound(1,2),1,pointNum);
wolfs(i).pos.y = unifrnd(posBound(2,1),posBound(2,2),1,pointNum);
wolfs(i).pos.z = unifrnd(posBound(3,1),posBound(3,2),1,pointNum);

% 适应度
[flag,fitness,path] = calFitness(startPos, goalPos,X,Y,Z, wolfs(i).pos);

% 碰撞检测判断
if flag == 1
    % 若flag=1，表明此路径将与障碍物相交，则增大适应度值
    wolfs(i).fitness = 1000*fitness;
    wolfs(i).path = path;
else
    % 否则，表明可以选择此路径
    wolfs(i).fitness = fitness;
    wolfs(i).path = path;
end

% 更新全局最优
if wolfs(i).fitness < wolf_header.fitness
    wolf_header = wolfs(i);
    idx = i;
end

end

⛄四、运行结果

在这里插入图片描述

⛄五、matlab版本及参考文献

1 matlab版本
2014a

2 参考文献
[1]]焦阳.基于改进蚁群算法的无人机三维路径规划研究[J].舰船电子工程. 2019,39(03)

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 雷达方面
卡尔曼滤波跟踪、航迹关联、航迹融合