T1345 香甜的黄油（#Ⅲ- 4 - 2）

【题目描述】

农夫John发现做出全威斯康辛州最甜的黄油的方法：糖。把糖放在一片牧场上，他知道N（1≤N≤500）只奶牛会过来舔它，这样就能做出能卖好价钱的超甜黄油。当然，他将付出额外的费用在奶牛上。

农夫John很狡猾。像以前的巴甫洛夫，他知道他可以训练这些奶牛，让它们在听到铃声时去一个特定的牧场。他打算将糖放在那里然后下午发出铃声，以至他可以在晚上挤奶。

农夫John知道每只奶牛都在各自喜欢的牧场（一个牧场不一定只有一头牛）。给出各头牛在的牧场和牧场间的路线，找出使所有牛到达的路程和最短的牧场（他将把糖放在那）。

【输入】

第一行: 三个数：奶牛数N，牧场数P（2≤P≤800），牧场间道路数C(1≤C≤1450)。

第二行到第N+1行: 1到N头奶牛所在的牧场号。

第N+2行到第N+C+1行：每行有三个数：相连的牧场A、B，两牧场间距（1≤D≤255），当然，连接是双向的。

【输出】

一行输出奶牛必须行走的最小的距离和。

【输入样例】

【输出样例】

【源程序】

#include<iostream>
#include<cstdio>
#include<cstring>
#include<cmath>
#include<algorithm>
#include<string>
#include<cstdlib>
#include<queue>
#include<vector>
#include<set>
#define INF 0x3f3f3f3f
#define PI acos(-1.0)
#define N 10001
#define MOD 123
#define E 1e-6
using namespace std;
int n,p,c;
int g[N],head[N];
int vis[N],f[N],q[N];
int cnt;
struct node{
    int pre;
    int next;
    int w;
}a[N];
void SPFA(int s)
{
    int headd=1,tail=1;

    q[tail]=s;
    tail++;

    memset(vis,0,sizeof(vis));
    for(int i=1;i<=p;i++)
        f[i]=INF;

    f[s]=0;
    vis[s]=1;


    while(headd<tail)
    {
        int u=q[headd];
        for(int b=head[u];b;b=a[b].next)
        {
            int v=a[b].pre;
            int w=a[b].w;
            if(f[v]>f[u]+w)
            {
                f[v]=f[u]+w;
                if(vis[v]==0)
                {
                    q[tail]=v;
                    tail++;
                    vis[v]=1;
                }
            }
        }
        vis[u]=0;
        headd++;
    }
}
void add_edge(int x,int y,int w)
{
    cnt++;
    a[cnt].pre=y;
    a[cnt].w=w;
    a[cnt].next=head[x];
    head[x]=cnt;
}
int main()
{
    cin>>n>>p>>c;
    for(int i=1;i<=n;i++)
        cin>>g[i];
    for(int i=1;i<=c;i++)
    {
        int x,y,w;
        cin>>x>>y>>w;
        add_edge(x,y,w);
        add_edge(y,x,w);
    }

    int sum=0;
    int minn=INF;
    for(int i=1;i<=p;i++)
    {
        SPFA(i);
        sum=0;
        for(int j=1;j<=n;j++)
            sum+=f[g[j]];
        minn=min(sum,minn);
    }
    cout<<minn<<endl;
    return 0;
}