floyd算法

7-15 旅游规划（25 分）

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

输入格式:

输入说明：输入数据的第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

#include<iostream>
#include<cstdio>
#include<cstring>
#include<cmath>
#include<algorithm>
#include"vector"
#include<stack>
#include "queue"
#define N 0xfffff
using namespace std;
int p[505][505];
int pp[505][505];
int main()
{
    int a,b,c,d;
    scanf("%d%d%d%d",&a,&b,&c,&d);
    for (int i=0; i<a; i++) {
        for (int j=0; j<a; j++) {
            if (i==j) {
                p[i][j]=0;
            }
            else
                p[i][j]=p[j][i]=N;
        }
    }
    int w,e,r,t;
    for (int i=1; i<=b; i++) {
        scanf("%d%d%d%d",&w,&e,&r,&t);
        p[w][e]=p[e][w]=r;
        pp[w][e]=pp[e][w]=t;
    }
    for (int k=0; k<a; k++) {
        for (int i=0; i<a; i++) {
            for (int j=0; j<a; j++) {
                if (p[i][j]>=p[i][k]+p[k][j]) {
                    if (p[i][j]>p[i][k]+p[k][j]) {
                        p[i][j]=p[i][k]+p[k][j];
                        pp[i][j]=pp[i][k]+pp[k][j];
                    }
                    else if((p[i][j]=p[i][k]+p[k][j])&&(pp[i][j]>pp[i][k]+pp[k][j]))
                    {
                        pp[i][j]=pp[i][k]+pp[k][j];
                    }
                }
            }
        }
    }
    printf("%d %d\n",p[c][d],pp[c][d]);
    return 0;
}