胜利大逃亡

算法：搜索

题目描述
Ignatius被魔王抓走了,有一天魔王出差去了,这可是Ignatius逃亡的好机会.

魔王住在一个城堡里,城堡是一个A*B*C的立方体,可以被表示成A个B*C的矩阵,刚开始Ignatius被关在(0,0,0)的位置,离开城堡的门在(A-1,B-1,C-1)的位置,现在知道魔王将在T分钟后回到城堡,Ignatius每分钟能从一个坐标走到相邻的六个坐标中的其中一个.现在给你城堡的地图,请你计算出Ignatius能否在魔王回来前离开城堡(只要走到出口就算离开城堡,如果走到出口的时候魔王刚好回来也算逃亡成功),如果可以请输出需要多少分钟才能离开,如果不能则输出-1.



输入
输入数据的第一行是一个正整数K,表明测试数据的数量.每组测试数据的第一行是四个正整数A,B,C和T(1<=A,B,C<=50,1<=T<=1000),它们分别代表城堡的大小和魔王回来的时间.然后是A块输入数据(先是第0块,然后是第1块,第2块......),每块输入数据有B行,每行有C个正整数,代表迷宫的布局,其中0代表路,1代表墙.(如果对输入描述不清楚,可以参考Sample Input中的迷宫描述,它表示的就是上图中的迷宫)

特别注意:本题的测试数据非常大,请使用scanf输入,我不能保证使用cin能不超时.在本OJ上请使用Visual C++提交.
输出
对于每组测试数据,如果Ignatius能够在魔王回来前离开城堡,那么请输出他最少需要多少分钟,否则输出-1.
样例输入
1
3 3 4 20
0 1 1 1
0 0 1 1
0 1 1 1
1 1 1 1
1 0 0 1
0 1 1 1
0 0 0 0
0 1 1 0
0 1 1 0
样例输出
11

代码：

   #include <iostream>
   #include <iomanip>
   #include <algorithm>
   #include <cstring>
   #include <string>
   #include <queue>
   #include <stdio.h>
   using namespace std;
   int a[55][55][55],n,m,k,s;
   int b[6][3]={1,0,0,-1,0,0,0,1,0,0,-1,0,0,0,1,0,0,-1};//这里必须这样写才可以，其他顺序会wrong
   struct dot
   {
   	 int x,y,z,step;
   };
   queue<dot>que;
   int bfs()
   {
   	  dot cur,loer;
   	  cur.x=0;cur.y=0;cur.z=0;
   	  cur.step=0;
   	  que.push(cur);
   	  a[0][0][0]=1;
   	  while(que.size())
   	  {
   	  	  loer=que.front();
   	  	  que.pop();
   	  	  if(loer.x==n-1&&loer.y==m-1&&loer.z==k-1&&loer.step<=s)
   	  	  return loer.step;
   	  	  for(int i=0;i<6;i++)
   	  	  {
   	  	  	  int dx=loer.x+b[i][0];
   	  	  	  int dy=loer.y+b[i][1];
   	  	  	  int dz=loer.z+b[i][2];
   	  	  	  if(dx>=0&&dx<n&&dy>=0&&dy<m&&dz>=0&&dz<k&&a[dx][dy][dz]==0)
   	  	  	  {   
				  a[dx][dy][dz]=1;
   	  	  	  	  cur.x=dx;
   	  	  	  	  cur.y=dy;
   	  	  	  	  cur.z=dz;
   	  	  	  	  cur.step=loer.step+1;
   	  	  	  	  if(abs(n-dx+1)+abs(m-dy+1)+abs(k-dz+1)+cur.step>s)
						   continue; 
   	  	  	  	  que.push(cur);
			  }
		  }
	  }
	  return -1;
   }
   int main()
   {
   	  int i,j,p,q;
   	  scanf("%d",&p);
   	  while(p--)
   	  {
   	  	 scanf("%d%d%d%d",&n,&m,&k,&s);
   	  	 memset(a,0,sizeof(a));  
   	  	 for(i=0;i<n;i++)
   	  	 {
   	  	 	for(j=0;j<m;j++)
   	  	 	for(q=0;q<k;q++)
   	  	 	scanf("%d",&a[i][j][q]);
	  }
		  cout<<bfs()<<endl;
	  }
	  return 0;
   }