hdu 1253 胜利大逃亡 bfs

三维的bfs

#include<stdio.h>
#include<string.h>
#include<queue>  
using namespace std;

const int N=52;
int mp[N][N][N],visit[N][N][N];
int dir[6][3]={0,0,1,0,0,-1,0,1,0,0,-1,0,1,0,0,-1,0,0};
int tt,x,y,z,t;
struct node{
    int x,y,z,step;
    node(int a,int b,int c,int d){
        x=a;y=b;z=c;step=d;
    }
};

int bfs(){
    queue<node> q;
    q.push(node(1,1,1,0));
	visit[1][1][1]=1;
    while(!q.empty()){
        node cur=q.front();
        q.pop();
        if(cur.step>t)//bfs的剪枝
            break;
        //visit[cur.x][cur.y][cur.z]=1;写这里会增加很多
        if(cur.x==x&&cur.y==y&&cur.z==z)
            return cur.step;
        for(int i=0;i<6;i++){
            int nx=cur.x+dir[i][0],ny=cur.y+dir[i][1],nz=cur.z+dir[i][2];
            if(mp[nx][ny][nz]==0&&visit[nx][ny][nz]==0){//0代表路
				visit[nx][ny][nz]=1;
                q.push(node(nx,ny,nz,cur.step+1));
			}
        }
    }
    return -1;
}

int main(){
    scanf("%d",&tt);
    while(tt--){
        scanf("%d %d %d %d",&x,&y,&z,&t);
        memset(mp,-1,sizeof mp);
        memset(visit,0,sizeof visit);
        for(int i=1;i<=x;i++)
            for(int j=1;j<=y;j++)
                for(int k=1;k<=z;k++)
                    scanf("%d",&mp[i][j][k]);
        printf("%d\n",bfs());
    }
    return 0;
}
/*
1
3 3 4 20
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
*/