7-9 旅游规划

有了一张自驾旅游路线图，你会知道城市间的高速公路长度、以及该公路要收取的过路费。现在需要你写一个程序，帮助前来咨询的游客找一条出发地和目的地之间的最短路径。如果有若干条路径都是最短的，那么需要输出最便宜的一条路径。

输入格式:

输入说明：输入数据的第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算法问题，只不过在建立的图中，每条边有两个权重，一个是公路的长度，一个是收费额，当从源点S到某一点W有若干条等长的最短路径时，选择收费额最短的那一条；这意味着我们在每个结点更新最短路径的时候也要更新收费额；此外，若有等长路径时还要比较收费额，若更少，则要更新最短路径及收费额。

 具体代码实现为：

#include<stdio.h>
#include<stdlib.h>

#define MaxVertexNum 505  //最大顶点数设为100
#define INFINITY 65535    //∞设为双字节无符号整数的最大值65535

typedef int Vertex;  //用顶点下标表示顶点，为整型
typedef int WeightType;  //边的权值设为整型
typedef int CostType;    //边的权值设为整型

/*边的定义*/
typedef struct ENode *PtrToENode;
struct ENode{
	Vertex V1,V2;  //有向边<V1,V2>
	WeightType Weight;  //公路长度
	CostType  Cost;     //收费额 
}; 
typedef PtrToENode Edge;

/*图结点的定义*/
typedef struct GNode *PtrToGNode;
struct GNode{
	int Nv;  //顶点数
	int Ne;  //边数
	WeightType G1[MaxVertexNum][MaxVertexNum];  //存储公路长度 
	CostType G2[MaxVertexNum][MaxVertexNum];    //存储收费额 
}; 
typedef PtrToGNode MGraph;  //以邻接矩阵存储的图类型

#define TRUE 1
#define FALSE 0

int S,D;  //源点，终点

MGraph BuildGraph();
void Dijkstra( MGraph Graph, Vertex S );

int main() 
{
	MGraph graph = BuildGraph();
	Dijkstra(graph,S);
	
	return 0;
}

MGraph CreateGraph(int VertexNum)
{/*初始化一个有VertexNum个顶点但没有边的图*/
	Vertex V,W;
	MGraph Graph;
	
	Graph = (MGraph)malloc(sizeof(struct GNode));  //建立图
	Graph->Nv = VertexNum;
	Graph->Ne = 0;
	/*初始化邻接矩阵*/
	//注意：这里默认顶点编号从0开始，到(Graph->Nv-1) 
	for(V=0; V<Graph->Nv; V++){
		for(W=0; W<Graph->Nv; W++){
			Graph->G1[V][W] = INFINITY;
			Graph->G2[V][W] = INFINITY;
		}
	}
	
	return Graph;
 } 
 
void InsertEdge(MGraph Graph,Edge E)
{
	/*插入边<V1,V2>*/
	Graph->G1[E->V1][E->V2] = E->Weight;
	Graph->G2[E->V1][E->V2] = E->Cost;
	//若是无向图，还要插入<V2,V1>
	Graph->G1[E->V2][E->V1] = E->Weight;
	Graph->G2[E->V2][E->V1] = E->Cost;
}

MGraph BuildGraph()
{
	MGraph Graph;
	Edge E;
	Vertex V;
	int Nv,i;
	
	scanf("%d",&Nv);  //读入顶点个数
	Graph = CreateGraph(Nv);  //初始化有Nv个顶点但没有边的图
	
	scanf("%d %d %d",&(Graph->Ne),&S,&D);  //读入边数、源点、终点 
	if( Graph->Ne != 0){  //如果有边 
		E = (Edge)malloc(sizeof(struct ENode));
		/*读入边，格式为"起点 终点 权重1 权重2"，插入邻接矩阵*/
		for(i=0; i<Graph->Ne; i++){
			scanf("%d %d %d %d",&E->V1,&E->V2,&E->Weight,&E->Cost);
			InsertEdge(Graph,E);
		} 
	} 

	return Graph;
}

/* 邻接矩阵存储 - 有权图的单源最短路算法 */
#define ERROR -1
Vertex FindMinDist( MGraph Graph, int dist[], int collected[] )
{ /* 返回未被收录顶点中dist最小者 */
    Vertex MinV, V;
    int MinDist = INFINITY;
 
    for (V=0; V<Graph->Nv; V++) {
        if ( collected[V]==FALSE && dist[V]<MinDist) {
            /* 若V未被收录，且dist[V]更小 */
            MinDist = dist[V]; /* 更新最小距离 */
            MinV = V; /* 更新对应顶点 */
        }
    }
    if (MinDist < INFINITY) /* 若找到最小dist */
        return MinV; /* 返回对应的顶点下标 */
    else 
		return ERROR;  /* 若这样的顶点不存在，返回错误标记 */
}
 
void Dijkstra( MGraph Graph, Vertex S )
{
    int collected[MaxVertexNum];          //每个城市结点是否被收录的标志  =FALSE未被收录 
    int dist[MaxVertexNum] = {INFINITY};  //存储每个城市结点到源点的最短路径长度 
	int path[MaxVertexNum] = {-1};        //存储每个城市结点到源点的最短路径
	int cost[MaxVertexNum] = {INFINITY};  //存储每个城市结点到源点的最短收费额 
    Vertex V, W;
 
    /* 初始化：此处默认邻接矩阵中不存在的边用INFINITY表示 */
    /*对于S的邻接点V可以确定S到其的最短路径就是S->V*/
    for ( V=0; V<Graph->Nv; V++ ) {
        dist[V] = Graph->G1[S][V];
        cost[V] = Graph->G2[S][V];
        if ( dist[V] < INFINITY )
            path[V] = S;
        else
            path[V] = -1;
        collected[V] = FALSE;
    }
    /* 先将起点收入集合 */
    dist[S] = 0;
    collected[S] = TRUE;
 
    while (1) {
        /* V = 未被收录顶点中dist最小者 */
        V = FindMinDist( Graph, dist, collected );
        if ( V == ERROR ) /* 若这样的V不存在 */
            break;      /* 算法结束 */
        collected[V] = TRUE;  /* 收录V */
        for( W=0; W<Graph->Nv; W++ ) /* 对图中的每个顶点W */
            /* 若W是V的邻接点并且未被收录 */
            if ( collected[W] == FALSE && Graph->G1[V][W] < INFINITY ) {                
                /* 若收录V使得dist[W]变小 */
                if ( dist[V]+Graph->G1[V][W] < dist[W] ) {
                    dist[W] = dist[V]+Graph->G1[V][W]; /* 更新dist[W] */
                    path[W] = V; /* 更新S到W的路径 */
                    cost[W] = cost[V]+Graph->G2[V][W];  /* 更新cost[W] */
                }else if(dist[V]+Graph->G1[V][W] == dist[W]){
                	/* 若收录V使得dist[W]不变，即有等长路径 */
                	if(cost[V]+Graph->G2[V][W] < cost[W]){
                		path[W] = V; /* 更新S到W的路径 */
                    	cost[W] = cost[V]+Graph->G2[V][W];  /* 更新cost[W] */
					}
				}
            }
    }
    
    printf("%d %d\n",dist[D],cost[D]);
}