Uva532(三维搜索)

#include<stdio.h>
#include<string.h>
#include<iostream>
#include<queue> 
#include<algorithm>
#define N 33
using namespace std;
int f[N][N][N];
int x[6]={1,-1,0,0,0,0},y[6]={0,0,1,-1,0,0},z[6]={0,0,0,0,-1,1};
struct node
{
    int x,y,z,step;
};
int sx,sy,sz,ex,ey,ez;
int n,m,k;
int flag;
int bfs()
{
    queue<node>q;
    node in,out;
    in.x=sx,in.y=sy,in.z=sz;
    f[sx][sy][sz]=1;
    in.step=0;
    q.push(in);    
    while(!q.empty())
    {
        in=q.front();
        q.pop(); 
        if(in.x==ex&&in.y==ey&&in.z==ez)
        {
        flag=1;
        return in.step;
        }
        for(int i=0;i<6;i++)
        {
            out.x=in.x+x[i];
            out.y=in.y+y[i];
            out.z=in.z+z[i];
            out.step=in.step; 
            if(out.x>=0&&out.x<n&&out.y>=0&&out.y<m&&out.z>=0&&out.z<k&&!f[out.x][out.y][out.z])
            { 
            f[out.x][out.y][out.z]=1; 
            out.step++;   
            q.push(out); 
            } 
        }
    }
}
int main()
{
    while(scanf("%d%d%d",&k,&n,&m)!=EOF&&n&&m&&k)
    {
        flag=0;
        char s[100];
        memset(f,0,sizeof(f));
        for(int i=0;i<k;i++)
        {
            for(int j=0;j<n;j++)
            {
                scanf("%s",s);
                for(int l=0;l<m;l++)
                {
                    if(s[l]==‘S‘)
                    {
                    sx=j;
                    sy=l;
                    sz=i;
                    }
                    else if(s[l]==‘E‘)
                    {
                    ex=j;
                    ey=l;
                    ez=i;
                    }
                    else if(s[l]==‘#‘)
                    f[j][l][i]=1;
                }
            }
        }
        int ans=bfs();
        if(flag)
        printf("Escaped in %d minute(s).\n",ans);
        else
        printf("Trapped!\n");
    }
    return 0;
}