广度优先搜索（BFS）

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 23104		Accepted: 13463

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<bits/stdc++.h> 
#include<vector>
#include<cstring> 
using namespace std;
struct Pos{
	int r,c;
	int father;
	Pos(int rr=0,int cc=0,int ff=0):r(rr),c(cc),father(ff){ }
};
int maze[8][8];
Pos que[100];
int head,tail;
Pos  dir[4]={Pos(-1,0),Pos(1,0),Pos(0,-1),Pos(0,1)};//移动方向
int main()
{
	memset(maze,0xff,sizeof(maze));
	for(int i=1;i<=5;i++)
	    for(int j=1;j<=5;j++)
	           cin>>maze[i][j];
	           head=0;
	           tail=1;
	           que[0]=Pos(1,1,-1);
	           while(head!=tail){
	           	Pos  ps=que[head];
	           	if(ps.r=5&&ps.c==5){
	           		vector<Pos> vt;
	           		while(true){
	           			vt.push_back(Pos(ps.r,ps.c,0));
	           			if(ps.father==-1)
	           			    break;
	           			    ps=que[ps.father];
					   };
					   for(int i=vt.size()-1;i>=0;--i)
					      cout<<"("<<vt[i].r-1<<","<<vt[i].c-1<<")"<<endl;
					      return 0;
				   }
				   else {
				         int r=ps.r,c=ps.c;
				         for(int i=0;i<4;i++)
				         	if(!maze[r+dir[i].r][c+dir[i].c]){
				         		que[tail++]=Pos(r+dir[i].r,c+dir[i].c,head);
				         		maze[r+dir[i].r][c+dir[i].c]=1;
							 }
							 ++head;
						 }
			}
			return 0;
		}