poj3984 迷宫问题

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)

思路:广搜,用pr表示前一个结点的位置.输出的时候把顺序正过来,再加上(0,0)和(4,4)就可以了.

代码:

#include <stdio.h>
#include <string.h>

struct Queue{
    int x;
    int y;
    int pr;
};

int maze[5][5],mark[5][5],head=0,tail=0;
struct Queue q[25];
int dir[4][2]={{-1,0},{1,0},{0,1},{0,-1}};


int main()
{
    int i,j,x2,y2,pr;
    int se[25];
    memset(mark,0,sizeof(mark));
    for(i=0;i<5;i++)
        for(j=0;j<5;j++)
        scanf("%d",&maze[i][j]);
    q[0].x=0;q[0].y=0;q[0].pr=0;
    tail++;
    mark[0][0]=1;

    while(head<tail){
    if(q[head].x==4&&q[head].y==4)
        break;

    for(int i=0;i<4;i++){
        x2=q[head].x+dir[i][0];
        y2=q[head].y+dir[i][1];
        if(x2<0||x2>4||y2<0||y2>4)
            continue;
        if(mark[x2][y2]==0&&maze[x2][y2]==0){
            q[tail].x=x2;
            q[tail].y=y2;
            q[tail].pr=head;
            tail++;
            mark[x2][y2]=1;
        }
    }
    head++;
    }
    printf("(0, 0)\n");
    pr=q[head].pr;i=0;
    while(pr!=0){
        se[i++]=pr;
        pr=q[pr].pr;
    }
    for(j=i-1;j>=0;j--){
        printf("(%d, %d)\n",q[se[j]].x,q[se[j]].y);
    }
    printf("(4, 4)\n");
    return 0;
}