迷宫问题 (BFS之路径坐标)

C - 迷宫问题

定义一个二维数组：

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<iostream>
#include<cstring>
#include<vector>
#include<cstdio>
using namespace std;
int a[4]= {-1,1,0,0};
int b[4]= {0,0,-1,1}; //记录坐标上下左右变化
struct Point
{
    int x,y;//坐标位置
    int parent;//父结点位置
    int temp;//步数
    Point(int a,int b,int c,int d):x(a),y(b),parent(c),temp(d)
    {}
};
int maze[5][5];//原地图
int visit[5][5];//标记是否被访问
vector<Point> que;//用数组模仿队列
vector<Point> result;//存储最终路径
int minn;//保存最小步数
void bfs()
{
    que.push_back(Point(0,0,-1,0));//起始点的父结点为-1
    visit[0][0]=1;
    int cont=0;//记录当前搜索为数组的第几个元素
    while(1)
    {
        Point now=que[cont];
        if(now.x==4&&now.y==4)//找到最后一个结点
        {
            while(now.parent!=-1)
            {
                result.push_back(now);
                now=que[now.parent];
            }
            result.push_back(Point(0,0,-1,0));
            break;
        }
        else
        {
            for(int i=0; i<4; i++)
            {
                int nextx=now.x+a[i];
                int nexty=now.y+b[i];
                if(nextx<=4&&nextx>=0&&nexty<=4&&nexty>=0&&visit[nextx][nexty]==0&&maze[nextx][nexty]==0)//将符合条件的坐标入队列
                {
                    visit[nextx][nexty]=1;
                    que.push_back(Point(nextx,nexty,cont,que[cont].temp+1));
                }
            }
        }
        cont++;
    }
    minn=que[cont].temp;
}
int main()
{
    memset(visit,0,sizeof(visit));
    for(int i=0; i<5; i++)
        for(int j=0; j<5; j++)
            scanf("%d",&maze[i][j]);
    bfs();
    //输出最短路径坐标
    for(int i=result.size()-1; i>=0; i--)
        printf("(%d, %d)\n",result[i].x,result[i].y);
    //输出最短步数
    printf("%d\n",minn);
    return 0;
}