Floyd算法的完整Matlab程序

function [d,path]=floyd(B,sp,ep)
%floyd-最短路问题
%输入：
%B-邻接矩阵(bij)，指i到j之间的距离，可以是有向的。
%sp-   起点标号。
%ep-   终点标号。
%输出：
%d-     最短路的距离。
%path-最短路的路径。
n=size(B,1);
D=B
path=zeros(n,n);
for i=1:n
    for j=1:n
        if D(i,j)~=inf
            path(i,j)=j;    %j是i的后续点
        end
    end
end
for k=1:n
    for i=1:n
        for j=:n
            if D(i,j)>D(i,k)+D(k,j)
                D(i,j)=D(i,k)+D(k,j);
                path(i,j)=path(i,k);
            end
        end
    end
end
p=[sp];