迷宫问题 （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)

• 解题思路：

bfs,用pre记录上一个位置，最后用回溯的方法输出路径。

• 代码:

#include<cstdio>
#include<queue>
#include<cstring>
#include<iostream>
using namespace std;
int b[][];
int a[][];
int next[][]={{,},{-,},{,},{,-}};
struct node
{
    int x,y;
    int pre;
}que[];
int tx,ty;

void print(int s)
{
    if(que[s].pre!=-)
    {
        print(que[s].pre);
        printf("(%d, %d)\n",que[s].x,que[s].y);
    }
}

void bfs(int x,int y)
{
    int head=,tail=;
    que[tail].x=x;
    que[tail].y=y;
    que[tail].pre=-;
    tail++;
    while(head<tail)
    {
        for(int i=;i<;i++)
        {
            tx=que[head].x+next[i][];
            ty=que[head].y+next[i][];
            if(tx<||tx>=||ty<||ty>=)continue;
            if(b[tx][ty]==&&a[tx][ty]==)
            {
                b[tx][ty]=;
                que[tail].x=tx;
                que[tail].y=ty;
                que[tail].pre=head;
                tail++;
            }
            if(tx==&&ty==)
                print(head);
        }
        head++;
    }
}

int main()
{
    for(int i=;i<;i++)
    {
        for(int j=;j<;j++)
        {
            scanf("%d",&a[i][j]);
        }
    }
    memset(b,,sizeof(b));
    b[][]=;
    printf("(0, 0)\n");
    bfs(,);
    printf("(4, 4)\n");
    return ;
}