bfs搜图：POJ3984迷宫问题

迷宫问题

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)

思路：从左上角开始把（0，0）位置放进队列然后把与他临的而且可以走的点放进队列，放进去的点的pre就是用来记录他前面那步（它前面那步的下标就是当前这步的pre），最后输出的时候就可以用这个一直往前把路径都输出出来。

下面是5*5的图全是0搜索的样子

表格里括号的意思：（下标，pre）

AC代码：

#include<stdio.h>
#include<algorithm>
#include<cstring>
#include<iostream>
using namespace std;
int map[5][5];
int dx[4]={1,0,-1,0};
int dy[4]={0,-1,0,1};
int head=0,tail=1;
struct node{
	int x;
	int y;
	int pre;
}q[100];

void print(int m)
{
	if(q[m].pre!=-1)
	{
		print(q[m].pre);
		printf("(%d, %d)\n", q[m].x, q[m].y);
	}
}


int main()
{
	for(int i=0; i<5; i++)
	{
		for(int j=0; j<5; j++)
		{
			cin>>map[i][j];
		}
	}
	printf("(0, 0)\n");
	q[0].x=0;
	q[0].y=0;
	q[0].pre=-1;
	while(head<tail)
	{
		for(int i=0; i<4; i++)
		{
			int nx=q[head].x+dx[i];
			int ny=q[head].y+dy[i];
			if(map[nx][ny]==0&&nx>=0&&ny>=0&&nx<5&&ny<5)
			{
				map[nx][ny]=1;
				q[tail].x=nx;
				q[tail].y=ny;
				q[tail].pre=head;
				tail++;
			}
			if(nx==4&&ny==4)
			{
				print(head);
			}
		}
		head++;
	}
	printf("(4, 4)\n");
	return 0;
}