迷宫问题

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)

bfs 记录前驱节点，递归输出

AC代码

/*************************************************************************
    > File Name: migong.cpp
    > Author: YinJianxiang
    > Mail: YinJianxiang123@gmail.com 
    > Created Time: 2017年06月24日 星期六 08时20分40秒
 ************************************************************************/

#include<stdio.h>  
  
int maze[5][5];  
  
typedef struct node{  
    int x;  
    int y;  
    int pre;  
}Queue;  
  
int dx[] = {1,0,0,-1};  
int dy[] = {0,1,-1,0};  
  
Queue queue[20001];  
  
int isSafe(int x,int y) {  
    if(x < 0 || x >= 5 || y < 0 || y >= 5 || maze[x][y] == 1) {  
        return 0;  
    }  
      
    return 1;  
}  
  
void print(int last) {  
    if(queue[last].pre != -1) {  
        print(queue[last].pre);  
          
        printf("(%d, %d)\n",queue[last].x,queue[last].y);  
    }  
}  
  
void bfs(int x,int y) {  
    int front = 0;  
    int rear = 0;  
    int i;  
    int next_x;  
    int next_y;  
      
    queue[front].x = x;  
    queue[front].y = y;  
    queue[front].pre = -1;  
    rear++;  
    maze[x][y] = 1;  
      
    while(front < rear) {  
        for(i = 0;i < 4;i++) {  
            next_x = queue[front].x + dx[i];  
            next_y = queue[front].y + dy[i];  
            if(isSafe(next_x,next_y)) {  
                maze[next_x][next_y] = 1;  
                queue[rear].x = next_x;  
                queue[rear].y = next_y;  
                queue[rear].pre = front;  
                rear++;  
            }  
            if(next_x == 4 && next_y == 4) {  
                print(rear - 1);  
            }  
        }      
        front++;  
    }  
}  
  
int main(void) {  
  
    int i;  
    int j;  
      
    for(i = 0;i < 5;i++) {  
        for(j = 0;j < 5;j++) {  
            scanf("%d",&maze[i][j]);  
        }  
    }  
      
    printf("(0, 0)\n");    
    bfs(0,0);    
      
    return 0;  
}