資源簡介
基于蟻族算法的二維路徑規(guī)劃算法,可以用于機器人的路徑規(guī)劃問題,尋找最優(yōu)路徑。

代碼片段和文件信息
function?path?=?DijkstraPlan(positionsign)
%%?基于Dijkstra算法的路徑規(guī)劃算法
%position????input?????%節(jié)點位置
%sign????????input?????%節(jié)點間是否可達
?
%path????????output????%規(guī)劃路徑
?
%%?計算路徑距離
cost?=?ones(size(sign))*10000;
[nm]?=?size(sign);
for?i?=?1:n
????for?j?=?1:m
????????if?sign(ij)?==?1
????????????cost(ij)?=?sqrt(sum((position(i:)-position(j:)).^2));
????????end
????end
end
?
%%?路徑開始點
dist?=?cost(1:);?????????????%節(jié)點間路徑長度???????????
s?=?zeros(size(dist));????????%節(jié)點經(jīng)過標志
s(1)?=?1;dist(1)?=?0;
path?=?zeros(size(dist));?????%依次經(jīng)過的節(jié)點
path(1:)?=?1;
?
%%?循環(huán)尋找路徑點
for?num?=?2:n???
????
????%?選擇路徑長度最小點
????mindist?=?10000;
????for?i?=?1:length(dist)
????????if?s(i)?==?0
????????????if?dist(i)????????????????mindist?=?dist(i);
????????????????u?=?i;
????????????end
????????end
????end
????
????%?更新點點間路徑
????s(u)?=?1;
????for?w?=?1:length(dist)
????????if?s(i)?==?0
????????????if?dist(u)+cost(uw)?????????????????dist(w)?=?dist(u)+cost(uw);
????????????????path(w)?=?u;
????????????end
????????end
????end
end
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件????????225??2013-12-20?09:39??基于蟻族算法的二維路徑規(guī)劃算法\barrier.asv
?????文件????????190??2013-12-20?09:44??基于蟻族算法的二維路徑規(guī)劃算法\barrier.txt
?????文件???????1158??2010-11-17?08:41??基于蟻族算法的二維路徑規(guī)劃算法\DijkstraPlan.m
?????文件????????122??2009-07-19?18:08??基于蟻族算法的二維路徑規(guī)劃算法\lines.txt
?????文件???????5599??2014-02-27?09:22??基于蟻族算法的二維路徑規(guī)劃算法\main.asv
?????文件???????5599??2014-03-02?10:57??基于蟻族算法的二維路徑規(guī)劃算法\main.m
?????文件????????989??2009-08-05?18:33??基于蟻族算法的二維路徑規(guī)劃算法\matrix.txt
?????文件???????3730??2013-12-22?19:44??基于蟻族算法的二維路徑規(guī)劃算法\unti
?????目錄??????????0??2013-12-22?19:44??基于蟻族算法的二維路徑規(guī)劃算法
-----------?---------??----------?-----??----
????????????????17612????????????????????9
- 上一篇:匯編語言-推箱子
- 下一篇:dsp2812 ADC程序
評論
共有 條評論