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)
题意：从题目应该能够理解。
思路：利用广搜（BFS），从0,0开始一层层的搜索，直到找到4,4这个点结束。不过此时要记录每个点的编号，方便最后的输出，当然也可以用链表，把子节点的指针指向根节点，最后再输出。
完整代码如下

#include<stdio.h>
#include<string.h>
#define MAX 6
struct coord{
    int x,y;
    int f;//记录该坐标的父亲在队列中的坐标，方便输出 
};
int main(void)
{
    struct coord s[50];//创建队列 
    int i,j,k;
    int map[MAX][MAX] = {0},book[MAX][MAX]= {0};
    int next[4][2] = {{0,1},{1,0},{0,-1},{-1,0}};//按瞬时针，右下左上进行搜索。 
    for(i=0;i<=4;i++)
    {
        for(j=0;j<=4;j++)
            scanf("%d",&map[i][j]);
    }
    int head = 1,tail = 1;//队列初始化 
    s[tail].x = 0;s[tail].y = 0;//把起点坐标0,0放入队列中。 
    s[tail].f = 0;//此坐标为起点，因此他没有父亲，设为0
    tail++;
    int tx,ty;//临时搜索坐标。 
    while(head < tail)
    {
        for(k=0;k<4;k++)//从根节点向四周扩展。 
        {
            tx = s[head].x + next[k][0];
            ty = s[head].y + next[k][1];
            if(tx < 0 || tx > 4 || ty < 0 || ty > 4)//是否越过边界 
                continue;
            if(book[tx][ty] == 0 && map[tx][ty] == 0)   
            {
                book[tx][ty] = 1;//把符合的坐标放入队列中 
                s[tail].x = tx;
                s[tail].y = ty;
                s[tail].f = head;
                tail++; 
            }
            if(tx == 4 && ty == 4)//如果找到该坐标则停止 
                break;
        }
        if(k < 4)//如果找到该坐标，for会break，此时k<4，则此时跳出外循环。 
            break;
        head++;//根节点舍去 
    }
    int t = tail-1;//此时最后一个点的编号 
    int left[30],right[30],top = 0;//由于是逆序的故创建一个堆栈,把左右左边压入堆栈中。 
    while(t != 0)//起始坐标的父亲为0 
    {
        left[top] = s[t].x;
        right[top] = s[t].y;
        t = s[t].f;top++;
    }
    for(i=top-1;i>0;i--)//把堆栈中坐标输出 
        printf("(%d, %d)\n",left[i],right[i]);
    printf("(%d, %d)",left[0],right[0]);
    return 0;
}