A - 迷宫问题

 

Time Limit:1000MS     Memory Limit:65536KB     64bit IO Format:%I64d & %I64u

Submit Status Practice POJ 3984

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<string.h>
using namespace std;
int maze[5][5];
int q[10000];
int dx[4]={-1,1,0,0};
int dy[4]={0,0,-1,1};
int vis[5][5];
int fa[5][5],dist[5][5],dir[5][5];
int dirt[10000];
int zuobiao[10000];
void bfs(int x,int y)//(x,y)是起点
{
    int front=0,rear=0,d,u;
    u=5*x+y;
    vis[x][y]=1;fa[x][y]=u;dist[x][y]=0;
    q[rear++]=u;
    while(front<rear)
    {
        u=q[front++];
        x=u/5;y=u%5;
        if(x==4&&y==4) break;
        for(d=0;d<4;d++)
        {
            int nx=x+dx[d],ny=y+dy[d];
            if(nx>=0&&nx<5&&ny>=0&&ny<5&&!maze[nx][ny]&&!vis[nx][ny])
            {
                int v=nx*5+ny;
                q[rear++]=v;
                vis[nx][ny]=1;
                fa[nx][ny]=u;
                dist[nx][ny]=dist[x][y]+1;
                dir[nx][ny]=d;
            }
        }
    }
}

void print_path(int x,int y)
{
    int c=0;
    for(;;)
    {
        int fx=fa[x][y]/5;
        int fy=fa[x][y]%5;
        if(fx==x&&fy==y) break;
        dirt[c++]=dir[x][y];
        zuobiao[c-1]=fa[x][y];
        x=fx;
        y=fy;
    }
    printf("(0, 0)\n");
    while(c--)
        printf("(%d, %d)\n",zuobiao[c]/5+dx[dirt[c]],zuobiao[c]%5+dy[dirt[c]]);
}

int main()
{
    int i,j;
    for(i=0;i<5;i++)
        for(j=0;j<5;j++)
          {
            scanf("%d",&maze[i][j]);
          }
        bfs(0,0);
        print_path(4,4);
    return 0;
}