poj 3984 迷宫问题

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 10528		Accepted: 6260

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)

Source

bfs。路径打印比较麻烦，借鉴栈的思想。

#include <cstdio>
#include <cstring>
#include <string>
#include <queue>
#include <stack>
#include <algorithm>
#include <iostream>
using namespace std;
int map[6][6];
int fa[30];
int dx[4]={-1,1,0,0};//上下左右
int dy[4]={0,0,-1,1};
int main(){
    //freopen("D:\INPUT.txt","r",stdin);
    int i,j;
    for(i=0;i<5;i++){
        for(j=0;j<5;j++){
            scanf("%d",&map[i][j]);
        }
    }
    queue<int> q;
    q.push(0*5+0);
    map[0][0]=1;//已经访问过
    int now;
    while(!q.empty()){
        now=q.front();
        q.pop();
        int x=now/5;
        int y=now%5;
        if(x==4&&y==4){
            break;
        }
        for(i=0;i<4;i++){
            int xx=x+dx[i];
            int yy=y+dy[i];
            if(xx>=0&&xx<5&&yy>=0&&yy<5&&!map[xx][yy]){
                map[xx][yy]=1;
                fa[xx*5+yy]=x*5+y;//保存父节点
                q.push(xx*5+yy);
            }
        }
    }
    int x=4,y=4;
    int print[30];
    i=0;
    while(x||y){
        now=x*5+y;
        print[i++]=now;
        int f=fa[now];
        x=f/5;
        y=f%5;
    }
    print[i]=0;
    for(;i>=0;i--){
        printf("(%d, %d)
",print[i]/5,print[i]%5);
    }
    return 0;
}