POJ3984 迷宫问题

定义一个二维数组：

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,

};

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)

它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。

分析：本题是bfs的模板题，要求输出路径，我们这里使用两遍bfs

广度优先搜索的具体做法

从初始节点start开始，将start加入队列
取出队列中的队头元素，访问以该节点为起始点的四个邻域节点,，这里需要判断该节点是否可访问(maps[i][j]==0)，是否已经被访问过(visited[i][j]==0)，同时检查该节点是否超出地图越界。
如果经过检查后该节点可以访问，则访问该节点，visited[i][j]=1,并将该节点的信息(横坐标x,纵坐标y,父节点f)存入队列中。
重复2步骤，直到找到end节点，或者队列为空。

visit数组记录的是到该点的最小长度，

#include<stdio.h> 
#include<queue>  
using namespace std;  
struct Point  
{  
 int i;  
 int j;
};  
Point path[50];  
Point p;  
queue<Point>q;  
int dir[4][2] = {{1,0},{-1,0},{0,1},{0,-1}};  
int visit[10][10];  
int main( )  
{  
  int road[6][6],i,j,k,xx,yy,a,b,len=0;  

  for(i=0;i<5;i++){  
   for(j=0;j<5;j++){  
     scanf("%d",&road[i][j]);  
   }  
  }  
    p.i=0;  
    p.j=0;  
    q.push(p);  
    visit[0][0]=1;  
    while(!q.empty())  
    {  
       p=q.front();  
       q.pop();  
       for(i=0;i<4;i++)  
       {  
            xx=p.i+dir[i][0];  
            yy=p.j+dir[i][1];  
            if(xx<0||xx>4||yy<0||yy>4)continue;  
            if(road[xx][yy]==0&&visit[xx][yy]==0)  
            {  
               visit[xx][yy]=visit[p.i][p.j]+1;  
               if(xx==4&&yy==4)  
               {  
                  len=visit[xx][yy];  
                  break;  
               }  
                Point newP;  
                newP.i=xx;  
                newP.j=yy;  
                q.push(newP);  
              }  
            }  
        }
	
       p.i=4,p.j=4;  //第二遍的bfs 
       for(i=len-1;i>=0;i--)  
       {  
        path[i].i=p.i;  
        path[i].j=p.j;  
        for(j=0;j<4;j++)  
          {  
            xx=p.i+dir[j][0];  
            yy=p.j+dir[j][1];  
            if(xx<0||xx>4||yy<0||yy>4)continue;  
            if((visit[xx][yy]==visit[p.i][p.j]-1))  
            {  
              p.i=xx;  
              p.j=yy;  
              break;  
            }  
  
          }  
        }  
       for(i=0;i<len;i++)  
       printf("(%d, %d)\n",path[i].i,path[i].j);  
        return 0;  
   }