【图】最短路径之旅游规划（C实现）

现有一张自驾旅游路线图，通过地图你会知道城市间的高速公路长度、以及该公路要收取的过路费。现在需要你写一个程序，帮助前来咨询的游客找一条出发地和目的地之间的最短路径。如果有若干条路径都是最短的，那么需要输出最便宜的一条路径。（注：该题目来源于浙江大学陈越老师题目，因为Java编译的时间和内存限制问题，暂时新增题目以便通过，如有能减少消耗的，也请不吝指导。）

输入格式:

输入说明：输入数据的第1行给出4个正整数N、M、S、D，其中N（2≤N≤500）是城市的个数，顺便假设城市的编号为0~(N−1)；M是高速公路的条数；S是出发地的城市编号；D是目的地的城市编号。随后的M行中，每行给出一条高速公路的信息，分别是：城市1、城市2、高速公路长度、收费额，中间用空格分开，数字均为整数且不超过500。输入保证解的存在。

输出格式:

在一行里输出路径的长度和收费总额，数字间以空格分隔，输出结尾不能有多余空格。

输入样例:

在这里给出一组输入。例如：

6 8 1 5
0 1 3 20
1 2 2 10
0 3 4 10
1 5 12 90
2 4 3 40
4 5 5 30
3 5 7 50
2 3 9 30

输出样例:

在这里给出相应的输出。例如：

10 80

代码如下： 

#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#define Infinity 10000
struct graph //邻接矩阵存储图
{
	int Nv;
	int Ne;
	int * * Length; //高速公路长度
	int * * Price; //过路费
};
typedef struct graph * Graph;

Graph CreateGraph(int N);
int * Collected; //判断顶点是否已收录
int main()
{
	int N, M, S, D;
	scanf("%d %d %d %d", &N, &M, &S, &D);
	Graph G;
	G = CreateGraph(N);
	int i;
	int v1, v2, l, p;
	for (i = 0; i < M; i++)
	{
		scanf("%d %d %d %d", &v1, &v2, &l, &p);
		G->Length[v1][v2] = l;
		G->Length[v2][v1] = l;
		G->Price[v1][v2] = p;
		G->Price[v2][v1] = p;
	}
	Collected = (int *)malloc(N * sizeof(int));
	for (i = 0; i < N; i++)
	{
		Collected[i] = 0;
	}
	//有权图最短单源路径的Dijkstra算法
	//求顶点S到其余顶点的最短路径问题
	int * dist, *fee;//dist数组记录最短距离，fee数组记录最少过路费
	dist = (int *)malloc(N * sizeof(int));
	fee = (int *)malloc(N * sizeof(int));
	for (i = 0; i < N; i++) //初始化
	{
		dist[i] = -1;
		fee[i] = 0;
	}
	Collected[S] = 1;
	dist[S] = 0;
	fee[S] = 0;
	for (i = 0; i < N; i++)
	{
		if (G->Length[S][i] != 0)
		{
			dist[i] = G->Length[S][i];
			fee[i] = G->Price[S][i];
		}
	}
	int min, index;
	while (1)
	{
		min = Infinity;
		int flag = 0;
		for (i = 0; i < N; i++) //每次收录dist数组内值最小的顶点
		{
			if (Collected[i] == 0 && dist[i] < min)
			{
				flag = 1;
				min = dist[i];
				index = i;
			}
		}
		if (flag == 0)
		{
			break;
		}
		Collected[index] = 1;
		for (i = 0; i < N; i++)
		{
			if (G->Length[index][i] > 0 && G->Length[index][i] < Infinity)
			{
				if (dist[index] + G->Length[index][i] < dist[i] && Collected[i] == 0) //收录一个顶点后，更新受其影响的顶点的dist和fee
				{
					dist[i] = dist[index] + G->Length[index][i];
					fee[i] = fee[index] + G->Price[index][i];
				}
				else if (dist[index] + G->Length[index][i] == dist[i] && Collected[i] == 0) //如果dist值相等，但是fee更小，则更新fee
				{
					if (fee[index] + G->Price[index][i] < fee[i])
					{
						fee[i] = fee[index] + G->Price[index][i];
					}
				}
			}
		}
	}
	printf("%d %d", dist[D], fee[D]);
	return 0;
}
Graph CreateGraph(int N)//创建图
{
	int i, j;
	Graph G;
	G = (Graph)malloc(sizeof(struct graph));
	G->Nv = N;
	G->Ne = 0;
	G->Length = (int * *)malloc(N * sizeof(int *));
	for (i = 0; i < N; i++)
	{
		G->Length[i] = (int *)malloc(N * sizeof(int));
	}
	G->Price = (int * *)malloc(N * sizeof(int *));
	for (i = 0; i < N; i++)
	{
		G->Price[i] = (int *)malloc(N * sizeof(int));
	}
	for (i = 0; i < N; i++)
	{
		for (j = 0; j < N; j++)
		{
			if (i == j)
			{
				G->Length[i][j] = 0;
				G->Price[i][j] = 0;
			}
			G->Length[i][j] = Infinity;
			G->Price[i][j] = Infinity;
		}
	}
	return G;
}