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)

Solution

简单搜索，因为要记录路径，故要开个数组记录状态，此处因为只是个5*5矩阵，故我采用一位数组p[i]记录路径，(p[i]/5,p[i]%5)表示该步坐标

Code

#include<cstdio>
#include<cstring>
#include<iostream>
#include<queue>
using namespace std;
struct node
{
int x,y;
};
queue<node> que;
int flag[30],map[5][5],vis[5][5];
int nx[4]={-1,0,1,0},ny[4]={0,-1,0,1};
void Printf()
{
int p[30];
int u=24,j=0;
while(1)
{
p[j++]=flag[u];
u=flag[u];
if(u==0)
break;
}
for(int i=j-1;i>=0;i--)
printf("(%d, %d)\n",p[i]/5,p[i]%5);
printf("(4, 4)\n");
return ;
}
void bfs(int x,int y)
{
node now,next;
memset(flag,0,sizeof(flag));//初始化
memset(vis,0,sizeof(vis));//初始化
//从左上角出发
now.x=0;
now.y=0;
que.push(now);//起点入队
while(!que.empty())
{
now=que.front();//出队
que.pop();
for(int i=0;i<4;i++)//四个方向枚举
{
int dx=now.x+nx[i],dy=now.y+ny[i];
if(dx>=0&&dx<=4&&dy>=0&&dy<=4&&!vis[dx][dy]&&!map[dx][dy])//满足条件
{
vis[dx][dy]=1;//标记该点
flag[dx*5+dy]=now.x*5+now.y;//记录路径
if(dx==4&&dy==4)//到达终点
{
Printf();//打印路径
return ;
}
next.x=dx;
next.y=dy;
que.push(next);//该点入队
}
}
}
}
int main()
{
for(int i=0;i<5;i++)
for(int j=0;j<5;j++)
scanf("%d",&map[i][j]);
bfs(0,0);
return 0;
}