迷宮問題（bfs+記錄路徑）

題目鏈接：http://acm.hust.edu.cn/vjudge/contest/view.action?cid=105278#problem/K

K - 迷宮問題

Time Limit:1000MS     Memory Limit:65536KB     64bit IO Format:%I64d & %I64u

Submit  Status

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<cstdio>
#include<cstring>
#include<stack>
#include<queue>
#include<string>
using namespace std;
int mp[5][5];
struct Node{
    int x;
    int y;
};
Node fa[5][5];
bool vis[5][5];
bool ck(Node k)
{
    if(k.x<=4&&k.x>=0&&k.y>=0&&k.y<=4) return true;
    return false;
}

int go[4][2] = {{1,0},{-1,0},{0,1},{0,-1}};

void bfs(){
    queue<Node>q;
    memset(vis,0,sizeof(vis));
    Node tm;
    tm.x = 0;
    tm.y = 0;
    q.push(tm);
    vis[0][0] = 1;
    while(!q.empty()){
        Node tm1 = q.front();q.pop();
        Node fl;
        for(int i = 0; i < 4; i++){
            fl.x = tm1.x+go[i][0];
            fl.y = tm1.y+go[i][1];
            if(ck(fl)&&vis[fl.x][fl.y]==0&&mp[fl.x][fl.y]==0){
                q.push(fl);
                vis[fl.x][fl.y] = 1;
                fa[fl.x][fl.y] = tm1;
            }
        }
    }
}

int main()
{
    for(int i = 0; i < 5; i++)
        for(int j = 0; j < 5; j++)
            scanf("%d",&mp[i][j]);
    bfs();
    stack<Node>v;
    Node ff = fa[4][4];
    while(!(ff.x==0&&ff.y==0)){
        v.push(ff);
        ff = fa[ff.x][ff.y];
    }
    printf("(0, 0)\n");
    while(!v.empty()){
        printf("(%d, %d)\n",v.top().x,v.top().y);
        v.pop();
    }
    printf("(4, 4)\n");
    return 0;
}