1 简介

为实现无人机编队在指定空域完成从起始点到目标点间的自主路径规划,且机群在该过程中具有良好的协同性和执行高效性,提出了一种无人机群航路自主规划的方法并进行仿真.分析了机群个体的规划路径点及其特点,并通过建立的数学评价体系对以上路径进行优劣性评估.仿真及评估结果表明:该方案是正确和有效的,并能对传统规划方案存在的固有缺陷进行较好的修正,更利于现实中无人机群的实现.

【路径规划】基于人工势场的无人机三维路径规划matlab源码_无人机

【路径规划】基于人工势场的无人机三维路径规划matlab源码_无人机_02

【路径规划】基于人工势场的无人机三维路径规划matlab源码_无人机_03

【路径规划】基于人工势场的无人机三维路径规划matlab源码_无人机_04

3 部分代码

close all
  • 1.
clear all
  • 1.
tic
  • 1.
%%
  • 1.
%==========================================================================
  • 1.
%初始化
  • 1.
%==========================================================================
  • 1.
P0 = [0;0;0];%起点位置
  • 1.
n = 7;%障碍个数
  • 1.
Tar = [10;10;10];%%目标点坐标
  • 1.
Obs = [10 10 10;1 1.2 1;3 2.5 3;4 4.5 4;3 6 3;6 2 6;6 6 6;8 8.5 8]';%目标点与障碍位置 第一列是目标点
  • 1.
%%
  • 1.
figure(1);
  • 1.
plot3(Obs(1,2:8),Obs(2,2:8),Obs(3,2:8),'o');hold on;
  • 1.
plot3(Obs(1,1),Obs(2,1),Obs(3,1),'O');
  • 1.
for i=1:5
  • 1.
po = i;%障碍影响距离
  • 1.
[P,K]=shi(po,Tar,n,P0,Obs);
  • 1.
%==========================================================================
  • 1.
%画图
  • 1.
%==========================================================================
  • 1.
switch i
  • 1.
case 1
  • 1.
plot3(P(1,1:K),P(2,1:K),P(3,1:K),'.b');
  • 1.
case 2
  • 1.
plot3(P(1,1:K),P(2,1:K),P(3,1:K),'.r');
  • 1.
case 3
  • 1.
plot3(P(1,1:K),P(2,1:K),P(3,1:K),'.g');
  • 1.
case 4
  • 1.
plot3(P(1,1:K),P(2,1:K),P(3,1:K),'.m');
  • 1.
otherwise
  • 1.
plot3(P(1,1:K),P(2,1:K),P(3,1:K),'.k');
  • 1.
end
  • 1.
end
  • 1.
toc
  • 1.

4 仿真结果
点击并拖拽以移动

【路径规划】基于人工势场的无人机三维路径规划matlab源码_无人机_06点击并拖拽以移动

5 参考文献

[1]毛晨悦, 吴鹏勇. 基于人工势场法的无人机路径规划避障算法[J]. 电子科技, 2019(7).

[2]魏博文, 邵长旭, 王茂森. 基于人工势场法的无人机群航路自主规划[J]. 兵工自动化, 2018, 37(011):84-88.

【路径规划】基于人工势场的无人机三维路径规划matlab源码_无人机_08