【POJ 3984】迷宫问题（BFS）

Description

定义一个二维数组：

int maze[5][5] = {

0, 1, 0, 0, 0,

0, 1, 0, 1, 0,

0, 0, 0, 0, 0,

0, 1, 1, 1, 0,

0, 0, 0, 1, 0,

};

它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。

Input

一个5 × 5的二维数组，表示一个迷宫。数据保证有唯一解。

Output

左上角到右下角的最短路径，格式如样例所示。

Sample Input

0 1 0 0 0
0 1 0 1 0
0 0 0 0 0
0 1 1 1 0
0 0 0 1 0

Sample Output

(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

题目大意

中文题

思路

普通的bfs加了路径保存。实现看代码：

代码

#include <iostream>
#include <cstdio>
#include <cstring>
#include <algorithm>
#include <queue>
#include <stack>

using namespace std;
const int maxn=7;

int dir[4][2]={{1,0},{0,1},{-1,0},{0,-1}};
int map[maxn][maxn];
int posx,posy,stax,stay,vis[maxn][maxn];

struct proc
{
    int x,y,step;
    proc *pre;//用于存取当前这个点是由那个点搜索过来的(相当于保存父亲结点)
};

queue<proc> r;

int bfs(int x,int y)
{
    memset(vis,0,sizeof(vis));
    queue<proc> q;
    proc t[2*maxn+50];
    proc vw;
    vw.x=x;
    vw.y=y;
    vw.step=0;
    vw.pre=NULL;
    vis[vw.x][vw.y]=0;
    q.push(vw);
    int cnt=-1;
    while(!q.empty())
    {
        cnt++;
        t[cnt]=q.front();
        q.pop();
        for(int i=0;i<4;i++)
        {
            vw.x=t[cnt].x+dir[i][0];
            vw.y=t[cnt].y+dir[i][1];
            if(map[vw.x][vw.y]!=1&&!vis[vw.x][vw.y]&&vw.x>=1&&vw.x<=5&&vw.y>=1&&vw.y<=5)
            {
                vw.pre=&t[cnt];//记录路径
                vw.step=t[cnt].step+1;
                vis[vw.x][vw.y]=1;
                q.push(vw);
            }
            if(vw.x==posx&&vw.y==posy)
            {
                while(vw.pre)//将路径保存在队列r中
                {
                    r.push(vw);
                    vw=*vw.pre;
                }
                return t[cnt].step;
            }
        }

    }
    return -1;
}

int main()
{
    for(int i=1;i<=5;i++)
    {
        for(int j=1;j<=5;j++)
        {
            scanf("%d",&map[i][j]);
        }
    }
    stax=1,stay=1,posx=5,posy=5;
    int ans=bfs(stax,stay);
    stack<proc> p;
    while(!r.empty())//输出入境，因为从r中输出时是倒序的，所以先存到栈p中，再输出。
    {
        proc tmp=r.front();
        r.pop();
        p.push(tmp);
    }
    printf("(0, 0)\n");//（0,0）需要自己输出，因为没法保存起点的路径。
    while(!p.empty())
    {
        proc tmp=p.top();
        p.pop();
        printf("(%d, %d)\n",tmp.x-1,tmp.y-1);//从1开始存的需要-1，从0开始不需要
    }
    return 0;
}