胜利大逃亡——广度优先搜索（BFS）

#include <cstdio>
#include <queue>
using namespace std;
bool mark[50][50][50];
int maze[50][50][50];
struct N{
    int x,y,z;
    int t;
};
queue<N> Q;
int go[][3]={{1,0,0},{-1,0,0},{0,1,0},{0,-1,0},{0,0,1},{0,0,-1}};
int bfs(int a,int b,int c){
    while(Q.empty()==false){
        N now=Q.front();
        Q.pop();
        for(int i=0;i<6;i++){
            int nx=now.x+go[i][0];
            int ny=now.y+go[i][1];
            int nz=now.z+go[i][2];
            if(nx<0||nx>=a||ny<0||ny>=b||nz<0||nz>=c) continue;
            if(maze[nx][ny][nz]==1) continue;
            if(mark[nx][ny][nz]==true) continue;
            N tmp;
            tmp.x=nx,tmp.y=ny,tmp.z=nz,tmp.t=now.t+1;
            Q.push(tmp);
            mark[nx][ny][nz]=true;
            if(nx==a-1&&ny==b-1&&nz==c-1) return tmp.t;
        }
    }
    return -1;
}
int main(){
    int T;
    scanf("%d",&T);
    while(T--){
        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++){
                    scanf("%d",&maze[i][j][k]);
                    mark[i][j][k]=false;
                }
        while(Q.empty()==false) Q.pop();
        mark[0][0][0]=true;
        N tmp;
        tmp.x=tmp.y=tmp.z=tmp.t=0;
        Q.push(tmp);
        int ans=bfs(a,b,c);
        if(ans<=t) printf("%d\n",ans);
        else printf("-1\n");
    }
    return 0;
}