旅游规划——Dijkstra算法

案例6-1.5 旅游规划 (25分)

题目要求是找出最短的路径，最短路径不唯一就选择最便宜的路径

输入格式:

输入说明：输入数据的第1行给出4个正整数N、M、S、D，其中N（2≤N≤500）是城市的个数，顺便假设城市的编号为0~(N−1)；M是高速公路的条数；S是出发地的城市编号；D是目的地的城市编号。随后的M行中，每行给出一条高速公路的信息，分别是：城市1、城市2、高速公路长度、收费额，中间用空格分开，数字均为整数且不超过500。输入保证解的存在。

输出格式:

在一行里输出路径的长度和收费总额，数字间以空格分隔，输出结尾不能有多余空格。

运行截图

Dijkstra算法求有权图单源最短路径问题；
tips：单源最短路径问题：从某固定源点出发，求其到所有顶点的最短路径。
代码

#include<iostream>
#include<cstdlib>
#include <cstring>
using namespace std;
#define MaxNum 502
#define INF (0x3f3f3f3f)
int visit[MaxNum];
int dist[MaxNum];
int tolls[MaxNum];
typedef struct GNode *PtrGNode;
struct GNode{
    int Nv,Ne;
    int G[MaxNum][MaxNum];
    int toll[MaxNum][MaxNum];
};
typedef PtrGNode MGraph;
MGraph Init(MGraph G){
    for (int i = 0; i < G->Nv; ++i) {
        visit[i]=0;
        dist[i]=INF;
        tolls[i]=0;
        for (int j = 0; j < G->Nv; ++j) {
            G->G[i][i]=0;
            G->toll[i][i]=0;
            if(j!=i){
                G->G[i][j]=INF;
                G->toll[i][j]=INF;
            }
        }
    }
    return G;
}
void Dijkstra(MGraph Graph,int s,int d){
    int i,j,w;
    for ( i = 0; i < Graph->Nv; ++i) {
        int v=-1;
        for (j = 0; j < Graph->Nv; ++j) {
            if(!visit[j]&&(v==-1||dist[j]<dist[v]))
                v=j;
        }
        visit[v]=1;
        for (j=0;j<Graph->Nv;j++){
            if(v==j)continue;
            if(dist[v]+Graph->G[v][j]==dist[j]){
                if(tolls[j]>tolls[v]+Graph->toll[v][j])
                    tolls[j]=tolls[v]+Graph->toll[v][j];
            } else if(dist[v]+Graph->G[v][j]<dist[j]){
                dist[j]=dist[v]+Graph->G[v][j];
                tolls[j]=tolls[v]+Graph->toll[v][j];
            }
        }
    }
}
int main(){
    int n,m,s,d;
    int x,y,weight,toll;
    cin>>n>>m>>s>>d;
    auto Graph=(MGraph)malloc(sizeof(struct GNode));
    Graph->Nv=n;
    Graph->Ne=m;
    Graph=Init(Graph);
    while(m--){
        cin>>x>>y>>weight>>toll;
        Graph->G[x][y]=weight;
        Graph->G[y][x]=weight;
        Graph->toll[x][y]=toll;
        Graph->toll[y][x]=toll;
    }
    dist[s]=0;
    Dijkstra(Graph,s,d);
    cout<<dist[d]<<' '<<tolls[d];
    return 0;
}