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);
}