利用BFS实现简单的走迷宫问题

BFS算法的核心

利用队列（queue）的特点，先进先出。将需要扩展出去的点加入队列，进行扩展，然后移出
队列。直到队列为空就可以遍历完全。在这里利用BFS来解决简单的迷宫问题（找路径）。

问题描述：

东东有一张地图，想通过地图找到妹纸。地图显示，0表示可以走，1表示不可以走，
左上角是入口，右下角是妹纸，这两个位置保证为0。
既然已经知道了地图，那么东东找到妹纸就不难了，
请你编一个程序，写出东东找到妹纸的最短路线。

输入：
输入是一个5 × 5的二维数组，仅由0、1两数字组成，表示法阵地图。

输出：
输出若干行，表示从左上角到右下角的最短路径依次经过的坐标，格式如样例所示。
数据保证有唯一解。

解题分析：

我们需要解决两个问题：1.在使用BFS时如何标志已经走过的点？2.如何记录每一条路径？
我们这里使用map结构来解决这两个问题：
map<node,node> from;
node是定义的一个结构体，表示地图中的一个点；用from[s]=t,来表示s的前面一个路径是t，
即t–>s. 这样就可以使用向前回溯的方法来找到一条正确的路径。

除了用bfs遍历，还有一个主要的点就是路径输出，我们利用from这个变量，可以采用：
1.递归回溯法；2.循环法。
循环法就是从终点开始，将每一个路过的点放入数组中，然后反序输出；
递归法就要注意返回的判别条件：from.find(n)==from.end()//表示走到了原点。
这里是递归输出的思路：

代码部分：

#include<stdio.h>
#include<map>
#include<queue>
using namespace std;
int a[5][5];
int dx[]={+1,-1,0,0};
int dy[]={0,0,+1,-1};

struct node//定义结构体表示地图中的一个点
{
	int x;int y;
	bool operator < (const node &s)const//重载比较方法
	{
		return x!=s.x ? x<s.x : y<s.y;
	}
};
map<node,node> from;//用来记录路径和标记是否走过

//路径输出
void print(node &n)
{
	if(from.find(n)==from.end())//起点
	{
		printf("(%d, %d)\n",n.x,n.y);
		return;
	}
	print(from[n]);//递归
	printf("(%d, %d)\n",n.x,n.y);
	return;
}

void bfs()
{
	
	node s1; s1.x=0;s1.y=0;
	queue<node> Q;
	Q.push(s1);
	while(!Q.empty())
	{
		node now=Q.front();
		Q.pop();
		//判断终点
		if(now.x==4&&now.y==4)
		{
			print(now);
			return;
		}
		for(int i=0;i<4;i++)
		{
			int new_x=now.x+dx[i],
			    new_y=now.y+dy[i];
			node theNew;
			theNew.x=new_x;theNew.y=new_y;
			if(new_x==0&&new_y==0) break;
			if(new_x>=0&&new_x<=4&&new_y>=0&&new_y<=4&&
			a[new_x][new_y]==0&& from.find(theNew)==from.end())//边界/障碍/走过的不会加入
			{
				from[theNew]=now;
				Q.push(theNew);
			}
		}
	}
}

int main()
{
	for(int i=0;i<5;i++)
		for(int j=0;j<5;j++)
			scanf("%d",&a[i][j]);
	bfs();//调用bfs函数
	return 0;
}