POJ 3984 迷宫问题(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<cstdio>
#include<queue>
#include<cstring>
using namespace std;

struct point
{
    int x;
    int y;
};

int d[4][2]={0,1,1,0,0,-1,-1,0};
int vis[6][6];
int maze[7][7];
point rec[5][5],a[26];

void bfs(int x,int y)
{
    queue<point>q;
    point init;
    init.x=init.y=0;
    q.push(init);
    vis[x][y]=1;
    while(!q.empty())
    {
        point t1,t2;
        t1=q.front();
        q.pop();
        if(t1.x==4&&t1.y==4)
        return;
        for(int i=0;i<4;i++)
        {
            t2.x=t1.x+d[i][0];
            t2.y=t1.y+d[i][1];
            if(t2.x>=0&&t2.x<5&&t2.y>=0&&t2.y<5)
            {
                if(!vis[t2.x][t2.y]&&maze[t2.x][t2.y]==0)
                {    
                    rec[t2.x][t2.y].x=t1.x;
                    rec[t2.x][t2.y].y=t1.y;
                    q.push(t2);
                    vis[t2.x][t2.y]=1;
                }
            }
        }
    }
}

int main()
{
    //freopen("in.txt","r",stdin);
    int i,j;
    memset(vis,0,sizeof(vis));
    for(i=0;i<5;i++)
    for(j=0;j<5;j++)
    scanf("%d",&maze[i][j]);
    bfs(0,0);
    int x=4,y=4,k=0;
    while(x!=0||y!=0)
    {
        a[k].x=x;
        a[k].y=y;
        point temp=rec[x][y];
        x=temp.x;
        y=temp.y;
        k++;
    }
    a[k].x=a[k].y=0;
    for(i=k;i>=0;i--)
    printf("(%d, %d)
",a[i].x,a[i].y);
    return 0;
}