手写matlab的弗洛伊德算法的函数(注释很详细)

function [dist,mypath]=myfloyd(a,sb,db)

%输入邻接矩阵a；元素a(i,j)——顶点i到j之间的直达距离，可以是有向的

%sb起点的标号；db终点的标号

%输出：dist——最短的距离

%mypath——最短的路径

%优点可以求出任意两点之间的最短路缺点就是慢

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

%得path矩阵对于path(i,j)的值表示如果要从i到j,j的前一个节点，然后看path(i,path(i,j)(即前一个节点的值))

%依次倒推找到最短路径

dist = a(sb,db);

parent = path(sb,:);%从起点sb到终点db的最短路上各顶点的前驱顶点

parent(parent==0)=sb;%path中的分量为0，表示该顶点的前驱是起点

mypath =db; t=db;

while t~=sb

    p = parent(t);

    mypath = [p,mypath];%从终点到起点倒着记录

    t=p;

end

end