POJ - 3984 迷宫问题【bfs路径打印】

 K - 迷宫问题 POJ - 3984

定义一个二维数组：

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)

思路：这就是一个简单的bfs+路径打印，初学的小伙伴可以注意一下路径打印

#include<cstdio>
#include<cstdlib>
#include<cstring>
#include<cmath>
#include<queue>
#include<iostream>
#include<algorithm>
using namespace std;
int a[7][7];
int vis[7][7];
int X[5]= {0,1,-1,0,0};
int Y[5]= {0,0,0,-1,1};
int res=0x3f3f3f3f;
struct node
{
    int i;
    int j;
    int from;
} path[100];
int len;
queue<pair<pair<int,int>,int> >q;///通俗点说，这个定义了具有三个元素的结构体，故该队列就为结构体队列
int bfs(int x,int y)
{
    vis[x][y]=1;
    path[len].i=x;
    path[len].j=y;
    path[len].from=-1;
    q.push(make_pair(make_pair(x,y),len));
    while(!q.empty())
    {
        int x1=q.front().first.first;///取结构体第一个元素
        int y1=q.front().first.second;///取结构体第二个元素
        int tmp=q.front().second;///取第三个元素
        q.pop();
        if(x1==4&&y1==4)
        {
            return tmp;
        }
        for(int i=1; i<5; i++)
        {
            int xx=x1+X[i];
            int yy=y1+Y[i];
            if(xx>=0&&xx<5&&yy>=0&&yy<5&&vis[xx][yy]==0&&a[xx][yy]==0)
            {
                len++;
                path[len].i=xx;
                path[len].j=yy;
                path[len].from=tmp;
                vis[xx][yy]=1;
                q.push(make_pair(make_pair(xx,yy),len));
            }
        }
    }
    return -1;
}
void pri(int s)
{
    int tmp=s;
    int t=0;
    int num[100];
    num[t++]=tmp;
    while(path[tmp].from!=-1)///从后往前把所有路径上经过的点都保存到num数组中
    {
        num[t++]=path[tmp].from;
        tmp=path[tmp].from;
    }

    for(int k=t-1; k>=1; k--)
        printf("(%d, %d)\n",path[num[k]].i,path[num[k]].j);
    printf("(4, 4)\n");
}

int main()
{
    int n;
    while(~scanf("%d",&n))
    {
        a[0][0]=n;
        memset(vis,0,sizeof(vis));
        memset(path,0,sizeof(path));
        while(!q.empty())
            q.pop();
        len=0;
        for(int i=0; i<5; i++)
            for(int j=0; j<5; j++)
            {
                if(i==0&&j==0)
                    continue;
                else
                scanf("%d",&a[i][j]);
            }

        int res=bfs(0,0);
        pri(res);
    }

    return 0;
}