POJ_2251（初识广搜）

#include<cstdio>
#include<cstring>
#include<queue>
#include<algorithm>
using namespace std;
const int maxn = 35;
char mp[maxn][maxn][maxn];
bool vis[maxn][maxn][maxn];
int dis[6][3]={-1,0,0, 1,0,0, 0,-1,0, 0,0,-1, 0,0,1, 0,1,0};
int n,m,c;

struct Node{
	int x,y,z,step;
};

queue<Node> q;

int bfs(){
	while(!q.empty()){
		Node k,f;
		k=q.front();
		q.pop();
		if(mp[k.x][k.y][k.z]==‘E‘)
			return k.step;
		for(int i=0;i<6;i++){
			int xx=k.x+dis[i][0];
			int yy=k.y+dis[i][1];
			int zz=k.z+dis[i][2];
			if(xx>=0&&yy>=0&&zz>=0&&xx<n&&yy<m&&zz<c&&vis[xx][yy][zz]==0&&mp[xx][yy][zz]!=‘#‘){
				vis[xx][yy][zz]=1;
				f.x=xx; f.y=yy; f.z=zz;
				f.step=k.step+1;
				q.push(f);
			}
		}	
	}
	return 0;
}

int main(){
	
	while(scanf("%d %d %d",&n,&m,&c)==3&&n&&m&&c){
		memset(vis,0,sizeof(vis));
		while(!q.empty()) q.pop();
		for(int i=0;i<n;i++){
			for(int j=0;j<m;j++){
				scanf("%s",mp[i][j]);
				for(int k=0;k<c;k++){
					if(mp[i][j][k]==‘S‘){
						vis[i][j][k]=1;
						Node s;
						s.x=i; s.y=j; s.z=k; s.step=0;
						//vis[s.x][s.y][s.z]=1;
						q.push(s);
					}
				}
			}	
		}
		int ans;
		ans = bfs();
		if(ans!=0)
			printf("Escaped in %d minute(s).\n",ans);
		else
			printf("Trapped!\n");
	}
	return 0;
}