数模：Floyd算法：求两点间的最短路径

思路：
用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