3维迷宫的bfs

#include <stdio.h>
#include <iostream>
#include <cstring>
#include <stdlib.h>
#include <algorithm>
#include <queue>
#include <math.h>
#define MAX 30
#define INF 1e8

using namespace std;
int L,R,C;
char maze[MAX][MAX][MAX];
int d[MAX][MAX][MAX];
int move1[6][3] = {{-1,0,0},{0,1,0},{1,0,0},{0,-1,0},{0,0,1},{0,0,-1}};
int sx,sy,sz,ex,ey,ez;
struct P{
    int a,b,c;
};
void bfs()
{
    queue<P> que;
    P q,cq;
    q.a = sx,q.b = sy,q.c = sz;
    que.push(q);
    while (!que.empty())
    {
        q = que.front();
        que.pop();
        for (int i = 0;i < 6;i++)
        {
            int nx = q.a+move1[i][0],ny = q.b+move1[i][1],nz = q.c+move1[i][2];
            if((nx>=0&&nx<L)&&(ny>=0&&ny<R)&&(nz>=0&&nz<C)&&maze[nx][ny][nz] != '#'&&d[nx][ny][nz] == INF)
            {
                cq.a = nx,cq.b = ny,cq.c = nz;
                que.push(cq);
                d[nx][ny][nz] = d[q.a][q.b][q.c] + 1;
            }
        }
    }
}
int main(void)
{
    while(scanf("%d %d %d",&L,&R,&C) != EOF&&(L||R||C))
    {
        for (int i = 0;i < L;i++)
        {
            for (int j = 0;j < R;j++)
            {
                scanf("%s",maze[i][j]);
            }
        }
        for (int i = 0;i < L;i++)
        {
            for (int j = 0;j < R;j++)
            {
                for (int k = 0;k < C;k++)
                {
                    if(maze[i][j][k] == 'S')
                        sx = i,sy = j,sz = k;
                    else if(maze[i][j][k] == 'E')
                        ex = i,ey = j,ez = k;
                    d[i][j][k] = INF;
                }
            }
        }
        d[sx][sy][sz] = 0;
        bfs();
        if(d[ex][ey][ez] != INF)
            printf("Escaped in %d minute(s). \n",d[ex][ey][ez]);
        else
            cout<<"Trapped!"<<endl;
    }
    return 0;
}
一次就过- -松松无压力
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值