基于改进粒子群算法的多无人机协同航迹规划（Matlab代码实现）

💥💥💞💞欢迎来到本博客❤️❤️💥💥
🏆博主优势：🌞🌞🌞博客内容尽量做到思维缜密，逻辑清晰，为了方便读者。
⛳️座右铭：行百里者，半于九十。

⛳️赠与读者

👨‍💻做科研，涉及到一个深在的思想系统，需要科研者逻辑缜密，踏实认真，但是不能只是努力，很多时候借力比努力更重要，然后还要有仰望星空的创新点和启发点。当哲学课上老师问你什么是科学，什么是电的时候，不要觉得这些问题搞笑。哲学是科学之母，哲学就是追究终极问题，寻找那些不言自明只有小孩子会问的但是你却回答不出来的问题。建议读者按目录次序逐一浏览，免得骤然跌入幽暗的迷宫找不到来时的路，它不足为你揭示全部问题的答案，但若能让人胸中升起一朵朵疑云，也未尝不会酿成晚霞斑斓的别一番景致，万一它居然给你带来了一场精神世界的苦雨，那就借机洗刷一下原来存放在那儿的“躺平”上的尘埃吧。
或许，雨过云收，神驰的天地更清朗.......🔎🔎🔎

💥1 概述

基于改进粒子群算法的多无人机协同航迹规划是一种利用优化算法解决复杂问题的方法，它旨在为多架无人机（UAVs）设计出高效、安全且符合任务要求的飞行路径。这种方法通过模仿鸟群的社会行为来搜索最优解，同时对基本粒子群优化（Particle Swarm Optimization, PSO）算法进行改进以适应多无人机系统的特殊需求。

一、粒子群算法（PSO）基础与改进方向

1.PSO基本原理

PSO模拟鸟群觅食行为，每个粒子代表一个潜在解，通过更新位置和速度逼近最优解。核心公式为：

2.PSO的局限性及改进方向

局部极值问题：标准PSO易陷入局部最优，需引入变异机制（如柯西变异）增强全局搜索能力。
收敛速度慢：自适应惯性权重（如Sigmoid递增权重）可平衡探索与开发阶段。
多目标优化缺陷：需结合Pareto支配与非支配排序处理多目标冲突。

二、多无人机协同航迹规划的关键挑战

1.组合爆炸问题

nn 架无人机在 kk 条路径中搜索时，解空间达 knkn 级，需剪枝或分层规划降低复杂度。
解决方案：采用滚动时域优化（Rolling Horizon），将全局问题分解为局部路径迭代优化。

2.时空协同约束

时间协同：要求多机同时到达目标点，需优化航迹长度与速度配比。
空间避障：需同时规避静态障碍物（建筑、山体）和动态威胁（其他无人机）。
动力学约束：无人机转弯角度、爬升率受限，航迹需满足最小曲率半径。

3.不确定性环境

突发威胁（如新增障碍物）要求在线重规划能力。
现有研究多假设静态环境，动态场景下算法鲁棒性不足。

三、改进粒子群算法的协同航迹规划框架

1.算法改进策略

改进方法	核心机制	优势
自适应柯西变异 (ACMPSO)	指数型惯性权重 + 柯西变异步长	跳出局部最优，收敛速度提升30%
PSO-GWO混合算法	引入灰狼算法包围策略（精英粒子引导群体）	寻优精度提高1-4个数量级
多目标MOPSO	外部存档存储Pareto最优解 + 非支配排序	同时优化航迹长度、威胁代价、能耗

2.协同规划框架设计

分层规划：先分配任务再优化航迹，降低求解复杂度。
滚动优化：窗口内局部寻优，多步规划单步执行，平衡实时性与全局性。
冲突消解：基于速度/航向调配的动态避障策略，考虑最大加速度约束。

四、冲突检测与避障策略

1.分布式冲突检测（CD）

分析4D轨迹（空间+时间）预测碰撞，生成离散化威胁表示。
因果分析模块（CR）：计算轨迹偏差成本函数，选择最优避障路径。

2.强化学习避障

深度Q学习（DQN）：将雷达探测数据映射为避障动作，奖励函数设计为：
R=α⋅安全距离+β⋅能耗+γ⋅任务优先级
实现动静态障碍物联合规避。

3.复杂网络避障

节点收缩算法筛选关键节点，仅调整高度维度避碰，减少计算量。

五、仿真验证与性能分析

1.典型场景设置

场景类型	参数设置	优化目标
三维城市空域	100km×100km×10km，雷达威胁+建筑障碍	航迹长度、威胁规避、高度平滑
多机协同侦察	5架无人机，动态目标+突发威胁	任务完成时间、协同一致性
密集集群飞行	20架无人机，共享航路	冲突次数、空域利用率

2.算法对比结果

ACMPSO vs 标准PSO：
- 航迹长度缩短15%，威胁规避率提升22%，计算耗时减少40%。
PSO-GWO vs 遗传算法：
- 在 f1f1~f8f8 测试函数中，寻优精度提高1-4个数量级。
MOPSO多目标优化：
- 同时降低距离代价18%、威胁代价27%、能耗代价15%。

3.动态环境验证

滚动PSO在突发威胁下重规划响应时间<0.5s，成功率91%。
DQN避障在动态障碍物场景中碰撞率降至5%以下。

六、未来研究方向

混合算法开发
- 融合强化学习与PSO（如RL-DC算法），提升动态环境适应性。
并行计算框架
- 利用GPU加速MOPSO的Pareto解集搜索，支持千架无人机实时规划。
不确定性建模
- 引入区间分析（Interval Analysis）处理传感器误差，避障成功率可提升至96%。
多机通信优化
- 设计低延迟通信协议，解决时空协同中的信息异步问题。

结论

改进粒子群算法通过引入自适应变异、多目标优化及分层滚动策略，有效解决了多无人机协同航迹规划中的组合爆炸、动态避障和时空约束问题。未来需进一步结合强化学习与并行计算，提升高密度动态环境下的实时性与鲁棒性。仿真验证表明，所提框架在航迹质量、计算效率和安全性能上均显著优于传统方法。

📚2 运行结果

部分代码：

% 改进的多种群粒子群算法
% -------------------------------------------------------------
% 改进策略：
% 整个种群分为三类：1优势群 2劣势群 3混合群 3类群在每次迭代过程中依据适应度动态组合
% 1.劣势群
% 高斯变异+混合更新
% 2.优势群
% 融合莱维飞行以及贪婪算法
% 3.混合群
% 融合动态权重因子和正余弦思想更新位置
% -------------------------------------------------------------

% 清空运行环境
clc;
clear;
close all;

% 设置随机种子为2，确保随机数生成器的初始状态是一致的，以便于进行可重复的实验。
rng(2);

%% 三维地图模型
% 定义路径规划的起点和终点坐标
startPos = [10, 400, 10];
goalPos = [470, 420, 60];

% 随机定义山峰地图
mapRange = [500,500,100]; % 地图长、宽、高范围
N=10; % 山峰个数，更改山峰个数同时要到defMap.m里更改山峰中心坐标
[X,Y,Z] = defMap(mapRange,N); % 10个山峰

% 创建图窗口
figure('Name','Map');
% 标记起点和终点
scatter3(startPos(1), startPos(2), startPos(3),100,'bs','MarkerFaceColor','y');
hold on;
scatter3(goalPos(1), goalPos(2), goalPos(3),100,'kp','MarkerFaceColor','y');

% 画山峰曲面
surf(X,Y,Z); % 画曲面图
hold on;
shading interp; % 使用插值方法进行着色，使得曲面上的颜色更加平滑
colormap summer; % 内置颜色映射表，表示夏季风格的颜色，从深蓝渐变到浅黄

% 威胁物定义；更新威胁物坐标时Draw_path.m里的也要更新
alpha1=0.4; % 不透明度

% 定义威胁物的坐标、半径等参数
menaceParams = [
struct('start', [270, 200, 0], 'end', [270, 200, 100], 'radius', 20);
struct('start', [170, 350, 0], 'end', [170, 350, 100], 'radius', 30);
struct('start', [300, 300, 0], 'end', [300, 300, 100], 'radius', 25);
struct('start', [350, 400, 0], 'end', [350, 400, 100], 'radius', 30);
];