香甜的黄油

Problem Description
农夫John发现做出全威斯康辛州最甜的黄油的方法：糖。把糖放在一片牧场上，他知道N(1<=N<=500)头奶牛会过来舔它，这样就能做出能卖好价钱的超甜黄油。当然，他将付出额外的费用在奶牛上。
农夫John很聪明。像以前的巴普洛夫，他知道他可以训练这些奶牛，让它们在听到铃声时去一个特定的牧场。他打算将糖放在那里然后下午发出铃声，以至他可以在晚上挤奶。
农夫John知道每头奶牛都在各自喜欢的牧场(一个牧场不一定只有一头牛)。给出各头牛在的牧场和牧场间的路线，找出使所有牛到达的路程和最短的牧场(他将把糖放在那)。
Input
输入有多组数据，每组数据第1行有三个数：奶牛数N，牧场数P(2<=P<=800)，牧场间道路数C(1<=C<=1450)。
第2行到第N+1行：1到N头奶牛所在的牧场号。
第N+2行到第N+C+1行：每行有三个数：相连的牧场A、B，两牧场间距(1<=D<=255)，当然，连接是双向的。
Output
对于每组数据输出一行，奶牛必须行走的最小的距离和。
Sample Input
3 4 5
2
3
4
1 2 1
1 3 5
2 3 7
2 4 3
3 4 5
Sample Output

8

#include<iostream>#include<stdio.h>#include<cstring>#include<queue>#define INF 0x7fffffff#define Max 808using namespace std;int n,p,c;int map[Max][Max]={0},niu[Max],dis[Max],v[Max][Max],v_edge[Max];void spfa(int x){for(int i=1;i<=p;i++)dis[i]=INF;queue<int> q;bool vis[Max];memset(vis,0,sizeof(vis));q.push(x);vis[x]=true;dis[x]=0;for(;!q.empty();q.pop()){int k=q.front();for(int i=0;i<v_edge[k];i++){int t=v[k][i];if(map[k][t]>0&& dis[t]>dis[k]+map[k][t]){dis[t]=dis[k]+map[k][t];if(!vis[t]){q.push(t);vis[t]=true;}}}vis[k]=false;}}void work(){int tot=0,my_min=INF,i,j;for(i=1;i<=p;i++){spfa(i);tot=0;for(j=1;j<=n;j++)if(dis[niu[j]]<INF) {tot+=dis[niu[j]];}if(my_min>tot) my_min=tot;}printf("%d\n",my_min);}int main(){//freopen("b.txt","r",stdin);while(scanf("%d %d %d",&n,&p,&c)==3){memset(map,0,sizeof(map));memset(v,0,sizeof(v));memset(v_edge,0,sizeof(v_edge));int i;for(i=1;i<=n;i++) scanf("%d",&niu[i]);int x,y,z;for(i=1;i<=c;i++){scanf("%d %d %d",&x,&y,&z);map[x][y]=map[y][x]=z;v[x][v_edge[x]++]=y;v[y][v_edge[y]++]=x;}work();}return 0;}