弗洛伊德算法

#include <stdio.h>
#include <iostream>
using namespace std;
#define INF 65535
int d[101][101];//邻接矩阵，不存在边就为无穷大
int p[101][101];//路径矩阵，P[i][j]表示从i到j需要经过的第一个点，初始化就为j

void Init_and_Input(int n,int m)/*初始化_输入函数*/
{
    int i,j,a,b,t;
    for(i=1;i<=n;i++)
        for(j=1;j<=n;j++)
        {
            d[i][j]=INF;
            p[i][j]=j;
        }
    for(i=1;i<=m;i++)
    {
        scanf("%d%d%d",&a,&b,&t);
        d[a][b]=d[b][a]=t;
    }
}

void Floyd(int n)/*贪心迭代*/
{
    int i,j,k;
    for(k=1;k<=n;k++)
        for(i=1;i<=n;i++)
            for(j=1;j<=n;j++)
                if(d[i][k]+d[k][j]<d[i][j])
                {
                    d[i][j]=d[i][k]+d[k][j];
                    p[i][j]=p[i][k];
                }
}

int main()
{
    int n,m,x,y,en;
    freopen("in.txt","r",stdin);
    scanf("%d%d",&n,&m);
    Init_and_Input(n,m);
    Floyd(n);
    scanf("%d%d",&x,&y);
    printf("最短路径为：");
    en=x;/*输出路径需要这种技巧哦*/
    while(en!=y)
    {
        printf("%d->",en);
        en=p[en][y];
    }
    printf("%d\n",y);
    printf("最短路径长度为：");
    printf("%d\n",d[x][y]);
    fclose(stdin);
}