思路:
用a矩阵来存储点与点之间距离的矩阵
用path来存之间经过的点
算法:主要不断更新距离的最小值,最后得到的a矩阵就是最短路径矩阵
代码(matlab)
n=6;
a=zeros(n);
a(1,2)=50;
a(1,4)=40;
a(1,5)=25;
a(1,6)=10;
a(2,3)=15;
a(2,4)=20;
a(2,6)=25;
a(3,4)=10;
a(3,5)=20;
a(4,5)=10;
a(4,6)=25;a(5,6)=55;
a=a'+a
a(a==0)=inf;
a([1:n+1:n.^2])=0;
path=zeros(n);
for k=1:n
for i=1:n
for j=1:n
if a(i,j)>a(i,k)+a(k,j)//如果比当前的路径小就替换
a(i,j)=a(i,k)+a(k,j);
path(i,j)=k;//记录下经过的点
end
end
end
end
a,path
算sb到db的通用算法
function [dist,mypath]=myfloyd(a,sb,db)
n=size(a,1);
path=zeros(n);
for k=1:n
for i=1:n
for j=1:n
if a(i,j)>a(i,k)+a(k,j)
a(i,j)=a(i,k)+a(k,j);
path(i,j)=k;
end
end
end
end
dist=a(sb,db);
parent=path(sb,:);
parent(parent==0)=sb;
mypath=db;t=db;
while t~=sb
p=parent(t);mypath=[p,mypath];
t=p;
end