hdu1253BFS入门

//hdu1253
#include<iostream>
#include<cmath>
#include<cstring>
#include<cstdio>
#include<fstream>
#include<algorithm>
#include<string>
#include<stack>
#include<queue>
//#include<map>
#define PI acos(-1.0)
typedef long long LL;
const int MAX=0xfffffff;
using namespace std;
int a,b,c,t,STEP;
int map[55][55][55];
bool vis[55][55][55];
struct node{
int x,y,z,step;
};
node p,q;
int dir[6][3]={{1,0,0},{-1,0,0},{0,1,0},{0,-1,0},{0,0,1},{0,0,-1}};
void bfs()
{
    memset(vis,0,sizeof(vis));
    vis[0][0][0]=1;
    queue<node>Q;
    p.x=0,p.y=0,p.z=0,p.step=0;
    Q.push(p);
    while(!Q.empty())
    {
        p=Q.front( ),Q.pop( );
        if(p.x==a-1&&p.y==b-1&&p.z==c-1&&p.step<=t)     //不太理解为什么这一步不能立即停止。
        {
            printf("%d\n",p.step);         
            return ;
        }
        for(int i=0;i<6;i++)
        {
            q=p;
            q.x=p.x+dir[i][0];
            q.y=p.y+dir[i][1];
            q.z=p.z+dir[i][2];
            q.step=p.step+1;
            if(map[q.x][q.y][q.z]==0&&vis[q.x][q.y][q.z]==0&&q.x>=0&&q.y>=0&&q.z>=0&&q.x<a&&q.y<b&&q.z<c)
            {
                vis[q.x][q.y][q.z]=1;
                Q.push(q);
            }
        }
    }
    printf("-1\n");
}
int main( )
{
    freopen("1.txt","r",stdin);
    int time;
    while(scanf("%d",&time)!=EOF)
    {
        while(time--)
        {
            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",&map[i][j][k]);
            bfs();
        }
    }
}