K - 迷宫问题 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)

/*
* @Author: lyuc
* @Date:   2017-05-02 16:31:37
* @Last Modified by:   lyuc
* @Last Modified time: 2017-05-02 16:49:57
*/

#include <iostream>
#include <stdio.h>
#include <queue>
#include <string.h>
using namespace std;
struct node{
    int x,y;
    int step;
    node(){}
    node(int a,int b,int c){
        x=a;
        y=b;
        step=c;
    }
};
int dir[][]={{,},{-,},{,},{,-}};
int mapn[][];
int path[];//用来记录路径
bool vis[][];
bool ok(int x,int y){
    if(x<||x>=||y<||y>=||mapn[x][y]||vis[x][y]) return false;
    return true;
}
int bfs(){
    queue<node>q;
    node start,tmp;
    q.push(node(,,));
    vis[][]=true;
    while(!q.empty()){
        start=q.front();
        q.pop();
        if(start.x==&&start.y==)
            return start.step;
        for(int i=;i<;i++){
            tmp.x=start.x+dir[i][];
            tmp.y=start.y+dir[i][];
            tmp.step=start.step+;
            if(ok(tmp.x,tmp.y)==false){
                continue;
            }
            vis[tmp.x][tmp.y]=true;
            path[tmp.x*+tmp.y]=start.x*+start.y;

            q.push(tmp);
        }
    }
    return -;
}
void print(int u){
    if(path[u]==-){
        return;
    }
    print(path[u]);
    printf("(%d, %d)\n",u/,u%);

}
void init(){
    memset(vis,false,sizeof vis);
    memset(path,-,sizeof path);
}
int main(){
    // freopen("in.txt","r",stdin);
    while(scanf("%d",&mapn[][])!=EOF){
        init();
        for(int i=;i<;i++){
            scanf("%d",&mapn[][i]);
        }
        for(int i=;i<;i++){
            for(int j=;j<;j++){
                scanf("%d",&mapn[i][j]);
            }
        }
        bfs();
        puts("(0, 0)");
        print();
    }
    return ;
}