利用BFS、队列求解迷宫问题

POJ 3984

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)

代码如下：

#include <stdio.h>
#include<string.h>
#include <iostream>
#include <queue>
#include <limits.h>
#include <algorithm>
#define A 5
using namespace std;

const int BLOCK=1;
int Maze[A][A];
pair<int,int>path[A][A];
int dx[]={1,-1,0,0};
int dy[]={0,0,1,-1};
inline bool is_Legal(int x,int y)
{
    return x>=0&&y>=0&&x<A&&y<A&&!Maze[x][y];
}

void bfs(int ex=4,int ey=4) /// ////////////////////////////////////////////////////
{
    queue <pair<int,int> > q;
    q.push(make_pair(ex,ey));     ///初始条件，从终点开始搜索到起点，方便记录路径
    path[ex][ey]=make_pair(-1,-1);///记录终点结束条件值
    Maze[ex][ey]=BLOCK;           ///标志为不可走

    while(!q.empty())
    {
        pair<int,int>fa =q.front();
        q.pop();
        for(int i=0;i<4;i++)
        {
            int nx=dx[i]+fa.first,ny=dy[i]+fa.second;
            if(!is_Legal(nx,ny)) ///跳过不可走的方格
                continue;
            path[nx][ny]=fa;     ///记录路径(经过该点的路线的上一个点)
            if(0==nx&&0==ny)     ///找到起点可以返回
            return ;
            q.push(make_pair(nx,ny));///入队列
            Maze[nx][ny]=BLOCK;  ///入队列的方格，可以马上置为不可走状态
        }
    }
} /// ///////////////////////////////////////////////////////////////////////////////

int main()
{
    for(int i=0;i<5;i++)
        for(int j=0;j<5;j++)
        scanf("%d",&Maze[i][j]);
        bfs();
        int x=0,y=0;            ///起点开始输出路径点
        while(x!=-1)
        {
            printf("(%d, %d)\n",x,y);///注意：","后面有一个空格要加上，否则会显示"Presentation Error".
            int nx=path[x][y].first;
            int ny=path[x][y].second;
            x=nx,y=ny;               ///注意需要使用中间变量nx，ny
        }
    return 0;
}

看了bfs的一些文章，又找了一些代码示例，终于把迷宫问题写出来了。