旅游规划 (25分Flyod和Dijkstra详解)

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

输入格式:
输入说明：输入数据的第1行给出4个正整数N，M，小号，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

Floyd:

#include<stdio.h>
#include<stdlib.h>
#define MAX 1000

int matrix[MAX][MAX], cost[MAX][MAX];
int i, j, k, m, n;
int x, y, z, w, a, b;

void floyd(){
    for (k = 0; k < n; k++) {
		for (i = 0; i < n; i++) {
			for (j = 0; j < n; j++) {
				if (matrix[i][k] + matrix[k][j] < matrix[i][j]) {
					matrix[i][j] = matrix[i][k] + matrix[k][j];
                    cost[i][j] = cost[i][k] + cost[k][j];
                    //判断相反时是否也是最短路径
					if(matrix[i][n-k-1] + matrix[n-k-1][j] == matrix[i][j]){
                        //是最短路径再进而判断其花费与原来的谁多，多的要换成少的
                        if(cost[i][j] > cost[i][n-k-1] + cost[n-k-1][j]){
                            cost[i][j]=cost[i][n-k-1] + cost[n-k-1][j];
                        }
					}
				}
			}
		}
	}
}

int main() {

	scanf("%d%d%d%d", &n, &m, &a, &b);
	for (i = 0; i < n; i++)
		for (j = 0; j < n; j++) {
			if (i != j) {
				matrix[i][j] = MAX;
				cost[i][j] = MAX;
			}
		}

	for (i = 0; i < m; i++) {
		scanf("%d%d%d%d", &x, &y, &z, &w);
		matrix[x][y] = z;
		matrix[y][x] = z;
		cost[x][y] = w;
		cost[y][x] = w;
	}
	floyd();
	printf("%d %d\n", matrix[a][b], cost[a][b]);
	return 0;
}

Dijkstra:

#include<stdio.h>
#include<stdlib.h>
#define MAXVEX 505
#define INFINITY  65535
void CreateGraph( );
void Dijkstra( int v);
int G[MAXVEX][MAXVEX][2],Nv,Ne;
int know[MAXVEX];        //know[]=1表示求得最短路径
int distance[MAXVEX];   //表示求的最短距离
int pay[MAXVEX];       //表示最少费用
int main()
{
    int s,d;
    scanf("%d %d %d %d",&Nv,&Ne,&s,&d);
    CreateGraph();
    Dijkstra(s);
    if( distance[d]<INFINITY ){
        printf("%d %d",distance[d],pay[d]);
    }
    return 0;
}
void CreateGraph(){
    //用邻接矩阵表示图
    int i,j;
    int v1,v2;
    int dn,f;  //dn表示距离，f表示费用
    for( i=0; i<Nv; i++){
        for( j=0; j<Nv; j++){
            G[i][j][0] = INFINITY;  //初始化
            G[i][j][1] = INFINITY;
        }
    }
    for( i=0; i<Ne; i++)  //注意这里是读入边{
        scanf("%d %d %d %d",&v1,&v2,&dn,&f);
        G[v1][v2][0] = G[v2][v1][0]=dn;
        G[v1][v2][1] = G[v2][v1][1]=f;
    }
}
void Dijkstra( int v)
{
    //求从v结点到其他各结点的最短距离
    int i,j,k;
    int min,cost;
    for( i=0; i<Nv; i++){
        know[i] =0;
        distance[i] =G[v][i][0];   //将与v点有连接的结点加上距离
        pay[i] =G[v][i][1];
    }
    know[v] = 1;
    distance[v] =0;   //V到V距离为0
    pay[v] = 0;
    for( i=1; i<Nv; i++){
        min = INFINITY;     //当前所知离v结点的最近距离
        for( j=0; j<Nv; j++){
            //寻找离v结点的最近距离
            if( !know[j] && distance[j]<min){
                k = j;
                min = distance[j];
                cost = pay[j];
            }
        }
        know[k] = 1;
        for( j=0; j<Nv; j++){
            //修正最短路径和距离
            if( !know[j] && (min+G[k][j][0]<distance[j])){
                distance[j] = min+G[k][j][0];
                pay[j] = cost + G[k][j][1];
            }
            else if( !know[j] && (min+G[k][j][0]==distance[j]) && (cost+G[k][j][1] < pay[j])){
                pay[j] = cost + G[k][j][1];  
            }
        }
    }
}