hdu 1253 胜利大逃亡 bfs

三维的bfs

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

const int N=52;
int mp

,visit

;
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
*/