POJ 3984 迷宫问题

迷宫问题

定义一个二维数组： 

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>
#include <string>
#include <cstring>
#include <queue>
#include <cstdio>

using namespace std;

int maze[5][5];
int vis[5][5];
int dx[] = { 1,-1,0,0 };
int dy[] = { 0,0,1,-1 };
pair<int, int> father[6][6];    // father[i][j]表示点(i, j)的父节点的坐标 

struct node
{
    int x, y;
};

void print(pair<int,int> p)
{
    if (p.first == 0 && p.second == 0)
        return;
    else
    {
        print(father[p.first][p.second]);
        printf("(%d, %d)
", father[p.first][p.second].first, father[p.first][p.second].second);
    }
}


int main()
{
    for (int i = 0; i < 5; ++i)
        for (int j = 0; j < 5; ++j)
            cin >> maze[i][j];
    memset(vis, 0, sizeof(vis));

    node nod;
    nod.x = nod.y = 0;
    node t, p;
    queue<node> Q;
    Q.push(nod);
    vis[0][0] = 1;

    while (!Q.empty())
    {
        t = Q.front();
        Q.pop();

        if (t.x == 4 && t.y == 4)
        {
            print(make_pair(4, 4));
            cout << "(4, 4)" << endl;
            break;
        }

        for (int i = 0; i < 4; ++i)
        {
            int xx = t.x + dx[i];
            int yy = t.y + dy[i];

            if (xx >= 0 && xx < 5 && yy >= 0 && yy < 5 && maze[xx][yy] != 1 && !vis[xx][yy])
            {
                vis[xx][yy] = 1;
                p.x = xx;
                p.y = yy;
                father[p.x][p.y] = make_pair(t.x, t.y);
                Q.push(p);
            }
        }
    }


    return 0;
}