利用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的一些文章,又找了一些代码示例,终于把迷宫问题写出来了。