#include<stdio.h>
#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;//若所有的状态都被查找完后,仍得不到所需坐标,则返回-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.t=tmp.y=tmp.x=tmp.z=0;
Q.push(tmp);
int rec=BFS(a,b,c);
if(rec<=t) printf("%d\n",rec);
else printf("-1\n");
}
}
广度优先搜索 BFS
最新推荐文章于 2023-06-14 23:43:52 发布