水题堆2.G - 一个人的旅行 （dijkstra算法

#include <stdio.h>
#include <stdlib.h>
#define MAX 1001
#define INF 1000000
int s[1001],d[1001],cost[1001][1001],u[1001],answer[1001],use[1001],t,T,S,D,n;
int min(int a,int b)
{
return a<b?a:b;
}
int max(int a,int b)
{
return a>b?a:b;
}
void f(int n,int cost[1001][1001])
{
int i;
for(i=0;i<=1000;i++){//Ö÷Ìå
u[i]=INF;
}
memset(use,0,sizeof(use));
for(i=0;i<=n;i++){
u[i]=cost[0][i];
// printf("%d,\n",u[i]);
//printf("%d,,\n",n);
}
u[0]=0;
//use[0]=1;
while(1){
int x=-1,y;
for(y=1;y<=n;y++){
if(!use[y]&&(x==-1||u[y]<u[x]))x=y;
}
if(x==-1)break;
use[x]=1;
for(y=1;y<=n;y++){
u[y]=min(u[y],u[x]+cost[x][y]);
//printf("%d,,\n",u[y]);
}
}
int ans=INF;
for(i=0;i<=D-1;i++){
ans=min(ans,u[d[i]]);//之前写成了1--D所以出来的答案是零
// printf("%d\n",d[i]);
}
printf("%d\n",ans);
}
int main()
{
int i,j,a,b;
while(scanf("%d%d%d",&T,&S,&D)!=EOF){
for(i=0;i<=1000;i++){
for(j=0;j<=1000;j++){
cost[i][j]=INF;
}
cost[i][i]=0;
}
int n=0;
for(i=1;i<=T;i++){
scanf("%d%d%d",&a,&b,&t);
n=max(max(n,a),b);
cost[a][b]=cost[b][a]=t;
//n=max(n,max(a,b));
}
//printf("%d,,",n);
for(i=0;i<S;i++){
scanf("%d",&s[i]);
cost[0][s[i]]=cost[s[i]][0]=0;
}
for(i=0;i<D;i++)scanf("%d",&d[i]);
f(n,cost);

}
return 0;
}

先初始化起点与其余各点之间的距离，若无直接的联系先初始化为无穷大。
寻找与起点距离最近的点j并标记，将原本的距离d[i]与d[j]+cost[j][i]比较取最小值，在遍历所有点后，再次寻找下一个未被标记过的点，重复这个过程