Week2 HomeWork A Maze BFS+路径输出

题目描述

东东有一张地图，想通过地图找到妹纸。地图显示，0表示可以走，1表示不可以走，左上角是入口，右下角是妹纸，这两个位置保证为0。既然已经知道了地图，那么东东找到妹纸就不难了，请你编一个程序，写出东东找到妹纸的最短路线。

Input

输入是一个5 × 5的二维数组，仅由0、1两数字组成，表示法阵地图。

Output

输出若干行，表示从左上角到右下角的最短路径依次经过的坐标，格式如样例所示。数据保证有唯一解。

Sample Input

0 1 0 0 0
0 1 0 1 0
0 1 0 1 0
0 0 0 1 0
0 1 0 1 0

Sample Output

(0, 0)
(1, 0)
(2, 0)
(3, 0)
(3, 1)
(3, 2)
(2, 2)
(1, 2)
(0, 2)
(0, 3)
(0, 4)
(1, 4)
(2, 4)
(3, 4)
(4, 4)

Hint

坐标(x, y)表示第x行第y列，行、列的编号从0开始，且以左上角为原点。

另外注意，输出中分隔坐标的逗号后面应当有一个空格。

算法分析

​ 这题求最短路径，优先想到BFS（宽度优先搜索）。另外，本题涉及路径输出。只需在一般的BFS基础上，再维护pre记录当前点的前驱节点，最后通过递归输出即可。

代码

#include <cstdio>
#include <iostream>
#include <algorithm>
#include <queue>
#include <vector> 
#include <cstring>
using namespace std;

struct Point {
	int x,y; //点坐标 
	int step; //记录步数 
	int N,pre; //标记点序号及前序节点 
};
int mp[6][6];  //记录输入的地图信息 
int dir[4][2] = {{1,0},{-1,0},{0,1},{0,-1}}; //方向数组 

bool vis[6][6]; //标记点的访问状态 

queue<Point> Q; //bfs使用的队列 
vector<Point> v; //记录路径的向量 

void output(int N)
{//递归输出路径 
	if(N == 0) 
	{
		cout << "(0, 0)" << endl; return;
	}
	output(v[N].pre);
	cout << "(" << v[N].x-1<< ", " <<v[N].y-1<<")"<< endl;
}

void bfs()
{
	vis[1][1] = true; //出发点 
	Point n1;  
	n1.x = 1, n1.y = 1, n1.step = 1, n1.N = 0, n1.pre = 0;
	Q.push(n1);  //起点入队 
	v.push_back(n1); //起点计入向量 
	int NO = 0; //点序号 
	while(!Q.empty())  //队列非空 
	{
		Point n2 = Q.front();  //n2表示前一个点，n1表示当前点  
		Q.pop();   //取岀队首元素 
		for(int i = 0; i < 4; i++) //遍历四个方向 
		{
			n1.x = n2.x + dir[i][0];
			n1.y = n2.y + dir[i][1];
			if(n1.x > 0 && n1.y > 0 && n1.x <= 5 && n1.y <= 5 &&
				!mp[n1.x][n2.y] && !vis[n1.x][n1.y]) //在边界内，且地图上该点可通且未访问过， 
			{
				vis[n1.x][n1.y] = true;
				n1.step = n2.step + 1;
				NO++;
				n1.N = NO;
				n1.pre = n2.N;
				Q.push(n1);
				v.push_back(n1);
				if(n1.x == 5 && n1.y == 5) //走到终点结束BFS过程，直接输出即为最短路径 
				{
					output(n1.N);
					return;
				}
			}
		}
	}
}

int main()
{
	//初始化 
	memset(vis,false,sizeof(vis));
	memset(mp,-1,sizeof(mp));
	
	for(int i = 1; i <= 5; i++)
		for(int j = 1; j <= 5; j++)
			cin >> mp[i][j];
	bfs();
	return 0;
}