三维广搜 PKU2225||ZJU1438

//注意输入的是列、行、层。//HDU1240
#include
#include
#include
#include
#include
#include
#include
using namespace std;
#define inf 10000000
char map[11][11][11];
int n;
int dir[6][3]={{0,0,1},{0,0,-1},{0,-1,0},{0,1,0},{1,0,0},{-1,0,0}};
int fx[6]={1,-1,0,0,0,0},fy[6]={0,0,1,-1,0,0},fz[6]={0,0,0,0,-1,1};
int visit[11][11][11];
struct node
{
   int x,y,z,step;
};
int pd(int x,int y,int z)
{
   if(x>=0&&x=0&&y=0&&z
        &&visit[x][y][z]==0&&map[x][y][z]=='O') 
        return 1; 
    return 0; 
}
int bfs(int a,int b,int c,int d,int e,int f)//广度优先搜索
{
        int dx,dy,dz,i;
  queueq;
  memset(visit,0,sizeof(visit));
        node front,rear;
        front.x=a,front.y=b,front.z=c,front.step=0;
        q.push(front);
        visit[a][b][c]=1;
  if(a==d&&b==e&&c==f)
  {
      return front.step;
  }
        while(!q.empty())//判断队列是否为空
       {
               front=q.front();//队首元素出队
              q.pop();
              for(i=0;i<6;i++)
              {
                   dx=front.x+dir[i][0];
       dy=front.y+dir[i][1];
       dz=front.z +dir[i][2];
                   if(pd(dx,dy,dz))//判断是否在图中且有无访问过
                   {
                            visit[dx][dy][dz]=1;//标记当前点已访问过
                            if(dx==d&&dy==e&&dz==f)//判断当前点是否为终点
       {
                                     return front.step+1;
       }
                            rear.x=dx,rear.y=dy,rear.z=dz,rear.step=front.step+1;//步数为父节点(起始点)步数加1
                            q.push(rear);
                  }
              }
      }
  return -1;
}
int main()
{
 char s1[10],s2[10];
 int a,b,c,d,e,f;
 while(~scanf("%s%d",s1,&n))
 {
   int i,j,k;
   for(i=0;i
    for(j=0;j
     for(k=0;k
     cin>>map[i][j][k];
   scanf("%d%d%d",&a,&b,&c);
   scanf("%d%d%d",&d,&e,&f);
   scanf("%s",s2);
   map[d][e][f]='O';
   int ans=bfs(c,b,a,f,e,d);//注意输入转换；
   if(ans!=-1)
    printf("%d %d\n",n,ans);
   else
    printf("NO ROUTE\n");
 }
return 0;
}