广度优先搜索 BFS

#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");
	}
}