HDOJ搜索专题之胜利大逃亡

#include <stdio.h>
#include <string.h>
#include <queue>
#define N 50
using namespace std;
typedef struct node
{
int x,y,z;
}node;
queue<node> Q;
node cur,next;
int dx[6]={1,-1,0,0,0,0};
int dy[6]={0,0,1,-1,0,0};
int dz[6]={0,0,0,0,1,-1};
int g

,t

;
int a,b,c,tmax,ans;
void bfs()
{
bool success=false;
memset(t,0xff,sizeof(t));
cur.x=cur.y=cur.z=0;
t[0][0][0]=0;
while(!Q.empty()) Q.pop();
Q.push(cur);
while(!Q.empty() && !success)
{
cur=Q.front(),Q.pop();
ans=t[cur.x][cur.y][cur.z];
if(cur.x==a-1 && cur.y==b-1 && cur.z==c-1 && ans<=tmax) success=true;
for(int d=0;!success && d<6;d++)
{
next=cur;
next.x+=dx[d];
next.y+=dy[d];
next.z+=dz[d];
if(next.x<0 || next.x>=a) continue;
if(next.y<0 || next.y>=b) continue;
if(next.z<0 || next.z>=c) continue;
if(g[next.x][next.y][next.z]) continue;
if(t[next.x][next.y][next.z]!=-1) continue;
ans=t[next.x][next.y][next.z]=t[cur.x][cur.y][cur.z]+1;
if(next.x==a-1 && next.y==b-1 && next.z==c-1 && ans<=tmax) success=true;
else if(t[next.x][next.y][next.z]<tmax) Q.push(next);
}
}
if(success) printf("%d\n",ans);
else  puts("-1");
}
int main()
{
int T,i,j,k;
scanf("%d",&T);
while(T--)
{
scanf("%d%d%d%d",&a,&b,&c,&tmax);
for(i=0;i<a;i++)
{
for(j=0;j<b;j++)
{
for(k=0;k<c;k++)  scanf("%d",&g[i][j][k]);
}
}
bfs();
}
return 0;
}