C语言实现Floyd算法

题目描述：
有向单源最短路径问题（Floyd算法）

输入格式
第1行：2个空格分开的整数n(2<=n<=500)和m(10<=m<=20000),分别表示图的顶点数和边数。
第2..m+1行:每行3个空格分开的整数i, j, w。i表示一条边的起点。j表示终点，w表示权值。
第m+2行：2个整数s,t(1<=s,t<=n),表示指定的顶点。

输出格式
第一行：最小距离
第二行：最短路径（从起点到终点的序列，用1个空格分开）

输入格式：

5  7
1 2 10
1 4 30
1 5 100
2 3 50
3 5 10
4 3 20
4 5 60
1 5

输出格式：

60
1 4 3 5

#define _CRT_SECURE_NO_WARNINGS
#include<stdio.h>
#include<stdlib.h>
#define INFINITY 65535
#define MaxVertexNum 500
int G[MaxVertexNum][MaxVertexNum],path[MaxVertexNum][MaxVertexNum] = {0},
D[MaxVertexNum][MaxVertexNum];
int s, t;
int n, m;
void BuildGraph() {
	int V, W;
	int V1, V2, Weight;
	scanf("%d%d", &n, &m);
	for (V = 1; V <= n; V++)
		for (W = 1; W <= n; W++) {
			G[V][W] = INFINITY;
		}	
	for (V = 1; V <= m; V++) {
		scanf("%d%d%d", &V1, &V2, &Weight);
		G[V1][V2] = Weight;//注意：这里指的是有向图
		path[V1][V2] = V1;
	}
}
void Find_path(int x) {
	if (path[s][x] == 0)
		return;
	Find_path(path[s][x]);
		printf("%d ", x);
}
bool Floyd() {
	int i, j, k;
	for (i = 1; i <= n; i++)
		for (j = 1; j <= n; j++) {
			D[i][j] = G[i][j];
		}		
	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];
					if (i == j && D[i][j] < 0)
						return false;
					path[i][j] = path[k][j];
				}
	return true;
}
int main() {
	BuildGraph();
	Floyd();
	scanf("%d%d", &s, &t);
	printf("%d\n", D[s][t]);
	printf("%d ", s);
	Find_path(t);
	return 0;
	system("pause");
}