hdu 1240(三维bfs)

题目链接：http://acm.hdu.edu.cn/showproblem.php?pid=1240

思路：就是一个简单的bfs，但我搞了好久啊，有一个trick一直没注意到，然后第二组数据就一直过不了。。。

#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
#include<cmath>
using namespace std;
#define MAXN  17
char map[MAXN][MAXN][MAXN];
bool visited[MAXN][MAXN][MAXN];
int n,sx,sy,sz,ex,ey,ez,ans;
char str[11];
//up,down,forward,back,left,right;
int dir[6][3]={{0,0,1},{0,0,-1},{1,0,0},{-1,0,0},{0,-1,0},{0,1,0}};

struct Node{
    int x,y,z;
    int step;
};

bool bfs(){
    memset(visited,false,sizeof(visited));
    Node p,q;
    p.x=sx,p.y=sy,p.z=sz,p.step=0;
    visited[p.x][p.y][p.z]=true;
    queue<Node>Q;
    Q.push(p);
    while(!Q.empty()){
        p=Q.front();
        Q.pop();
        if(p.x==ex&&p.y==ey&&p.z==ez){
            ans=p.step;
            return true;
        }
        for(int i=0;i<6;i++){
            q.x=p.x+dir[i][0];
            q.y=p.y+dir[i][1];
            q.z=p.z+dir[i][2];
            q.step=p.step;
            if(q.x<0||q.x>=n||q.y<0||q.y>=n||q.z<0||q.z>=n)
                continue;
            if(visited[q.x][q.y][q.z]||map[q.x][q.y][q.z]=='X')
                continue;
            visited[q.x][q.y][q.z]=true;
            q.step=p.step+1;
            Q.push(q);
        }
    }
    return false;
}


int main(){
    while(~scanf("%s%d",str,&n)){
        for(int i=0;i<n;i++){
            for(int j=0;j<n;j++){
                scanf("%s",map[i][j]);
            }
        }
        scanf("%d%d%d",&sx,&sy,&sz);
        scanf("%d%d%d",&ex,&ey,&ez);
        scanf("%s",str);
        map[ex][ey][ez]='O';//这个一直没发现，然后第二组数据就一直过不了。。。
        if(bfs()){
            printf("%d %d\n",n,ans);
        }else 
            puts("NO ROUTE");
    }
    return 0;
}