Dijkstra算法-城市间紧急救援

/*
作为一个城市的应急救援队伍的负责人，你有一张特殊的全国地图。在地图上显示有多个分散的城市和一些连接城市的快速道路。每个城市的救援队数量和每一条连接两个城市的快速道路长度都标在地图上。当其他城市有紧急求助电话给你的时候，你的任务是带领你的救援队尽快赶往事发地，同时，一路上召集尽可能多的救援队。
输入格式:

输入第一行给出4个正整数NN、MM、SS、DD，其中NN（2\le N\le 5002≤N≤500）是城市的个数，顺便假设城市的编号为0 ~ (N-1)(N?1)；MM是快速道路的条数；SS是出发地的城市编号；DD是目的地的城市编号。
第二行给出NN个正整数，其中第ii个数是第ii个城市的救援队的数目，数字间以空格分隔。随后的MM行中，每行给出一条快速道路的信息，分别是：城市1、城市2、快速道路的长度，中间用空格分开，数字均为整数且不超过500。输入保证救援可行且最优解唯一。
输出格式:

第一行输出最短路径的条数和能够召集的最多的救援队数量。第二行输出从SS到DD的路径中经过的城市编号。数字间以空格分隔，输出结尾不能有多余空格。
输入样例:

4 5 0 3
20 30 40 10
0 1 1
1 3 2
0 3 3
0 2 2
2 3 2
输出样例:

2 60
0 1 3
*/

#include<stdio.h>
#include <stdlib.h>
#include <string.h>
int main(){

int n,m,s,d;
scanf("%d",&n);scanf("%d",&m);scanf("%d",&s);scanf("%d",&d);
int G

;
int num
;
int max
;
int pathnum
;
int INF = 100000;
int D
;//出发点 经过 选定点 到 当前[待定集合中的顶点] 的最短路
int final
;
char str[500][500];

for(int i=0;i<n;i++){
final[i] = 0;
}

for(int i=0;i<n;i++){
scanf("%d",&num[i]);
}
for(int a=0;a<n;a++){
for(int b=0;b<n;b++){
G[a][b] = INF;
G[b][a] = INF;
}
}
for(int i=0;i<m;i++){
int a,b,c;
scanf("%d",&a);scanf("%d",&b);scanf("%d",&c);
G[a][b] = c; G[b][a] = c;
}
//先求最短路径
//初始化
final[s] = 1;D[s] = 0;
for(int v=0;v<n;v++){
D[v] = G[s][v];
if(D[v]<INF){
max[v] = num[v] + num[s];
pathnum[v] = 1;
//路径初始化
char tem[10];
sprintf(tem,"%d",s);
strcat(str[v],tem);
strcat(str[v]," ");
sprintf(tem,"%d",v);
strcat(str[v],tem);
}
}
for(int i=1;i<n;i++){

int min = INF,v;
for(int w=0;w<n;w++)
if(final[w]==0&&D[w]<min){//找到最短点
v = w;min = D[w];
}

final[v] = 1;//并入
for(int w=0;w<n;w++){ //更新
//printf("%d  %d  %d  %d-----\n",final[w],min,G[v][w],D[w]);
if(final[w]==0&&(min+G[v][w]==D[w])){//相等的时候求一下有多少条最短路径
pathnum[w] = pathnum[v] + pathnum[w];
if(max[w]<max[v]+num[w]){
max[w] = max[v] + num[w];
//更改路径
char tem[10];
strcpy(str[w],str[v]);
strcat(str[w]," ");
sprintf(tem,"%d",w);
strcat(str[w],tem);

}

}
if(final[w]==0&&(min+G[v][w]<D[w])){
D[w] = min + G[v][w];
pathnum[w] = pathnum[v];
max[w] = max[v]+num[w];
//更改路径
char tem[10];
strcpy(str[w],str[v]);
strcat(str[w]," ");
sprintf(tem,"%d",w);
strcat(str[w],tem);
}
}
}
printf("%d ",pathnum[d]);
printf("%d\n",max[d]);
printf("%s",str[d]);
return 0;
}