- 迷宫问题 POJ - 3984 bfs记录路径并输出最短路径

定义一个二维数组：

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<string.h>
#include<algorithm>
#include<iostream>
#include<queue>
using namespace std;
struct shu
{
    int y,x,step;
}str1,str2;
int a,s,d,f,g,q[10][10],v[10][10],w[10][10],z[25],c[25];
int p[4][2]={{1,0},{0,1},{-1,0},{0,-1}};
void bfs()
{
    int xx,yy,x,y;
    queue<shu>r;
    r.push(str1);
    while(!r.empty())
    {
        str1=r.front();
        r.pop();
        if(str1.y==4 && str1.x==4)
        {
            xx=q[str1.y][str1.x]%10;
            yy=(q[str1.y][str1.x]-xx)/10;
            while(1)  //while循环找寻路径
            {
                z[g]=yy;c[g]=xx;
                g++;
                if(q[yy][xx]==0)
                {
                    break;
                }
                x=q[yy][xx]%10;   //找到这一个点的前一个点的坐标(因为我们之前维护过，所以用同样方式找寻点坐标)
                y=(q[yy][xx]%100-x)/10;
                yy=y;
                xx=x;
            }
            while(!r.empty())
                r.pop();
            return;
        }
        str2.step=str1.step+1;
        for(int i=0;i<4;++i)
        {

            str2.y=str1.y+p[i][1];
            str2.x=str1.x+p[i][0];
            if(str2.y<0 || str2.x<0 || str2.y>=5 || str2.x>=5) continue;
            if(v[str2.y][str2.x]==0 && w[str2.y][str2.x]==0)
            {
                q[str2.y][str2.x]=str1.y*10+str1.x;  //把它的前一个点的坐标维护成一个唯一值
                w[str2.y][str2.x]=1;
                r.push(str2);
                /*
                除了这一种方式之外，我们还可以定义一个结构体专门保存上一个点的坐标
                
                */
            }
        }
    }
}
int main()
{
    g=0;
    for(int i=0; i<5;++i)
    {
        for(int j=0; j<5 ;++j)
        {
            scanf("%d",&v[i][j]);
        }
    }
    q[0][0]=0;
    str1.x=0;
    str1.y=0;
    str1.step=0;
    w[0][0]=1;
    bfs();
    printf("(0, 0)\n");
    for(int i=g-1;i>=0;--i)
    {
        printf("(%d, %d)\n",z[i],c[i]);
    }
    printf("(4, 4)\n");
    return 0;
}