✅作者简介：热爱科研的Matlab仿真开发者，擅长数据处理、建模仿真、程序设计、完整代码获取、论文复现及科研仿真。
🍎 往期回顾关注个人主页：Matlab科研工作室
👇 关注我领取海量matlab电子书和数学建模资料
🍊个人信条：格物致知,完整Matlab代码获取及仿真咨询内容私信。
🔥 内容介绍
- 引言：为什么 UAV/AUV 需要 “三维智能避障”？
1.1 从二维到三维：航行器的 “空间自由” 与 “避障焦虑”
无论是空中巡检的无人机（UAV），还是海洋勘探的自主水下航行器（AUV），真实作业场景从来不是 “平面赛道”：
UAV 要面对高楼、山脉、电线杆等立体障碍物，还要考虑海拔落差、风速扰动；
AUV 需规避礁石、海底山脉、沉船等水下障碍，同时适应水深、水流、水压变化。
传统二维路径规划（比如只考虑平面 x/y 坐标）无法应对三维空间的复杂约束，而人工势场法（Artificial Potential Field, APF）凭借 “原理简单、实时性强、适配性高” 的优势，成为三维路径规划的核心算法之一 —— 它能模拟 “引力 + 斥力” 的物理场，让航行器像 “被目标吸引、被障碍排斥” 一样，自主找到安全最优路径。
1.2 本文核心看点：UAV/AUV 双场景全覆盖
通俗拆解人工势场法三维扩展原理，零基础也能看懂；
针对性解决 UAV/AUV 不同环境的适配难题（空中 vs 水下）；
给出改进型算法实操方案，避开传统 APF 的 “局部最优”“目标不可达” 坑；
附仿真案例 + 核心步骤，方便直接落地验证。
- 基础认知：人工势场法的 “三维逻辑”
2.1 核心原理：像 “磁铁” 一样引导航行器
人工势场法的本质是 “虚拟力场建模”：
引力场：由 “起点→目标点” 产生，拉力越大，航行器越靠近目标；
斥力场：由 “障碍物” 产生，推力越大，航行器越远离障碍；
航行器的运动方向 = 引力与斥力的 “合力方向”，通过实时计算合力，动态调整航行路径。
2.2 从二维到三维：关键公式升级（通俗版）
传统二维 APF 只考虑 x/y 平面，三维场景需加入 z 轴（高度 / 水深），核心公式简化如下：
Image
- 核心挑战：传统 APF 的 “三维坑” 怎么填？
直接将二维 APF 扩展到三维，会遇到 3 个致命问题，尤其在 UAV/AUV 复杂场景中：
3.1 局部最优陷阱：航行器 “卡壳” 在障碍之间
比如 UAV 遇到两座相邻高楼，引力拉它向目标，两座楼的斥力相互抵消，航行器在中间来回徘徊，无法前进 —— 这就是 “局部最优”（合力为 0）。
3.2 目标不可达：目标点被障碍 “包围”
若目标点附近有障碍物（比如 AUV 要抵达海底礁石旁的探测点），障碍斥力会大于目标引力，航行器永远无法靠近目标。
3.3 路径不平滑：UAV 颠簸、AUV 能耗飙升
三维空间中合力方向可能频繁突变，导致航行器轨迹 “折线过多”——UAV 飞行颠簸影响稳定性，AUV 则因频繁转向增加能耗。
⛳️ 运行结果
Image
Image
📣 部分代码
classdef Environment
properties
obstacles = {}; % list of obstacle structs with fields: type, pos, size, color
figureHandle
end
methods
function obj = Environment()
obj.figureHandle = figure;
hold on;
view(3);
axis vis3d;
grid on;
xlabel('x'); ylabel('y'); zlabel('z');
xlim([0 30]); ylim([0 30]); zlim([0 10]);
end
function obj = addCylinder(obj, pos, radius, color)
obj.obstacles{end+1} = struct('type', 'cylinder', 'pos', pos, 'radius', radius, 'color', color);
obj.drawCylinder(pos, radius, color);
end
function obj = addWall(obj, basePos, dims, color)
if nargin < 4
color = [0.6 0.6 0.6]; % default grey
end
wall.pos = basePos(:); % [x; y; z]
wall.dims = dims(:); % [width; depth; height]
wall.type = 'wall';
wall.color = color;
obj.obstacles{end+1} = wall;
obj.drawWall(wall);
end
function obj = addSphere(obj, pos, radius, color)
[X, Y, Z] = sphere(30);
X = X * radius + pos(1);
Y = Y * radius + pos(2);
Z = Z * radius + pos(3);
surf(X, Y, Z, 'FaceColor', color, 'EdgeColor', 'none');
obj.obstacles{end+1} = struct('type', 'sphere', 'pos', pos, 'radius', radius, 'color', color);
end
function drawCylinder(~, pos, radius, color)
nSides = 50;
[X,Y,Z] = cylinder(radius, nSides);
Z = Z * pos(3);
X = X + pos(1);
Y = Y + pos(2);
surf(X,Y,Z,'FaceColor',color,'EdgeColor','none');
end
function drawWall(~, wall)
pos = wall.pos(:);
dims = wall.dims(:);
color = wall.color;
% Get the 8 corners of the box
[X, Y, Z] = ndgrid([0, 1], [0, 1], [0, 1]);
corners = [X(:), Y(:), Z(:)] .* dims' + pos';
% Define box faces by corner indices
faces = [
1 3 4 2; % bottom
5 6 8 7; % top
1 2 6 5; % front
2 4 8 6; % right
4 3 7 8; % back
3 1 5 7 % left
];
% Plot the box
for i = 1:size(faces,1)
f = faces(i,:);
patch('Vertices', corners, 'Faces', f, ...
'FaceColor', color, 'FaceAlpha', 0.5, 'EdgeColor', 'none');
end
end
end
end
🔗 参考文献
图片
🏆团队擅长辅导定制多种科研领域MATLAB仿真，助力科研梦：
