三维BFS Poj 2251

#include <iostream>
#include <cstdio>
#include <string>
#include <cstring>
#include <fstream>
#include <algorithm>
#include <cmath>
#include <queue>
#include <stack>
#include <vector>
#include <map>
#include <set>
#include <iomanip>

using namespace std;
#define maxn 205

int d[][]={{,,},{-,,},{,,},{,-,},{,,},{,,-}};
typedef struct point
{
    int x,y,z;
    int ans;
}point;

point p[maxn];
int Map[][][];
bool used[maxn][maxn][maxn];

int x1,x2,y2,z1,z2;
int you;//这里原本是想用y1的，但是在cmath这个函数中y1（y0，yn等）有自己的定义，发生了冲突（如果将cmath删掉，就可以定义了）
int BFS(int l,int n,int m)
{
    int ii,jj,zz;
    int i;
    queue<point>q;
    point temp1,temp2;
    temp1.x=x1;
    temp1.y=you;
    temp1.z=z1;
    temp1.ans=;
    q.push(temp1);
    memset(used, false, sizeof(used));
           used[z1][x1][you]=true;
           while(!q.empty()){
               temp1=q.front();
               q.pop();
               for(i=;i<;i++)
               {
                   ii=temp1.x+d[i][];
                   jj=temp1.y+d[i][];
                   zz=temp1.z+d[i][];
                   if(ii==x2 && jj==y2 && zz==z2)
                   {
                       return temp1.ans+;
                   }
                   if(zz>= && zz<l && ii>= && ii<n && jj>= && jj<m && Map[zz][ii][jj]== && used[zz][ii][jj]==false)
                   {
                       used[zz][ii][jj]=true;
                       temp2.x=ii;
                       temp2.y=jj;
                       temp2.z=zz;
                       temp2.ans=temp1.ans+;
                       q.push(temp2);
                   }
           }
               
     }
    return -;
}
int main()
{
        int l,m,n,i,j,k,key;
        char str[];
        while(cin>>l>>n>>m){
            if(l==&&n==&&m==){
                break;
            }
            memset(Map, , sizeof(Map));
            for(k=;k<l;k++){
                for(i=;i<n;i++){
                    scanf("%s",str);
                    for(j=;j<m;j++){
                        if(str[j]=='#')
                            Map[k][i][j]=;
                        else if(str[j]=='.')
                        {
                            Map[k][i][j]=;
                        }
                        else if(str[j]=='S')
                        {
                            z1=k;
                            x1=i;
                            you=j;
                        }
                        else
                        {
                            z2=k;
                            x2=i;
                            y2=j;
                        }
                    }
                }
            }
            key=BFS(l,n,m);
            if(key==-)
                cout<<"Trapped!"<<endl;
            else
                printf("Escaped in %d minute(s).\n",key);
        }
        return ;
}