Dijkstra算法的Matlab程序资料

《Dijkstra算法的Matlab程序资料》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。

1、Functionpath=DijkstraPlan(position，sign)%%基于Dijkstra算法的路径规划算法%positioninput%节点位置%signinput%节点间是否可达（可用NaN表示不可达）%pathoutput%规划路径%%计算路径距离cost=ones(size(sign))*10000;[n,m]=size(sign);fori=1:nforj=1:mifsign(i,j)==1cost(i,j)=sqrt(sum((positon(i,:)-position(j,:)).^2));end

2、endend%%路径开始点dist=cost(1,:);%节点间路径长度s=zeros(size(dist));%节点经过标志s(1)=1;dist(1)=0;path=zeros(size(dist));%依次经过的节点path(1,:)=1;%%循环寻找路径点fornum=2:n%选择路径长度最小点mindist=10000;fori=1:length(dist)ifs(i)==0ifdist(i)

3、th(dist)ifs(i)==0ifdist(u)+cost(u,w)