飞道的博客

【路径规划】基于精英粒子群算法双机器人路径规划matlab源码

263人阅读  评论(0)

一、简介

1 粒子群算法的概念
粒子群优化算法(PSO:Particle swarm optimization) 是一种进化计算技术(evolutionary computation)。源于对鸟群捕食的行为研究。粒子群优化算法的基本思想:是通过群体中个体之间的协作和信息共享来寻找最优解.
PSO的优势:在于简单容易实现并且没有许多参数的调节。目前已被广泛应用于函数优化、神经网络训练、模糊系统控制以及其他遗传算法的应用领域。

2 粒子群算法分析
2.1基本思想
粒子群算法通过设计一种无质量的粒子来模拟鸟群中的鸟,粒子仅具有两个属性:速度和位置,速度代表移动的快慢,位置代表移动的方向。每个粒子在搜索空间中单独的搜寻最优解,并将其记为当前个体极值,并将个体极值与整个粒子群里的其他粒子共享,找到最优的那个个体极值作为整个粒子群的当前全局最优解,粒子群中的所有粒子根据自己找到的当前个体极值和整个粒子群共享的当前全局最优解来调整自己的速度和位置。下面的动图很形象地展示了PSO算法的过程:

2 更新规则
PSO初始化为一群随机粒子(随机解)。然后通过迭代找到最优解。在每一次的迭代中,粒子通过跟踪两个“极值”(pbest,gbest)来更新自己。在找到这两个最优值后,粒子通过下面的公式来更新自己的速度和位置。

公式(1)的第一部分称为【记忆项】,表示上次速度大小和方向的影响;公式(1)的第二部分称为【自身认知项】,是从当前点指向粒子自身最好点的一个矢量,表示粒子的动作来源于自己经验的部分;公式(1)的第三部分称为【群体认知项】,是一个从当前点指向种群最好点的矢量,反映了粒子间的协同合作和知识共享。粒子就是通过自己的经验和同伴中最好的经验来决定下一步的运动。以上面两个公式为基础,形成了PSO的标准形式。

公式(2)和 公式(3)被视为标准PSO算法。
3 PSO算法的流程和伪代码

二、源代码


  
  1. function [L_best,xx,tourGbest]=main(data)
  2. %% 下载数据
  3. % data=load('coor.txt');
  4. % cityCoor=data;%城市坐标矩阵
  5. cityCoor= data;
  6. %% 计算城市间距离
  7. n= size(cityCoor,1); %城市数目
  8. cityDist= zeros(n,n); %城市距离矩阵
  9. for i=1:n
  10. for j=1:n
  11. if i~=j
  12. cityDist(i,j)= ((cityCoor(i,1)-cityCoor(j,1))^2+...
  13. (cityCoor(i,2)-cityCoor(j,2))^2+(cityCoor(i,3)-cityCoor(j,3))^2)^0.5;
  14. end
  15. cityDist(j,i)= cityDist(i,j);
  16. end
  17. end
  18. nMax= 10; %进化次数
  19. indiNumber= 400; %个体数目
  20. individual= zeros(indiNumber,n);
  21. %^初始化粒子位置
  22. for i=1:indiNumber
  23. individual(i,: )=randperm(n);
  24. end
  25. %% 计算种群适应度
  26. indiFit= fitness(individual,cityDist);
  27. [value,index]= min(indiFit);
  28. tourPbest= individual; %当前个体最优
  29. tourGbest= individual(index,:) ; %当前全局最优
  30. recordPbest= inf*ones(1,indiNumber); %个体最优记录
  31. recordGbest= indiFit(index); %群体最优记录
  32. xnew1= individual;
  33. %% 循环寻找最优路径
  34. L_best= zeros(1,nMax);
  35. for N=1:nMax
  36. N
  37. %计算适应度值
  38. indiFit= fitness(individual,cityDist);
  39. % %% 精英复制
  40. % [bad good order]=elite(individual,cityCoor,cityDist,0.1); %提取10%的精英粒子
  41. % elitenum=size(bad,2);
  42. % individual(bad,:)=individual(good,:);
  43. %% 精英复制学习
  44. [bad good order]=elite(individual,cityCoor,cityDist,0.1); %提取10%的精英粒子
  45. elitenum= size(bad,2);
  46. %随机调整
  47. for i=1:elitenum
  48. % better(i,:)=tsp(cityCoor,n,cityDist);
  49. better(i,: )=goodchange(individual(good(i),:),cityDist);
  50. end
  51. individual(bad,: )=better;
  52. %更新当前最优和历史最优
  53. for i=1:indiNumber
  54. if indiFit(i)<recordPbest(i)
  55. recordPbest(i)= indiFit(i);
  56. tourPbest(i,: )=individual(i,:);
  57. end
  58. if indiFit(i)<recordGbest
  59. recordGbest= indiFit(i);
  60. tourGbest= individual(i,:);
  61. end
  62. end
  63. [value,index]= min(recordPbest);
  64. recordGbest(N)= recordPbest(index);
  65. %% 交叉操作
  66. for i=1:indiNumber
  67. % 与个体最优进行交叉
  68. c1= unidrnd(n-1); %产生交叉位
  69. c2= unidrnd(n-1); %产生交叉位
  70. while c1==c2
  71. c1= round(rand*(n-2))+1;
  72. c2= round(rand*(n-2))+1;
  73. end
  74. chb1= min(c1,c2);
  75. chb2= max(c1,c2);
  76. cros= tourPbest(i,chb1:chb2);
  77. ncros= size(cros,2);
  78. %删除与交叉区域相同元素
  79. for j=1:ncros
  80. for k=1:n
  81. if xnew1(i,k)==cros(j)
  82. xnew1(i,k)= 0;
  83. for t=1:n-k
  84. temp= xnew1(i,k+t-1);
  85. xnew1(i,k+t-1)= xnew1(i,k+t);
  86. xnew1(i,k+t)= temp;
  87. end
  88. end
  89. end
  90. end
  91. %插入交叉区域
  92. xnew1(i,n-ncros+1: n)=cros;
  93. %新路径长度变短则接受
  94. dist= 0;
  95. for j=1:n-1
  96. dist= dist+cityDist(xnew1(i,j),xnew1(i,j+1));
  97. end
  98. dist= dist+cityDist(xnew1(i,1),xnew1(i,n));
  99. if indiFit(i)>dist
  100. individual(i,: )=xnew1(i,:);
  101. end
  102. % 与全体最优进行交叉
  103. c1= round(rand*(n-2))+1; %产生交叉位
  104. c2= round(rand*(n-2))+1; %产生交叉位
  105. while c1==c2
  106. c1= round(rand*(n-2))+1;
  107. c2= round(rand*(n-2))+1;
  108. end
  109. chb1= min(c1,c2);
  110. chb2= max(c1,c2);
  111. cros= tourGbest(chb1:chb2);
  112. ncros= size(cros,2);
  113. %删除与交叉区域相同元素
  114. for j=1:ncros
  115. for k=1:n
  116. if xnew1(i,k)==cros(j)
  117. xnew1(i,k)= 0;
  118. for t=1:n-k
  119. temp= xnew1(i,k+t-1);
  120. xnew1(i,k+t-1)= xnew1(i,k+t);
  121. xnew1(i,k+t)= temp;
  122. end
  123. end
  124. end
  125. end
  126. %插入交叉区域
  127. xnew1(i,n-ncros+1: n)=cros;
  128. %新路径长度变短则接受
  129. dist= 0;
  130. for j=1:n-1
  131. dist= dist+cityDist(xnew1(i,j),xnew1(i,j+1));
  132. end
  133. function path = tsp(loc,NumCity,distance)
  134. % NumCity = length(loc); %城市个数
  135. % distance = zeros(NumCity); %初始化距离矩阵,30行30列
  136. %
  137. % %装填距离矩阵
  138. % for i = 1:NumCity,
  139. % for j = 1:NumCity,
  140. % %城市i和城市j之间的距离,既为两点间的二阶范数
  141. % distance(i, j) = norm(loc(i, :) - loc(j, :));
  142. % end
  143. % end
  144. %
  145. % %通过目标函数从路径中生成能量值,既为各个城市之间距离的和
  146. % %path = randperm(NumCity);
  147. % %energy = sum(distance((path-1)*NumCity + [path(2:NumCity) path(1)]));
  148. count = 1000;
  149. all_dE = zeros(count, 1);
  150. for i = 1:count
  151. path = randperm(NumCity); %随机的生成一个路径,数字为30以内
  152. %把距离定义成能量值,把所有城市之间的距离相加
  153. energy = sum(distance((path-1)*NumCity + [path(2:NumCity) path(1)]));
  154. new_path = path;
  155. index = round(rand(2,1)*NumCity+.5);
  156. inversion_index = (min(index):max(index));
  157. new_path(inversion_index) = fliplr(path(inversion_index));
  158. all_dE(i) = abs(energy - ...
  159. sum(sum(diff(loc([new_path new_path(1)],:))'.^2)));
  160. end
  161. dE = max(all_dE);%记录20组能量差里面的最大值
  162. dE = max(all_dE);
  163. temp = 10*dE; %选择一个最大差值作为起始温度值
  164. MaxTrialN = NumCity*100; % 最大的试验温度值 ,既试验解的最大个数
  165. MaxAcceptN = NumCity*10; % 最大的可接受的温度值,既可接受的解的最大个数
  166. StopTolerance = 0.005; %容忍度,既为终止温度值
  167. StopTolerance = 0.005;
  168. TempRatio = 0.4; %温度下降比率
  169. minE = inf; %初始化最小能量值
  170. maxE = -1; %初始化最大能量值

三、运行结果



四、备注

完整代码添加QQ1575304183


转载:https://blog.csdn.net/weixin_50197058/article/details/116432548
查看评论
* 以上用户言论只代表其个人观点,不代表本网站的观点或立场