poj 3984 迷宫问题

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 16238		Accepted: 9692

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 <algorithm>
#include <queue>
using namespace std;
typedef struct node{
    int x, y;
    struct node *pre;
} Node;
int a[5][5];
int visit[5][5];

int dir_dx[4] = {-1, 0, 1, 0};//方向数组
int dir_dy[4] = {0, 1, 0, -1};

void path(Node *p){//递归输出结果
    if(p == NULL)
        return;
    //if(p.x == 0 && p.y == 0)
    //    printf("(%d, %d)\n", p.x, p.y);
    path(p->pre);
    printf("(%d, %d)\n", p->x, p->y);

}

int main(){
    int i, j, start = 0, w = 1, dx, dy;
    for(i = 0; i < 5; i++)
        for(j = 0; j < 5; j++)
            cin >> a[i][j];
    Node que[1000], temp;
    Node st;//初始状态节点
    st.x = 0;
    st.y = 0;
    st.pre = NULL;
    que[start] = st;
    visit[0][0] = 1;
    while(!(que[start].x == 4 && que[start].y == 4)){
        temp = que[start];
        for(i = 0; i < 4; i++){
            dx = temp.x + dir_dx[i];
            dy = temp.y + dir_dy[i];
            if(dx >= 0 && dx < 5 && dy >= 0 && dy < 5 && a[dx][dy] == 0 && visit[dx][dy] == 0){
                visit[dx][dy] = 1;
                Node t;
                t.x = dx; t.y = dy; 
                t.pre = &que[start];//如果t.pre = &temp,则出错 
                que[w++] = t;
            }
        }
        start++;
    }
    path(&que[start]);
    return 0;
}