poj 3767 I Wanna Go Home

题意：n个点(从1-n编号)

m条边

下面m行 u v dis 表示双向边u v的距离

n个点表示 每个点被势力1或2占据

这里保证1 城市由势力1占据，2城市由势力2占据

思路：

求2遍spfa()

从1城市开始求所有 走到所有都是势力1的城市的距离，存在d[1]数组中，d[1][ i ] 表示经过 i 城市任意都是势力1占领的城市的点能到达 1点的最短距离

再由2城市跑一遍spfa ，求出 2势力占领的 距离2 城市最近的距离

最后ans=Min(ans, d[ 1 ] [ i ] + d[ 2 ] [ j ] + dis[ i ][ j ] )

#include<stdio.h>
#include<string.h>
#include<queue>
using namespace std;
#define N 605
#define INF 99999999

using namespace std;

struct node{
	int to,nex;
}edge[20005];

int edgenum,head[N];

int dis[N][N],n,ans;
int zhen[N],d[3][N];
bool inq[N];
inline int Min(int a,int b){return a>b?b:a;}
void addedge(int u,int v){
	edge[edgenum].to=v;
	edge[edgenum].nex=head[u];
	head[u]=edgenum++;
}
void spfa(int x,int other){
	for(int i=1;i<=n;i++)d[x][i]=INF;
	queue<int>q;while(!q.empty())q.pop();
	memset(inq,0,sizeof(inq));

	d[x][x]=0;
	q.push(x); inq[x]=1;

	while(!q.empty())
	{
		int u=q.front();q.pop(); inq[u]=0;
		for(int i=head[u];i!=-1;i=edge[i].nex)
		{
			int v=edge[i].to;
			if(zhen[u]==zhen[v] && d[x][v]>d[x][u]+dis[u][v] )
			{
				d[x][v]=d[x][u]+dis[u][v];
				if(!inq[v] && v!=other)
					inq[v]=true, q.push(v);
			}
		}
	}
}

int main(){
	int i,m;
	while(scanf("%d",&n),n)
	{
		scanf("%d",&m);
		memset(head,-1,sizeof(head)); memset(dis,-1,sizeof(dis));
		edgenum=0;

		while(m--){
			int u,v,dd;
			scanf("%d%d%d",&u,&v,&dd);
			if(dis[u][v]==-1)//去重边
				addedge(u,v),addedge(v,u),dis[u][v]=dis[v][u]=dd;
			else dis[u][v]=dis[v][u]=Min(dis[u][v],dd);
		}
		for(i=1;i<=n;i++)scanf("%d",&zhen[i]);

		ans=INF;
		spfa(1,2);
		spfa(2,1);
		for(i=1;i<=n;i++)
			for(int j=1;j<=n;j++)
				if(zhen[i]!=zhen[j] && dis[i][j]!=-1)
					ans=Min(ans,d[1][i]+d[2][j]+dis[i][j]);

			if(ans>INF/2)ans=-1;
			printf("%d\n",ans);
	}
	return 0;
}