C - Dungeon Master（bfs）

#include <cstdio>
#include<iostream>
#include<memory.h>
#include<queue>
#include<stack>
#include<algorithm>
#include<cmath>
#include<vector>
#include<cstdlib>
#include<iterator>
#include<cstring>

using namespace std;

int dd[6][3]={{1,0,0},{-1,0,0},{0,1,0},{0,-1,0},{0,0,1},{0,0,-1}};//六个步骤，分别代表六个方向。
int l,r,c;//l为地牢高度，r和c分别代表行和列。
char a[32][32][32];//地牢
bool biao[32][32][32];//辅助数组，判断某点是否被访问过。
struct node
{
	int x,y,z,step;//坐标。
	 //所花步数。
};/*
int start_x,start_y,start_z;//起点位置。
int end_x,end_y,end_z;//终点位置。*/
int start_x,start_y,start_z;
int end_x,end_y,end_z;
//int i,j,k;//循环控制变量。
bool check(int x,int y,int z)
{
/*	if(x<0||x>=l||y<0||y>=r||z<0||z>=c)//判断该点是否越界
	return true;
	else if(visited[x][y][z])//判断该点有没有走过。
	return true;
	else if(dungeon[x][y][z]=='#')// 判断是否被岩石挡住了
	return true;
	return false;*/
	
	if(x<0||x>=l||y<0||y>=r||z<0||z>=c||a[x][y][z]=='#'||biao[x][y][z]==1)
	return true;
	return false;
}
int bfs()//因为bfs有返回值，所以要用  int，而不是void 
{
	queue<node>Q;    //创建队列，实现先进先出的需求
	node later,now;   //now每次存储队头元素,later临时变量
	now.x=start_x;now.y=start_y;now.z=start_z;
	now.step=0;         //起点步数初始值为0
	Q.push(now);       //将起点入队
	while(!Q.empty())
	{
		now=Q.front();
		if(now.x==end_x&&now.y==end_y&&now.z==end_z)
			return now.step;
				Q.pop();

		for(int i=0;i<6;i++)
		{
			//改变坐标。
			later.x=now.x+dd[i][0];
			later.y=now.y+dd[i][1];
			later.z=now.z+dd[i][2];
			//判断该点是否合法。
			if(check(later.x,later.y,later.z))
			continue;//非法。
			later.step=now.step+1;
			biao[later.x][later.y][later.z]=1;
			Q.push(later);
		}
	}
	return 0;//这里要返回零 
}
int main()
{
	while(cin>>l>>r>>c&&l&&r&&c)
	{
		//if(l==0&&r==0&&c==0)break;
		for(int i=0;i<l;i++)
		{
			for(int j=0;j<r;j++)
			{
				cin>>a[i][j];
				for(int k=0;k<c;k++)
				{
					if(a[i][j][k]=='S')//保存入口坐标。
					{
						start_x=i;
						start_y=j;
						start_z=k;
					}
					else if(a[i][j][k]=='E')//保存出口坐标
					{
						end_x=i;
						end_y=j;
						end_z=k;
					}
				}
			}
		}
		memset(biao,0,sizeof(biao));//初始化标记数组，不能在开头定义那里初始化
		int result=bfs();
		if(result)
		{
			cout<<"Escaped in "<<result<<" minute(s)."<<endl;
		}
		else cout<<"Trapped!"<<endl;
	}
	return 0;
}