bfs—迷宫问题—poj3984

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 20591		Accepted: 12050

http://poj.org/problem?id=3984

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)

bfs过程中记录每个点的上一个点坐标，最后从终点找回到起点，利用栈逆序输出。

#include<iostream>
#include<cstring>
#include<string>
#include<queue>
#include<stack>
#include<set>
using namespace std;

const int MAX=5;
struct Node
{
    int x,y,pace;
    bool c;
    int prex,prey;//记录上一个点的坐标
}maze[MAX][MAX],t;
int dre[4][2]={{1,0},{-1,0},{0,1},{0,-1}};//方向

int main()
{
    for(int i=0;i<5;i++)
        for(int j=0;j<5;j++)
        {
            cin>>maze[i][j].c;
            maze[i][j].x=i;
            maze[i][j].y=j;
        }
    queue<Node> Q;
    stack<Node> St;
    int X,Y;
    Q.push(maze[0][0]);
    while(!Q.empty())
    {
        t=Q.front();
        if(t.x==4&&t.y==4)//到达右下角
        {
            St.push(t);
            while(t.x!=0||t.y!=0)//根据上一个点坐标把一条路所有点压入栈
            {
                t=maze[t.prex][t.prey];
                St.push(t);
            }
            while(!St.empty())//把点逆序输出
            {
                cout<<"("<<St.top().x<<", "<<St.top().y<<")
";
                St.pop();
            }
        }
        Q.pop();
        for(int i=0;i<4;i++)
        {
            X=t.x+dre[i][0];
            Y=t.y+dre[i][1];
            if(X>=0&&X<5&&Y>=0&&Y<5&&maze[X][Y].c==0&&!maze[X][Y].pace)
            {
                maze[X][Y].pace=t.pace+1;
                maze[X][Y].prex=t.x;//记录上一个点坐标
                maze[X][Y].prey=t.y;
                Q.push(maze[X][Y]);
            }
        }
    }
    return 0;
}