Floyd-Warshall算法

Floyd-Warshall算法是求一个图中任意两点之间的最短路径长度的算法。

题目：给出一个有向图，请计算图中任意两个顶点之间的最短路径，及其长度。
Input
第一行是该有向图的 顶点数n ( 0 < n < 500 )（注：图有n个顶点，首个顶点的编号是0。 ）
第二行是该有向图的 边数e ( 0 < e < n×n )
接下来e行，每行三个整数 i 、j 和 k，表示 顶点i 到顶点j 有一条弧，长度为k。 ( 0 ≤ i, j < n )
（注：输入数据中不含 自环 。）
接下来一个正整数Q，表示有Q个询问。
接下来Q行，每行两个非负整数u和v，表示询问 顶点u 到 顶点v 的最短路长度，以及该最短路径是怎么走的。
Output
对每个询问输出三行。
第一行是一个整数，表示顶点u到顶点v的最短路长度。如果不可达，输出INF ，且不用输出第二行。如果路径长度为0，也不用输出第二行。
第二行是若干个整数，每个整数后面跟一个空格，表示顶点u 到顶点v 的最短路的顶点序列。
第三行是一个空行，仅起分隔作用。

#include<stdio.h>
#include<string.h>
#define inf 0x3f3f3f3f
int cc[502][502];
void output(int i,int j){ ///输出路径
     if(i==j) return;
     if(cc[i][j]==-1) printf("%d ",j);
     else{
        output(i,cc[i][j]);
        output(cc[i][j],j);
    }
}
int main()
{
    memset(cc,-1,sizeof(cc));///因为该题首顶点从0开始，所以将记录路劲的数组初始化为-1而不能为0；若首顶点从1开始则可初始化为0
    int n,e,a[502][502],q,w,r;
    scanf("%d%d",&n,&e);///n为顶点个数，e为边的条数
    ///初始化
    for(int i=0;i<n;i++){	
        for(int j=0;j<n;j++){
            if(i==j)
                a[i][j]=0;
            else
                a[i][j]=inf;
        }
    }
    ///读入边
    for(int i=0;i<e;i++){
        scanf("%d%d%d",&q,&w,&r);
        a[q][w]=r;
    }
    ///Floyd-Warshall算法核心代码
    for(int k=0;k<n;k++){	
        for(int i=0;i<n;i++){
            for(int j=0;j<n;j++){
                if(a[i][j]>a[i][k]+a[k][j]){
                    a[i][j]=a[i][k]+a[k][j];///求出从i号顶点到j号顶点只经过前k号点的最短路程
                    cc[i][j]=k;///记录经过的点
                }
            }
        }
    }
    
    int Q,u,v;
    scanf("%d",&Q);
    while(Q--){
        scanf("%d%d",&u,&v);
        if(a[u][v]==inf)
            printf("INF\n");
        else if(a[u][v]==0)
            printf("0\n");
        else{
            printf("%d\n",a[u][v]);
            printf("%d ",u); ///首位置要先输出
            output(u,v);
            printf("\n");
        }
        printf("\n");
    }
    return 0;
}

如果你认为正无穷和其他值相加得到一个大于正无穷的数是不被允许的话，我们只需在判断的时候加两个判断条件就可以了，代码如下：

 for(int k=0;k<n;k++){	
        for(int i=0;i<n;i++){
            for(int j=0;j<n;j++){
                if(a[i][j]>a[i][k]+a[k][j]&&a[i][k]<inf&&a[k][i]<inf){
                    a[i][j]=a[i][k]+a[k][j];
                }
            }
        }
    }