南阳oj忙命逃窜，bfs

思路：这里说的第几层实际上就是三维数组，map[x][y][z],然后可以朝六个方向移动的话，在map[1]这层可以移动上下左右，x、y变化，然后还可以从map[1][x][y]到map[2][x][y]，移动层次。然后其他的就bfs广搜就ok了。

亡命逃窜

时间限制： 1000 ms  |  内存限制： 65535 KB

难度： 4

描述

    从前有个叫hck的骑士，为了救我们美丽的公主，潜入魔王的老巢，够英雄吧。不过英雄不是这么好当的。这个可怜的娃被魔王抓住了，倍受折磨，生死一线。有一天魔王出去约会了，这可是一个千载难逢的逃命机会。你现在的任务就是判断一下这个英雄未遂的孩子能不能在魔王回来之前逃出魔王的城堡，成功逃生，最后迎娶我们美丽的公主。

    魔王住在一个城堡里,城堡是一个A*B*C的立方体,可以被表示成A个B*C的矩阵,刚开始hck被关在(0,0,0)的位置,离开城堡的门在(A-1,B-1,C-1)的位置,现在知道魔王将在T分钟后回到城堡,hck每分钟能从一个坐标走到相邻的六个坐标中的其中一个.现在给你城堡的地图,请你计算出hck能否在魔王回来前离开城堡(只要走到出口就算离开城堡,如果走到出口的时候魔王刚好回来也算逃亡成功),如果可以请输出需要多少分钟才能离开,如果不能则输出-1.

如图所示，输入数据中的第0块的最左上角是hck被关的地方，第A-1块的最右下角是城堡的出口。按照图中红色箭头方向移动每一层以构成整个城堡。

输入

输入数据的第一行是一个正整数K,表明测试数据的数量. 每组测试数据的第一行是四个正整数A,B,C和T(1<=A,B,C<=50,1<=T<=1000),它们分别代表城堡的大小和魔王回来的时间.
然后是A块输入数据(先是第0块,然后是第1块,第2块......),每块输入数据有B行,每行有C个正整数,代表迷宫的布局,其中0代表路,1代表墙.
(如果对输入描述不清楚,可以参考上面的迷宫描述,它表示的就是上图中的迷宫)

输出

对于每组测试数据,如果hck能够在魔王回来前离开城堡,那么请输出他最少需要多少分钟,否则输出-1.

样例输入

2
3 2 2 10
0 1
0 0
1 1
1 0
0 0
0 1
3 3 4 20
0 1 1 1
0 0 1 1
0 1 1 1
1 1 1 1
1 0 0 1
0 1 1 1
0 0 0 0
0 1 1 0
0 1 1 0

样例输出

-1
11

上代码：代码比较烂

#include<stdio.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include<queue>
#define QUEUELEN 2500001

//数据结构的定义
typedef struct
{   int z;
	int x;
	int y;
	int pre;
}DATA;

typedef struct
{

	int head;
	int tail;
}SQType;
DATA data[QUEUELEN];
//队列的初始化
SQType *SQTypeInit()
{
	SQType *q;
	if(q=(SQType *)malloc(sizeof(SQType)))
	{
		q->head=0;
		q->tail=0;
        return q;
	}
	else
	{
		return NULL;
	}
}
//判断空队列
int SQTypeIsEmpty(SQType *q)
{
	int temp;
	temp=q->head==q->tail;
	return temp;

}



//入队
int InSQType(SQType *q,DATA a)
{
	if (q->tail==QUEUELEN)
	{
		printf("队列满鸟。。。");
		return 0;
	}
	else
	{
		data[q->tail++]=a;
		return 1;
	}
}

//出队列
int  OutSQType(SQType *q,DATA &a)
{
	if(q->head==q->tail)
	{
	   printf("亲，队列是空的。。。");
	   return 0;
	}
	else
{  a= data[q->head++];

   return 1;

	}

}

//读取节点的数据


//计算队列的长度


int map[50][50][1000];
bool flag[50][50][1000]={0};
int a,b,c,t;
int bfs(int z,int x,int y,int zz,int zx,int zy)
{
    if(z==zz&&x==zx&&y==zy) { printf("0\n"); return 1;}

   int dir[6][3]={{0,1,0},{0,-1,0},{0,0,1},{0,0,-1},{1,0,0},{-1,0,0}};


   {
   SQType *migong=SQTypeInit();
   DATA aa={z,x,y,0};
   flag[z][x][y]=1;
   InSQType(migong,aa);
   while(!SQTypeIsEmpty(migong))
   {
   	OutSQType(migong,aa);
   	for(int i=0;i<6;i++)
   	{   int nz=aa.z+dir[i][0];
   		int nx=aa.x+dir[i][1];
   		int ny=aa.y+dir[i][2];
        if(!(nx>=0&&nx<b&&ny>=0&&ny<c&&nz>=0&&nz<a)) continue;
   		if(nx>=0&&nx<b&&ny>=0&&ny<c&&nz>=0&&nz<a&&nx==zx&&ny==zy&&nz==zz&&!map[nz][nx][ny])
   		{
   			if(aa.pre+1<=t) printf("%d\n",aa.pre+1);
   			else printf("-1\n");return aa.pre+1;
   		}
   		if(map[nz][nx][ny]==0&&!flag[nz][nx][ny]&&nx>=0&&nx<b&&ny>=0&&ny<c&&nz>=0&&nz<a)
   		{
   			DATA n;
   			n.pre=aa.pre+1;
   			n.z=nz;
   			n.x=nx;
   			n.y=ny;
   			flag[nz][nx][ny]=1;
   	        InSQType(migong,n);

   		}
   	}

   }
printf("-1\n");
   }
}
int main()
{
  int k;
  scanf("%d",&k);
  while(k--)
    {
       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]);
           }
       }
       memset(flag,0,sizeof(flag));
       bfs(0,0,0,a-1,b-1,c-1);

    }



}