题意:
在一个三维有障碍物的迷宫中,求从起点S到终点E是否有 路径,如果有,求出最短的路径,否则输出“Tranpped!”
题解:
求迷宫的最短路径,经典的BFS题目,使用队列Queue来维护,没什么特别的地方,注意好 Q.push()和Q.pop()的时机就好。
代码:1次AC
#include<cstdio>
#include <iostream>
#include<cstring>
#include<queue>
using namespace std;
struct Node{
int l,r,c;
int cnt;
}maze,st,en;
int m[35][35][35],f[35][35][35];
int stpL[]={0,0,0,0,1,-1};
int stpR[]={0,1,0,-1,0,0};
int stpC[]={1,0,-1,0,0,0};
int ok;
int main(int argc, const char * argv[]) {
int L,R,C;
char s[105];
while(~scanf("%d%d%d",&L,&R,&C)){
if(!L && !R && !C) break;
memset(m,-1,sizeof(m));
memset(f,0,sizeof(f));
for(int i=0;i<L;i++)
for(int j=0;j<R;j++){
scanf("%s",s);
for(int k=0;k<C;k++){
if(s[k]=='S') {st.l=i+1; st.r=j+1; st.c=k+1; st.cnt=0;}
if(s[k]=='E') {en.l=i+1; en.r=j+1; en.c=k+1; m[i+1][j+1][k+1]=0;}
if(s[k]=='.') m[i+1][j+1][k+1]=0;
}
}
ok=0;
queue<struct Node> Q;
Q.push(st);
f[st.l][st.r][st.c]=-1;
while(!Q.empty() && !ok){
Node cur=Q.front();
for(int i=0;i<6;i++){
Node nxt;
nxt.l=cur.l+stpL[i];
nxt.r=cur.r+stpR[i];
nxt.c=cur.c+stpC[i];
nxt.cnt=cur.cnt+1;
if(m[nxt.l][nxt.r][nxt.c] || f[nxt.l][nxt.r][nxt.c]) continue; // 是障碍物或已经使用
f[nxt.l][nxt.r][nxt.c]=1; //占用当前位置
if(nxt.l==en.l && nxt.r==en.r && nxt.c==en.c){
ok=1;
en.cnt=nxt.cnt;
break;
}
Q.push(nxt); //加入新节点
}
Q.pop(); //pop掉第一个节点
}
if(!ok) puts("Trapped!");
else printf("Escaped in %d minute(s).\n",en.cnt);
}
return 0;
}