定义三维数组 [z][x][y]存储信息(矩阵是n*n*n,所以x,y换位置影响不大)
起始坐标存队列中,BFS遍历
如果找到终点坐标 令flag=1,退出遍历,否则循环结束后ans++。
keep数组判断是否'O'点坐标是否记录
#include<bits/stdc++.h>
using namespace std;
struct node
{
int x,y,z;
};
#define check(x,y,z) (x>=0&&x<k&&y>=0&&y<k&&z>=0&&z<k)
int lo[6][3]={{1,0,0},{-1,0,0},{0,1,0},{0,-1,0},{0,0,-1},{0,0,1}};
int main()
{
freopen("C:\\Users\\Lenovo\\Desktop\\input.txt","r",stdin);
string begin,end;
int k;
char c;
node st,en;
while (cin>>begin>>k)
{
char ma[20][20][20];
for(int z=0;z<k;z++){
for(int x=0;x<k;x++){
getchar();
scanf("%s",ma[z][x]);
ma[z][x][k]='\0';
}
}
scanf("%d%d%d",&st.y,&st.x,&st.z);scanf("%d%d%d",&en.y,&en.x,&en.z);
queue<node>list;
list.push(st);
int flag=0,ans=0;
int keep[20][20][20]={0};
while(list.size())
{
int len=list.size();
node temp,index;
for(int i=0;i<len;i++)
{
temp=list.front();list.pop();
if(temp.x==en.x&&temp.y==en.y&&temp.z==en.z)
{
flag=1;break;
}
else
{
int i=0;
for(;i<6;i++)
{
int y=lo[i][0]+temp.y;
int x=lo[i][1]+temp.x;
int z=lo[i][2]+temp.z;
if(check(x,y,z)&&keep[z][x][y]==0&&ma[z][y][x]=='O')
{
index.x=x;index.y=y;
index.z=z;keep[z][x][y]=1;
list.push(index);
}
}
}
}
if(flag==1)
{
break;
}
else ans++;
}
cin>>end;
if(flag)
{
printf("%d %d\n",k,ans);
}
else
{
printf("NO ROUTE\n");
}
}
return 0;
}