poj2251 Dungeon Master（B）

题意：你被困在三维空间中，给你高宽长和地图，问最少走几步才能走出迷宫 #是障碍不能走 .是空地可以走
思路：因为是求最少步数，显然是一道广搜的题目。用pair来存储坐标，然后用队列来进行广搜。

#include<cstdio>
#include<algorithm>
#include<cstring>
#include<iostream>
#include<queue>
using namespace std;
#define maxn 40
typedef pair<int,pair<int,int> >pii;//分别指的是z，x，y轴的坐标
#define P(a,b,c) make_pair(a,make_pair(b,c))//根据z，x，y三点制作一个pair

int vis[maxn][maxn][maxn];
char maps[maxn][maxn][maxn];//三维分别对应 z x y
int x,y,z;//三维坐标
int sx,sy,sz,ex,ey,ez;
int go[6][3]={{0,0,1},{0,0,-1},{1,0,0},{-1,0,0},{0,1,0},{0,-1,0}};//走的6个方向
int num[maxn][maxn][maxn];//记录到达每个点的最小步数
void bfs(int a,int b,int c)
{
    queue<pii>s;
    pii p;
    s.push(P(a,b,c));
    vis[c][a][b]=true;
    while(!s.empty())
    {
        p=s.front();
        s.pop();
        if(p.first==ex&&p.second.first==ey&&p.second.second==ez)
        {
            printf("Escaped in %d minute(s).\n",num[ez][ex][ey]);
            return;
        }
        for(int i=0;i<6;i++)//六个方向的试探
        {
            int fx=p.first+go[i][0];
            int fy=p.second.first+go[i][1];
            int fz=p.second.second+go[i][2];
            if(fx>=0&&fx<x&&fy>=0&&fy<y&&fz>=0&&fz<z)
            {   if(maps[fz][fx][fy]!='#'&&!vis[fz][fx][fy])
                {
                    num[fz][fx][fy]=num[p.second.second][p.first][p.second.first]+1;
                    vis[fz][fx][fy]=true;
                    s.push(P(fx,fy,fz));
                }
            }
        }
    }
    printf("Trapped!\n");
    return ;
}
int main()
{
   while(~scanf("%d%d%d",&z,&x,&y))
   {
        if(x==0&&y==0&&z==0)break;
        memset(vis,false,sizeof vis);
        memset(num,0,sizeof num);
        for(int i=0;i<z;i++)//输入 初始化
        {
            for(int j=0;j<x;j++)
            {
                scanf("%s",&maps[i][j]);
                for(int k=0;k<y;k++)
                {
                    if(maps[i][j][k]=='S')
                    {
                        sx=j,sy=k,sz=i;
                    }
                    else if(maps[i][j][k]=='E')
                    {
                        ex=j,ey=k,ez=i;
                    }
                }
            }
        }
        bfs(sx,sy,sz);
   }
    return 0;
}