poj3984迷宫问题 广搜+最短路径+模拟队列

转自：http://blog.csdn.net/no_retreats/article/details/8146585

 

定义一个二维数组：

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<iostream>
 using namespace std;
 int map[][];
 int vis[][];
 struct node{
     int x;
     int y;
     int pre;
 }edge[];
 int front=,rear=;//队头，队尾
 int dir[][]={{,-},{,},{,},{-,}};
 void f(int i)//倒向追踪法
 {
     if(edge[i].pre!=-)
     {
         f(edge[i].pre);
         cout<<"("<<edge[i].x<<", "<<edge[i].y<<")"<<endl;
     }
 }
 void BFS(int x,int y)
 {
     edge[front].x=x;
     edge[front].y=y;
     edge[front].pre=-;
     while(front<rear)//队列为空时终止
     {
         int u;
         for(u=;u<;u++)
         {
             int x=edge[front].x+dir[u][];
             int y=edge[front].y+dir[u][];
             if(x<||x>=||y<||y>=||vis[x][y]==||map[x][y]==)
                 continue;
             else
             {
                 vis[x][y]=;
                 map[x][y]=;
                 edge[rear].x=x;//入队
                 edge[rear].y=y;
                 edge[rear].pre=front;
                 rear++;
             }
             if(x==&&y==)
                 f(front);
         }
         front++;//出队
     }
 }
 int main()
 {
     int i,j;
     for(i=;i<;i++)
     {
         for(j=;j<;j++)
         {
             cin>>map[i][j];
         }
     }
     memset(vis,,sizeof(vis));
     cout<<"("<<"0, 0)"<<endl;
     BFS(,);
     cout<<"(4, 4)"<<endl;
     return ;
 }