数据结构实验之图论七：驴友计划（Foldy算法）

数据结构实验之图论七：驴友计划
Time Limit: 1000 ms Memory Limit: 65536 KiB

Problem Description
做为一个资深驴友，小新有一张珍藏的自驾游线路图，图上详细的标注了全国各个城市之间的高速公路距离和公路收费情况，现在请你编写一个程序，找出一条出发地到目的地之间的最短路径，如果有多条路径最短，则输出过路费最少的一条路径。
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
Hint

Source
xam

由于此题节点数较少(n<500)，故可使用Foldy算法求解（时间复杂度为O(n³)）

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#define inf 0x3f3f3f3f

struct node
{
    int w; //路径长度
    int f; //费用
}e[550][550];
int main()
{
    int T,n,m,s,d,i,j,k,t1,t2,t3,t4;
    scanf("%d",&T);
    while(T--)
    {
        memset(e,0,sizeof(e));
        scanf("%d%d%d%d",&n,&m,&s,&d);
        for(i=0;i<n;i++) //初始化路径长度
            for(j=0;j<n;j++)
        {
            if(i==j)
                e[i][j].w=0;
            else
                e[i][j].w=inf;
        }
        while(m--)
        {
            scanf("%d%d%d%d",&t1,&t2,&t3,&t4);
            e[t1][t2].w=t3;
            e[t2][t1].w=t3;
            e[t1][t2].f=t4;
            e[t2][t1].f=t4;
        }
        for(k=0;k<n;k++)  //Folyd算法
            for(i=0;i<n;i++)
            for(j=0;j<n;j++)
        {
            if(e[i][j].w>e[i][k].w+e[k][j].w)
            {
                e[i][j].w=e[i][k].w+e[k][j].w;
                    e[i][j].f=e[i][k].f+e[k][j].f;
            }
            if(e[i][j].w==e[i][k].w+e[k][j].w) //路径长度相等，费用选择小的
            {
                if(e[i][j].f>e[i][k].f+e[k][j].f)
                    e[i][j].f=e[i][k].f+e[k][j].f;
            }
        }
        printf("%d %d\n",e[s][d].w,e[s][d].f);
    }
    return 0;
}