7-9 旅游规划 (25 分)--SPFA算法

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

输入格式:

输入说明：输入数据的第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<bits/stdc++.h>
using namespace std;
int inf=0x3f3f3f3f;
int main(){
    int n,m,s,d;
    cin>>n>>m>>s>>d;
    int road[n][n];
    int price[n][n];
    fill(road[0],road[0]+n*n,inf);
    fill(price[0],price[0]+n*n,inf);
    int a,b,c,x;
    for(int i=0;i<m;i++){
        cin>>a>>b>>c>>x;
        road[a][b]=c;
        road[b][a]=c;
        price[a][b]=x;
        price[b][a]=x;
    }
    for(int i=0;i<n;i++){
        road[i][i]=0;
        price[i][i]=0;
    }
    int dist[n];
    fill(dist,dist+n,inf);
    queue<int>q;
    bool inq[n]={0};
    q.push(s);
    int cost[n];
    fill(cost,cost+n,inf);
    cost[s]=0;
    inq[s]=1;
    dist[s]=0;
    while(q.size()!=0){
        int v=q.front();
        q.pop();
        inq[v]=0;
        for(int i=0;i<n;i++){
            if(road[v][i]!=inf){
                if(dist[v]+road[v][i]<dist[i]){
                    dist[i]=dist[v]+road[v][i];
                    cost[i]=cost[v]+price[v][i];
                    if(inq[i]==0){
                        q.push(i);
                        inq[i]=1;
                    }
                }else if(cost[v]+price[v][i]<cost[i]&&dist[v]+road[v][i]==dist[i]){
                    cost[i]=cost[v]+price[v][i];
                }
            }
        }
    }
    cout<<dist[d]<<' '<<cost[d]<<endl;
    return 0;
}