Dungeon Master 地下城大师（BFS进阶）

#include<stdio.h>
#include<string.h>
#include<iostream>
#include<queue>
using namespace std;
struct node//定义三维坐标结构体 
{
    int z;
    int x;
    int y;
};
int dx[6]={0,-1,0,1,0,0},dy[6]={-1,0,1,0,0,0},dz[6]={0,0,0,0,-1,1};//六个方向的搜索 
bool vis[31][31][31];//vis数组记录是否走过，剪枝去重。 
char mp[31][31][31];
int d[31][31][31];//记录步数的三位数组。
int l,r,c,gx,gy,gz,sx,sy,sz;//g则是开始的坐标，S则是终止的坐标。
int bfs()
{
    queue<node>q;
    q.push({gz,gx,gy});
    vis[gz][gx][gy]=1;
    d[gz][gx][gy]=0;
    while(q.size())
    {
        node p=q.front();
        q.pop();
        if(p.x==sx&&p.y==sy&&p.z==sz)
        break;
        for(int i=0;i<6;i++)//六个方向搜寻 
        {
            int nx=p.x+dx[i];
            int ny=p.y+dy[i];
            int nz=p.z+dz[i];
            if(nx>=0&&nx<r&&nz>=0&&nz<l&&ny>=0&&ny<c&&!vis[nz][nx][ny]&&mp[nz][nx][ny]!=‘#‘)
            {
                q.push({nz,nx,ny});//如果满足就加入队列。
                vis[nz][nx][ny]=1;//标记此坐标来过。 
                d[nz][nx][ny]=d[p.z][p.x][p.y]+1;//步数加一。
                //printf("d:%d nx:%d ny:%d nz:%d\n",d[nz][nx][ny],nx,ny,nz);这个是我调试时用的 。 
            }
        }
    }
    return d[sz][sx][sy];//返回步数 。
}
int main(void)
{
    int sum;
    while(cin>>l>>r>>c)
    {
        memset(d,0,sizeof d);//初始化 
        memset(vis,0,sizeof vis);//初始化 
        if(l==0&&r==0&&c==0)
        break;
        for(int i=0;i<l;i++)
        {
            for(int j=0;j<r;j++)
            {
                for(int k=0;k<c;k++)
                {
                    cin>>mp[i][j][k];
                    if(mp[i][j][k]==‘S‘)//记录起点坐标。
                    {
                        gz=i;
                        gx=j;
                        gy=k;
                        mp[i][j][k]=‘.‘;
                    }
                    if(mp[i][j][k]==‘E‘)//记录终点坐标。
                    {
                        sz=i;
                        sx=j;
                        sy=k;
                        mp[i][j][k]=‘.‘;
                    }
                }
            }
            getchar();
        }
        sum=bfs();
        if(sum)
        printf("Escaped in %d minute(s).\n",sum);
        else
        printf("Trapped!\n");
    }
    return 0;
}