POJ 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)

一直很怕的迷宫问题，还是得多练啊

#include<iostream>
#include<cstdio>
#include<string.h>
#include<queue>
using namespace std;

int map[5][5];
int vis[5][5];
int dir[4][2]={{-1, 0}, {0, -1}, {1, 0}, {0, 1}};   //因为是从终点往起点搜，所以按逆时针方向走 

struct NODE{
    int x, y, no, next;    //结点x, y为坐标，no为该坐标在node[50]数组的下标，next为输出路径时下一个结点的下标 
}node[50];

void bfs(){
    int tot = 0;
    node[0].x = node[0].y = 4;
    node[0].no = node[0].next = 0;     //因为要正像输出路径，所以从终点反向往起点搜 
    queue<NODE> q;        //用于保存路径 
    q.push(node[0]);
    vis[4][4] = 1;        //标记已经走过的 

    while(!q.empty()){
        NODE now = q.front();
        q.pop();
        if (now.x == 0 && now.y == 0){    //到起点，则打印路径 
            int t = now.no;
            while(1){                 //因为node数组中每个结点中都有 
                printf("(%d, %d)\n", node[t].x, node[t].y); 
                if (!t)
                    return;
                t = node[t].next;
            }

        }

        for(int i = 0; i < 4; i++){
            int nx = now.x + dir[i][0];      //nx, ny下一节点坐标 
            int ny = now.y + dir[i][1];

            if (nx >= 0 && nx < 5 && ny >= 0 && ny < 5 && !map[nx][ny] && !vis[nx][ny]){
                vis[nx][ny] = 1;     //一个节点入队时，标记已经访问，并把该节点信息存入node数组 
                node[++tot].x = nx;
                node[tot].y = ny;
                node[tot].no = tot;
                node[tot].next = now.no;
                q.push(node[tot]);
            }
        }
    }
}

int main()
{
    memset(map, 0, sizeof(map));
    memset(vis, 0, sizeof(vis));
    memset(node, 0, sizeof(node));

    while(scanf("%d %d %d %d %d", &map[0][0], &map[0][1], &map[0][2], &map[0][3], &map[0][4])!=EOF){ 
        for (int i = 1; i < 5; i++)
            for (int j = 0; j < 5; j++)
                scanf("%d", &map[i][j]);

        bfs();
    } 
    return 0;
}