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[4][2]={{1,0},{-1,0},{0,1},{0,-1}};
int mapn[7][7];
int path[30];//用来记录路径
bool vis[7][7];
bool ok(int x,int y){
    if(x<0||x>=5||y<0||y>=5||mapn[x][y]||vis[x][y]) return false;
    return true; 
}
int bfs(){
    queue<node>q;
    node start,tmp;
    q.push(node(0,0,0));
    vis[0][0]=true;
    while(!q.empty()){
        start=q.front();
        q.pop();
        if(start.x==4&&start.y==4)
            return start.step;
        for(int i=0;i<4;i++){
            tmp.x=start.x+dir[i][0];
            tmp.y=start.y+dir[i][1];
            tmp.step=start.step+1;
            if(ok(tmp.x,tmp.y)==false){
                continue;    
            } 
            vis[tmp.x][tmp.y]=true;
            path[tmp.x*5+tmp.y]=start.x*5+start.y;

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

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