poj3984 广度搜索BFS

  迷宫问题

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)

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
int map[5][5],len[30],front,sear,x,y,i,j;
struct que
{
   int x,y;
   int n;

}que[30];
int xx[]={1,0,-1,0};
int yy[]={0,1,0,-1};
int bfs()
{
    front=0;sear=0;len[0]=0;que[0].x=0;que[0].y=0;que[front].n=-1;
    while(front<=sear)
    {
        for(i=0;i<4;i++)
        {
            x=que[front].x+xx[i];
            y=que[front].y+yy[i];
            if(x>=0&&y>=0&&x<5&&y<5&&map[x][y]==0)
            {
                map[x][y]=1;
                que[++sear].x=x;
                que[sear].y=y;
                que[sear].n=front;
                len[sear]=len[front]+1;
                if(x==4&&y==4)return 1;
            }
        }
        front++;
    }
}

void myprintf(int x)
{
    if(x==-1)
    {
       return;
    }
    myprintf(que[x].n);
    printf("(%d, %d)
",que[x].x,que[x].y);
}

int main()
{

    for(i=0;i<5;i++)
    {
        for(j=0;j<5;j++)
        scanf("%d",&map[i][j]);
        getchar();
    }
    bfs();
    myprintf(sear);
    return 0;
}