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)

Source

题目链接：http://poj.org/problem?id=3984

利用BFS搜索记忆路径，输出时递归：

#include<stdio.h>
void print_direct(int i,int j);
const int MAXN=5,N=5;
int mat[MAXN][MAXN],vis[MAXN][MAXN],fa[MAXN][MAXN];
int main()
{
//freopen("in.in","r",stdin);
int i,j,x,y;
for(i=0;i<N;i++)
for(j=0;j<N;j++)
scanf("%d",&mat[i][j]);
int queue[MAXN*MAXN][2]={{0,0}},front=0,rear=1,
dx[4]={-1,0,1,0},dy[4]={0,1,0,-1};
vis[0][0]=1;
//BFS
while(front<=rear)
{
x=queue[front][0],y=queue[front++][1];
for(i=0;i<4;i++)
{
int nx=x+dx[i],ny=y+dy[i];
if(mat[nx][ny]==0&&(nx>=0&&nx<N&&ny>=0&&ny<N)&&vis[nx][ny]==0)
queue[rear][0]=nx,   //可行走坐标入队列
queue[rear++][1]=ny,
vis[nx][ny]=1,
fa[nx][ny]=x*N+y;    //nx,ny的父节点
}
}
//print
print_direct(N-1,N-1);
printf("(%d, %d)\n",N-1,N-1);   //最后一个坐标没有子节点，应另外输出
return 0;
}
void print_direct(int i,int j)
{
if(i==0&&j==0)return;
print_direct(fa[i][j]/N,fa[i][j]%N);
printf("(%d, %d)\n",fa[i][j]/N,fa[i][j]%N);
}