POJ 3984 迷宫问题

迷宫问题
Time Limit: 1000MS Memory Limit: 65536K
Total Submissions: 9877 Accepted: 5848
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)

这题如果不用输出路径就是一道很简单的广搜题，但是要输出路径，那怎么办。。。。。。。

一下午在看了别人的思路后想出了怎么把路径加上去，，，在看了很多篇博客之后，终于得出了这道题要怎么记录路径了。

广搜记录到达每一位置的距离和标记已走过的点，再加一个数组，记录这一点的下一个点是谁，（因为数组只能记录一个下一个点的值，而一个点能有4情况向周围走，怎么办呢，不要记录这一个点的下一个点是什么，用pre【】【】数组记录每一个点是从哪个点过来的；

到最后当点走到了右下角的点的位置的时候，从这最后一个点往回走，通过pre数组，就可以找到从左上角的点到右下角的点是怎么一条路径了；

由于是从最后一个点往回遍历的，输出要求从原始点到尾点的路径，这时候就把栈请出来，从右下角开始的点一个一个压入栈中，直到回溯得点到了0点结束；

最后一步，出栈并输出，一次过。

#include <iostream>
#include <cstring>
#include <cstdio>
#include <queue>
#include <stack>
using namespace std;
struct point
{
    int x,y;
}pre[105][105],point;
int a[105][105],b[105][105];
int main(void)
{
   // freopen("E.txt","r",stdin);
    for(int i=0;i<5;i++)
    {
        for(int j=0;j<5;j++)
            scanf("%d",&b[i][j]);
    }
  /* for(int i=0;i<5;i++)
    {
        for(int j=0;j<5;j++)
            printf("%d",b[i][j]);
            printf("\n");
    }*/
    point.x=0;
    point.y=0;
    queue<struct point>p;
    stack<struct point>q;
    p.push(point);
    b[0][0]=1;
    while(!p.empty())
    {
        struct point tmp;
        tmp.x=p.front().x;tmp.y=p.front().y;
        p.pop();
        if(tmp.x==4&&tmp.y==4)
        {
            struct point d;
            d.x=tmp.x;d.y=tmp.y;
            q.push(d);
             break;
        }
        if(a[tmp.x+1][tmp.y]<=1000&&b[tmp.x+1][tmp.y]==0&&tmp.x+1<=4&&tmp.y<5)
        {
            b[tmp.x+1][tmp.y]=1;
            a[tmp.x+1][tmp.y]=a[tmp.x][tmp.y]+1;
            pre[tmp.x+1][tmp.y].x=tmp.x;pre[tmp.x+1][tmp.y].y=tmp.y;
            struct point t;
            t.x=tmp.x+1;t.y=tmp.y;p.push(t);
        }
        if(a[tmp.x-1][tmp.y]<=1000&&b[tmp.x-1][tmp.y]==0&&tmp.x-1>=0&&tmp.y<5)
        {
            b[tmp.x-1][tmp.y]=1;
            a[tmp.x-1][tmp.y]=a[tmp.x][tmp.y]+1;
            pre[tmp.x-1][tmp.y].x=tmp.x;pre[tmp.x-1][tmp.y].y=tmp.y;
             struct point t;
            t.x=tmp.x-1;t.y=tmp.y;p.push(t);
        }
        if(a[tmp.x][tmp.y+1]<=1000&&b[tmp.x][tmp.y+1]==0&&tmp.x+1<=4&&tmp.y<5)
        {
            b[tmp.x][tmp.y+1]=1;
            a[tmp.x][tmp.y+1]=a[tmp.x][tmp.y]+1;
            pre[tmp.x][tmp.y+1].x=tmp.x;pre[tmp.x][tmp.y+1].y=tmp.y;
             struct point t;
            t.x=tmp.x;t.y=tmp.y+1;p.push(t);
        }
        if(a[tmp.x][tmp.y-1]<=1000&&b[tmp.x][tmp.y-1]==0&&tmp.x<=4&&tmp.y-1>=0)
        {
            b[tmp.x][tmp.y-1]=1;
            a[tmp.x][tmp.y-1]=a[tmp.x][tmp.y]+1;
            pre[tmp.x][tmp.y-1].x=tmp.x;pre[tmp.x][tmp.y-1].y=tmp.y;
             struct point t;
            t.x=tmp.x;t.y=tmp.y-1;p.push(t);
        }

    }
    while(q.top().x!=0||q.top().y!=0)
    {
        q.push(pre[q.top().x][q.top().y]);
    }
    p.push(point);
    while(!q.empty())
    {
        printf("(%d, %d)\n",q.top().x,q.top().y);
        q.pop();
    }
    return 0;
}