有了一张自驾旅游路线图,你会知道城市间的高速公路长度、以及该公路要收取的过路费。现在需要你写一个程序,帮助前来咨询的游客找一条出发地和目的地之间的最短路径。如果有若干条路径都是最短的,那么需要输出最便宜的一条路径。
输入格式:
输入说明:输入数据的第1行给出4个正整数N、M、S、D,其中N(2≤N≤500)是城市的个数,顺便假设城市的编号为0~(N−1);M是高速公路的条数;S是出发地的城市编号;D是目的地的城市编号。随后的M行中,每行给出一条高速公路的信息,分别是:城市1、城市2、高速公路长度、收费额,中间用空格分开,数字均为整数且不超过500。输入保证解的存在。
输出格式:
在一行里输出路径的长度和收费总额,数字间以空格分隔,输出结尾不能有多余空格。
输入样例:
4 5 0 3
0 1 1 20
1 3 2 30
0 3 4 10
0 2 2 20
2 3 1 20
输出样例:
3 40
思路:Dijkstra算法,多加一个变量代表收费。
#include<stdio.h>
#include<stdlib.h>
#define MaxVertexNum 503
typedef struct GNode* Graph;
#define INFINITY 65535
struct GNode{
int Nv, Ne;
int L[MaxVertexNum][MaxVertexNum];
int P[MaxVertexNum][MaxVertexNum];
};
int FindMinDist(Graph G, int* dist, int* visited){
int i ;
int mindist = INFINITY;
int min = -1;
for(i = 0; i < G->Nv; i++){
if(!visited[i] && dist[i] < mindist){
mindist = dist[i];
min = i;
}
}
return min;
}
void Dijkstra(Graph G, int S, int* dist, int* money, int* visited, int* path){
int i,temp;
//将与起点连接的点更新
for (i = 0; i < G->Nv; i++){
dist[i] = G->L[S][i];
money[i] = G->P[S][i];
if (dist[i] != INFINITY)
path[i] = S;
}
//起点先加入集合
visited[S] = 1;
dist[S] = 0;
while(1){
//找到剩下的点中距离最近一个点
temp = FindMinDist(G, dist, visited);
if (temp == -1)
break;
//将他加入集合
visited[temp] = 1;
//更新该点的邻接点的信息
for(i = 0; i < G->Nv; i++){
if (visited[i] == 0 && G->L[temp][i] < INFINITY){
if(dist[i] > dist[temp] + G->L[temp][i]){
dist[i] = dist[temp] + G->L[temp][i];
money[i] = money[temp] + G->P[temp][i];
path[i] = temp;
}
if(dist[i] == dist[temp] + G->L[temp][i]){//选取花最少钱的一条路径,更新money
if(money[i] > money[temp] + G->P[temp][i])
money[i] = money[temp] + G->P[temp][i];
}
}
}
//继续循环
}//结束循环
}
int main(){
int v1, v2, length, price;
int N, M, S, D;
int i, j;
int visited[MaxVertexNum], path[MaxVertexNum],dist[MaxVertexNum], money[MaxVertexNum];
Graph G;
G = (Graph)malloc(sizeof(struct GNode));
scanf("%d %d %d %d", &N, &M, &S, &D);
G->Nv = N;
G->Ne = M;
//初始化:dist,money全都为INFINITY,邻接矩阵也为INFINITY;path为-1;
for(i = 0; i < N; i++){
visited[i] = 0;
path[i] = -1;
dist[i] = INFINITY;
money[i] = INFINITY;
for(j = 0; j < N; j++)
G->L[i][j] = INFINITY;
G->P[i][j] = INFINITY;
}
//读取数据,更新邻接表
for( i = 0; i < M; i++){
scanf("%d %d %d %d",&v1, &v2, &length, &price);
G->L[v1][v2] = length;
G->L[v2][v1] = length;
G->P[v1][v2] = G->P[v2][v1] = price;
}
//Dijkstra算法
Dijkstra(G,S,dist,money, visited,path);
printf("%d %d\n",dist[D],money[D]);
system("pause");
}