迷宫问题

 迷宫问题

Time Limit:1000MS     Memory Limit:65536KB     64bit IO Format:%I64d & %I64u

Submit  Status  Practice  POJ 3984

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<stdio.h>
#include<queue>
#include<string.h>
using namespace std;
struct node{
	int h;
	int x;
	int y;
	int pre;
}f[26];
int a[5][5],biao=1,flag,d;
int c[4][2]={{0,-1},{0,1},{-1,0},{1,0}};
int vis[5][5];
node f1[100];
queue<node>q;
void dfs(int z)
{
	f1[d].x=f[z].x;
	f1[d].y=f[z].y;
	d++;
	if(z==0)
	return;
	dfs(f[z].pre);	
}
void bfs(int x,int y)
{
	while(!q.empty())
	{
	for(int i=0;i<=3;i++)
	{
	   int	xx=q.front().x+c[i][0];
	   int	yy=q.front().y+c[i][1];
		if(xx>=0&&xx<=4&&yy>=0&&yy<=4&&a[xx][yy]==0&&vis[xx][yy]==0)
		{
			vis[xx][yy]=1;
			f[biao].x=xx;
			f[biao].y=yy;
			f[biao].pre=q.front().h;
			f[biao].h=biao;
			q.push(f[biao]);
			biao++;
		}
		if(xx==4&&yy==4)
		{
			flag=1;
			break;
		}	
	}
	q.pop();
	if(flag)
	break;
}
}
int main()
{
	int i,j;
	flag=0;
	d=0;
	memset(vis,0,sizeof(vis));
	for(i=0;i<5;i++)
	{
		for(j=0;j<5;j++)
		{
			scanf("%d",&a[i][j]);
		}
	}
		f[0].x=0;
		f[0].y=0;
		f[0].h=0;
		f[0].pre=0;
		vis[0][0]=1;
		q.push(f[0]);
		bfs(0,0);
		/*for(i=0;i<=25;i++)
		{
			printf("%d ",f[i].pre);
		}*/
		for(i=1;;i++)
		{
			if(f[i].x==4&&f[i].y==4)
			{
				//printf("%d\n",i);
				dfs(i);
				break;
			}
		}
		//printf("%d %d\n",f1[0].x,f1[0].y);
		for(i=d-1;i>=0;i--)
		{
			printf("(%d, %d)\n",f1[i].x,f1[i].y);
		}	
}