poj3984迷宫问题【bfs+记录路径】

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 11236		Accepted: 6719

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<cstdio>
#include<cstdlib>
#include<cstring>
#include<queue>
using namespace std;
int last[6][6];
int map[6][6];
int vis[6][6];
int mov[][2]={1,0,-1,0,0,1,0,-1};
bool judge(int x,int y)
{
	if(x>=0&&x<5&&y>=0&&y<5&&!map[x][y]&&!vis[x][y])return true;
	return false;
}
void printpath(int x,int y)
{
	int u,v,xx,yy;
	if(last[x][y]!=-1)
	{
		xx=last[x][y]/5;yy=last[x][y]%5;
		printpath(xx,yy);
	}
	printf("(%d, %d)\n",x,y);
}
void bfs()
{
	int x,y,xx,yy,i,j,u,flag=0;
	queue<int>Q;
	x=0;y=0;u=x*5+y;
	Q.push(u);vis[0][0]=1;last[0][0]=-1;
	while(!Q.empty())
	{
		u=Q.front();Q.pop();
		x=u/5;y=u%5;
		for(i=0;i<4;++i)
		{
			xx=x+mov[i][0];
			yy=y+mov[i][1];
			if(judge(xx,yy))
			{
				int v=xx*5+yy;
				vis[xx][yy]=1;
				last[xx][yy]=u;
				if(vis[4][4])
				{
					printpath(4,4);
					flag=1;break;
				}
				Q.push(v);
			}
			if(flag)break;
		}
	}
}
int main()
{
	int i,j;
	for(i=0;i<5;++i)
	{
		for(j=0;j<5;++j)
		{
			scanf("%d",&map[i][j]);
			last[i][j]=vis[i][j]=0;
		}
	}
	bfs();
	return 0;
}