【WA】题目1456：胜利大逃亡[BFS]

题目描述：

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代表墙。

输出：

对于每组测试数据,如果Ignatius能够在魔王回来前离开城堡,那么请输出他最少需要多少分钟,否则输出-1.

样例输入：

13 3 4 200 1 1 10 0 1 10 1 1 11 1 1 11 0 0 10 1 1 10 0 0 00 1 1 00 1 1 0 

样例输出：

11

代码：

#include <stdio.h>#include <queue>using namespace std;int go[][3] =  {    1,0,0,    -1,0,0,    0,1,0,    0,-1,0,    0,0,1,    0,0,-1};int matrix[51][51][51];bool mark[51][51][51];struct N {    int a;    int b;    int c;    int t;};queue<N> Q;int bfs(int a,int b,int c) {    while(!Q.empty()) {N tmp = Q.front();Q.pop();for(int i=0;i<6;i++) {    int x = tmp.a + go[i][0];    int y = tmp.b + go[i][1];    int z = tmp.c + go[i][2];    if(x>=a || y>=b || z>=c || x<0 || y<0 || z<0)continue;    if(matrix[x][y][z] == 1)continue;    if(mark[x][y][z] == true)continue;    tmp.a = x;    tmp.b = y;    tmp.c = z;    tmp.t = tmp.t + 1;    Q.push(tmp);    mark[x][y][z] = true;    if(x==a-1 && y==b-1 && z==c-1)return tmp.t;}    }    return -1;}int main() {    int n;    scanf("%d",&n);    while(n--) {int a,b,c,t;scanf("%d %d %d %d",&a,&b,&c,&t);for(int i=0;i<a;i++)    for(int j=0;j<b;j++)for(int k=0;k<c;k++) {    mark[i][j][k] = false;    scanf("%d",&matrix[i][j][k]);}while(!Q.empty()) Q.pop();N tmp;tmp.a = tmp.b = tmp.c = tmp.t = 0;mark[0][0][0] = true;Q.push(tmp);int ans = bfs(a,b,c);if(ans <= t)    printf("%d\n",ans);else    printf("-1\n");    }    return 0;}