数据结构-图-弗洛伊德算法

做为一个资深驴友，小新有一张珍藏的自驾游线路图，图上详细的标注了全国各个城市之间的高速公路距离和公路收费情况，现在请你编写一个程序，找出一条出发地到目的地之间的最短路径，如果有多条路径最短，则输出过路费最少的一条路径。
Input
连续T组数据输入，每组输入数据的第一行给出四个正整数N,M，s，d，其中N(2 <= N <= 500)是城市数目，城市编号从0～N-1，M是城市间高速公路的条数，s是出发地的城市编号，d是目的地的城市编号；随后M行，每行给出一条高速公路的信息，表示城市1、城市2、高速公路长度、收费额，中间以空格间隔，数字均为整数且不超过500，输入数据均保证有解。

Output
在同一行中输出路径长度和收费总额，数据间用空格间隔。

Sample Input

1
4 5 0 3
0 1 1 20
1 3 2 30
0 3 4 10
0 2 2 20
2 3 1 20

Sample Output

3 40

该算法使用弗洛伊德算法，核心是离散化，适用于小数据，n<=1000，一般不常用该算法。首先将数写入，其次通过三层循环，将把原始数据替换为目标数据，注意中间指针要在第一层，因为如果在第二层，那么一旦找到第一个伪目标数据，真目标数据则会被忽略。

#include <iostream>
#include <algorithm>
#include <queue>
#include <cstring>
#include <stdio.h>
using namespace std;
#define INF 0x3f3f3f3f

struct node
{
    int h;
    int w;
} a[500][500];
int main()
{
    int t;
    cin>>t;
    while(t--)
    {
        int i, j, n, m, s, e;
        cin>>n>>m>>s>>e;
        for(i=0;i<=n;i++)
        {
            for(j=0;j<=n;j++)
            {
                if(i==j)
                {
                    a[i][j].w = 0;
                    a[i][j].h = 0;
                }
                else
                {
                    a[i][j].w = a[i][j].h = INF;
                }
            }
        }
        int u, v, hh, ww;
        while(m--)
        {
            cin>>u>>v>>hh>>ww;
            if(a[u][v].h > hh && a[u][v].w > ww)
            {
                a[u][v].h = a[v][u].h = hh;
                a[u][v].w = a[v][u].w = ww;
            }
        }
        int k;
        for(k = 0;k <= n;k++)
        {
            for(i = 0;i <= n;i++)
            {
                for(j = 0;j <= n;j++)
                {
                    if(a[i][j].h > a[i][k].h+a[k][j].h)
                    {
                        a[i][j].h = a[i][k].h+ a[k][j].h;
                        a[i][j].w = a[i][k].w+ a[k][j].w;
                    }
                    else if(a[i][j].h==a[i][k].h+a[k][j].h && a[i][j].w>a[i][k].w+a[k][j].w)
                    {
                        a[i][j].h = a[i][k].h+ a[k][j].h;
                        a[i][j].w = a[i][k].w+ a[k][j].w;
                    }
                }
            }
        }
        printf("%d %d\n", a[s][e].h, a[s][e].w);
    }
    return 0;
}