1 粒子群算法

模型參考這里。

3 代碼

%% 粒子群 clc; close all clear load('data4.mat') figure(1)%畫障礙圖 hold on S=(S_coo(2)-0.5)*num_shange+(S_coo(1)+0.5);%起點(diǎn)對(duì)應(yīng)的編號(hào) E=(E_coo(2)-0.5)*num_shange+(E_coo(1)+0.5);%終點(diǎn)對(duì)應(yīng)的編號(hào) for i=1:num_shange   for j=1:num_shange       if sign(i,j)==1           y=[i-1,i-1,i,i];           x=[j-1,j,j,j-1];           h=fill(x,y,'k');           set(h,'facealpha',0.5)       end       s=(num2str((i-1)*num_shange+j));       %text(j-0.95,i-0.5,s,'fontsize',6)   end end axis([0 num_shange 0 num_shange])%限制圖的邊界 plot(S_coo(2),S_coo(1), 'p','markersize', 10,'

總結(jié)

以上是生活随笔為你收集整理的【路径规划】基于粒子群算法实现机器人栅格地图路径规划matlab源码的全部?jī)?nèi)容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網(wǎng)站內(nèi)容還不錯(cuò)，歡迎將生活随笔推薦給好友。