迷宫问题 经典bfs问题【bfs】

迷宫问题

Time Limit : 2000/1000ms (Java/Other)   Memory Limit : 131072/65536K (Java/Other)

Total Submission(s) : 46   Accepted Submission(s) : 28

Problem 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

PKU

代码：

#include<cstdio>
#include<cstring>
#include<algorithm>
#include<cstdlib>
#include<queue>
using namespace std;
int map[5][5];
int vis[100][100];
int ans=0;
int dir[4][2]={1,0,-1,0,0,-1,0,1};
int cnt=1;
struct node
{
	int x,y,step;
}gg[100];

void fuck(int i)
{
	if(gg[i].step!=-1)
	{
		fuck(gg[i].step);
		printf("(%d,%d)\n",gg[i].x,gg[i].y);
	}
}

int judge(int a,int b)
{
	if(a<0||a>=5)
	return 1;
	if(b<0||b>=5)
	return 1;
	if(map[a][b])
	return 1;
	return 0;
}
void bfs (int a,int b)
{
	gg[ans].x=a;
	gg[ans].y=b;
	gg[ans].step=-1;
	//memset(vis,0,sizeof(vis));
	//priority_queue<node>q;
	//vis[a][b]=1;
	//q.push(gg[ans]);
	while(ans<cnt)
	{
//		q.top();
//		q.pop();
		for(int i=0;i<4;i++)
		{
			int dx=gg[ans].x+dir[i][0];
			int dy=gg[ans].y+dir[i][1];
			if(judge(dx,dy))
			continue;
			else
			{
				map[dx][dy]=1;
				gg[cnt].x=dx;
				gg[cnt].y=dy;
				gg[cnt].step=ans;
				cnt++;
			}
			if(dx==4&&dy==4)
			fuck(ans);
		}
		ans++;
	}
} 

int main()
{
	int i,j;
	for(i=0;i<5;i++)
	for(j=0;j<5;j++)
	scanf("%d",&map[i][j]);
	printf("(0,0)\n");
	bfs(0,0);
	printf("(4,4)\n");
	return 0;
}