当前位置 : 主页 > 编程语言 > python >

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码

来源:互联网 收集:自由互联 发布时间:2022-06-15
1 简介 2 部分代码 %_________________________________________________________________________________ % Salp Swarm Algorithm (SSA) source codes version 1.0 % %____________________________________________________________________________

1 简介

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_无人机

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_matlab代码_02

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_matlab代码_03

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_matlab代码_04

2 部分代码

%_________________________________________________________________________________
% Salp Swarm Algorithm (SSA) source codes version 1.0
%
%____________________________________________________________________________________
function [FoodFitness,FoodPosition,Convergence_curve]=SSA(N,Max_iter,lb,ub,dim,fobj)
if size(ub,1)==1
ub=ones(dim,1)*ub;
lb=ones(dim,1)*lb;
end
Convergence_curve = zeros(1,Max_iter);
%Initialize the positions of salps
SalpPositions=initialization(N,dim,ub,lb);
FoodPosition=zeros(1,dim);
FoodFitness=inf;
%calculate the fitness of initial salps
for i=1:size(SalpPositions,1)
SalpFitness(1,i)=fobj(SalpPositions(i,:));
end
[sorted_salps_fitness,sorted_indexes]=sort(SalpFitness);
for newindex=1:N
Sorted_salps(newindex,:)=SalpPositions(sorted_indexes(newindex),:);
end
FoodPosition=Sorted_salps(1,:);
FoodFitness=sorted_salps_fitness(1);
%Main loop
l=2; % start from the second iteration since the first iteration was dedicated to calculating the fitness of salps
while l<Max_iter+1
c1 = 2*exp(-(4*l/Max_iter)^2); % Eq. (3.2) in the paper
for i=1:size(SalpPositions,1)
SalpPositions= SalpPositions';
if i<=N/2
for j=1:1:dim
c2=rand();
c3=rand();
%%%%%%%%%%%%% % Eq. (3.1) in the paper %%%%%%%%%%%%%%
if c3<0.5
SalpPositions(j,i)=FoodPosition(j)+c1*((ub(j)-lb(j))*c2+lb(j));
else
SalpPositions(j,i)=FoodPosition(j)-c1*((ub(j)-lb(j))*c2+lb(j));
end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
end
elseif i>N/2 && i<N+1
point1=SalpPositions(:,i-1);
point2=SalpPositions(:,i);
SalpPositions(:,i)=(point2+point1)/2; % % Eq. (3.4) in the paper
end
SalpPositions= SalpPositions';
end
for i=1:size(SalpPositions,1)
Tp=SalpPositions(i,:)>ub';Tm=SalpPositions(i,:)<lb';SalpPositions(i,:)=(SalpPositions(i,:).*(~(Tp+Tm)))+ub'.*Tp+lb'.*Tm;
SalpFitness(1,i)=fobj(SalpPositions(i,:));
if SalpFitness(1,i)<FoodFitness
FoodPosition=SalpPositions(i,:);
FoodFitness=SalpFitness(1,i);
end
end
Convergence_curve(l)=FoodFitness;
l = l + 1;
end

3 仿真结果

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_d3_05

【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_matlab代码_06

4 参考文献

[1]汤安迪, 韩统, 徐登武,等. 基于混沌麻雀搜索算法的无人机航迹规划方法[J]. 计算机应用, 2021, 41(7):9.

博主简介:擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真,相关matlab代码问题可私信交流。

部分理论引用网络文献,若有侵权联系博主删除。


【无人机三维路径规划】基于麻雀搜索算法实现无人机航迹规划附matlab代码_d3_07



网友评论