迷宫问题——bfs练习（记录路径）

定义一个二维数组：

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)

/*思路很简单，就是需要记录途径有点麻烦，
  因此不能再用模板中的队列来做，
  因为STL中的队列取出来后不能保存，
  所以需要自己弄一个队列，这里的是借鉴了大佬的代码才A出来的；
  看了网上很多的代码，大都是自己再写一个队列实现操作；
  觉得这个是最好的， 
 */ 

#include<iostream>
#include<cstring> 
using namespace std;
int a[5][5];
struct node
{
 int x,y;
 int pre;
}queue[30];
int rear=0;
int front=0;
int visited[5][5];
int dis[4][2]={{-1,0},{1,0},{0,1},{0,-1}};
void bfs(int sx,int sy, int ex, int ey)
{
   queue[0].x=sx;
   queue[0].y=sy;
   queue[0].pre=-1;
   rear++; 
   visited[sx][sy]=1;
   while(front<rear)
   {
   	for(int i = 0;i < 4;i++)
   	{
   		int newx=queue[front].x+dis[i][0];
   		int newy=queue[front].y+dis[i][1];
   		if(newx<0||newx>=5||newy<0||newy>=5) continue;
   		if(visited[newx][newy]==1||a[newx][newy]==1) continue;
   		visited[newx][newy]=1;
   		queue[rear].x=newx;
   		queue[rear].y=newy;
   		queue[rear].pre=front;
   		rear++;
   		if(newx==ex&&newy==ey) return ;
   		
	}
	front++;
   }
}
void Print(node now)
{
	if(now.pre==-1)
		cout<<"("<<now.x<<", "<<now.y<<")"<<endl;
	else
	{
		Print(queue[now.pre]);
		cout<<"("<<now.x<<", "<<now.y<<")"<<endl;
	}
}
int main()
{
	memset(visited,0,sizeof(visited));
	for(int i = 0;i < 5;i++)
	   for(int j = 0;j < 5;j++)
	    cin >>a[i][j];
	bfs(0,0,4,4);
	Print(queue[rear-1]);
	return 0;
 }