Floyd算法适用于APSP(All Pairs Shortest Paths,多源最短路径),是一种动态规划算法,稠密图效果最佳,边权可正可负。此算法简单有效,由于三重循环结构紧凑,对于稠密图,效率要高于执行|V|次Dijkstra算法,也要高于执行V次SPFA算法。
优点:容易理解,可以算出任意两个节点之间的最短距离,代码编写简单。
缺点:时间复杂度比较高,不适合计算大量数据。
%floyd算法通用程序,输入a为赋权邻接矩阵
%输出为距离矩阵D,和最短路径矩阵path
clc
clear
a=[Inf,Inf,10,Inf,30,100;Inf,Inf,5,Inf,Inf,Inf;Inf,Inf,Inf,50,Inf,Inf;Inf,Inf,Inf,Inf,Inf,10;Inf,Inf,Inf,20,Inf,60;Inf,Inf,Inf,Inf,Inf,Inf];%邻接矩阵
s=1;
t=6;%这里设置哪到哪的最短路
n=size(a,1);
D=a;
path=zeros(n,n);
for i=1:n
for j=1:n
if D(i,j)~=inf
path(i,j)=j;
end
end
end
for k=1:n
for i=1:n
for j=1:n
if D(i,k)+D(k,j)<D(i,j)
D(i,j)=D(i,k)+D(k,j);
path(i,j)=path(i,k);
end
end
end
end
%% 配合floyd算法的后续程序,s为源点,t为宿点
%L为长度,R为路由
%若出现提示形如“试图访问 D(0,2);索引必须为正整数或逻辑值”提示说明不存在最短路
L=zeros(0,0);
R=s;
while 1
if s==t
L=fliplr(L);
L=[0,L];
return
end
if D(s,t)==Inf
L=Inf;break;
else
L=[L,D(s,t)];
R=[R,path(s,t)];
s=path(s,t);
end
end
a;%a为输入的邻接矩阵
D;%输出两点间的最短路长
path;%输出路由矩阵,即最短路径矩阵,虽然我也不懂是啥
L=L(length(L))%L的最后一位即为s到t的最短路长 key
R%这里输出最短路的路径 key
clear;
clc;
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';
M=max(max(a))*n^2;
%M为充分大的正实数
a=a+((a==0)-eye(n))*M;
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
%求第一个城市到其它城市的短路径的 Matlab 程序如下:
clc,clear
a=zeros(6);
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(find(a==0))=inf;
pb(1:length(a))=0;
pb(1)=1;index1=1;
index2=ones(1,length(a));
d(1:length(a))=inf;
d(1)=0;temp=1;
while sum(pb)<length(a)
tb=find(pb==0);
d(tb)=min(d(tb),d(temp)+a(temp,tb));
tmpb=find(d(tb)==min(d(tb)));
temp=tb(tmpb(1));
pb(temp)=1;
index1=[index1,temp];
temp2=find(d(index1)==d(temp)-a(temp,index1));
index2(temp)=index1(temp2(1));
end
d, index1, index2