uva10047

利用四维数组vis[][][][]标志 行  列   颜色   方向  bfs就行了

#include<stdio.h>  
#include<string.h>
#include<ctype.h>
#include<stdlib.h>
#include<math.h>
int N,M,vis[30][30][6][5];//行 列 颜色 方向
int q[30000][4],dx[]={-1,0,1,0},dy[]={0,1,0,-1};//北 东 南 西
char a[30][30];
int bfs(int x,int y)
{
	int i,z,k,nx,ny,nz,nk,rear,front;
	vis[x][y][1][0]=1;
	rear=front=0;
	q[rear][0]=x;
	q[rear][1]=y;
	q[rear][2]=1;
	q[rear++][3]=0;
	while(rear>front)
	{		
		x=q[front][0];
		y=q[front][1];
		z=q[front][2];
		k=q[front++][3];
		for(i=-1;i<2;i++)
		{
			if(i==0)
			{
				nx=x+dx[k];
				ny=y+dy[k];
				nz=z+1;
				nk=k;
				if(nz>5)
					nz=1;
			}
			else
			{
				nx=x;ny=y;nz=z;
				nk=k+i;
				if(nk<0)
					nk=3;
				else if(nk>3)
					nk=0;
			}
			if(nx>=0&&nx<M &&ny>=0&&ny<N&& a[nx][ny]!='#'&&!vis[nx][ny][nz][nk])
			{
				if(a[nx][ny]=='T'&&nz==1)  return vis[x][y][z][k];
				vis[nx][ny][nz][nk]=vis[x][y][z][k]+1;
				q[rear][0]=nx;
				q[rear][1]=ny;
				q[rear][2]=nz;
				q[rear++][3]=nk;
			}
		}
	}
	return 0;
}
main()
{
	int i,j,count=1,min;
	//freopen("D:\\ppp.txt","r",stdin);
	while(scanf("%d%d",&M,&N)&&M+N)
	{
		getchar();
		memset(vis,0,sizeof(vis));
		for(i=0;i<M;i++)
			gets(a[i]);
		for(i=0;i<M;i++)
		{
			for(j=0;j<N;j++)
				if(a[i][j]=='S')
					min=bfs(i,j);
		}
		if(count!=1) printf("\n");
		if(min)
			printf("Case #%d\nminimum time = %d sec\n",count++,min);
		else printf("Case #%d\ndestination not reachable\n",count++);
	}
}