POJ—3984 迷宫问题

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 22710		Accepted: 13239

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)

Source

BFS搜索保存路径并用递归输出路径

#include<iostream>
#include<stdio.h>
#include<queue>
#include<string.h>
#define INF 1000
using namespace std;
int Map[5][5];
int d[5][5];
int dt[4][2]={{1,0},{-1,0},{0,1},{0,-1}};
typedef pair<int,int> P;
struct node
{
    int x,y;
}v[5][5];
void dfs(int x,int y)
{
    if(x==0&&y==0)
        return;
    dfs(v[x][y].x,v[x][y].y);
    printf("(%d, %d)\n",v[x][y].x,v[x][y].y);
}
void bfs()
{
    for(int i=0;i<5;i++)
    {
        for(int j=0;j<5;j++)
            d[i][j]=INF;
    }
    d[0][0]=0;
    queue<P> que;
    que.push(P(0,0));
    while(que.size())
    {
        P p=que.front();
        que.pop();
        for(int i=0;i<4;i++)
        {
            int nx=p.first+dt[i][0];
            int ny=p.second+dt[i][1];
            if(nx>=0&&nx<5&&ny>=0&&ny<5&&Map[nx][ny]==0&&d[nx][ny]==INF)
            {
                que.push(P(nx,ny));
                d[nx][ny]=d[p.first][p.second]+1;
                v[nx][ny].x=p.first;
                v[nx][ny].y=p.second;
            }
        }
    }
    dfs(4,4);
    printf("(%d, %d)\n",4,4);
}
int main()
{
    int i,j;
    for(i=0;i<5;i++)
    {
        for(j=0;j<5;j++)
        {
            scanf("%d",&Map[i][j]);
        }
    }
    bfs();
}