K - 迷宫问题

题意：一个5*5的矩阵从左上角（0,0）到右下角（4,4）的最短路径  0代表可走 1代表障碍不能走

思路：用pair存坐标放在queue中用于广搜  同时用一个结构体记录每个点的前一个结点  最后处理下输出即可

#include<cstdio>
#include<algorithm>
#include<cstring>
#include<iostream>
#include<queue>
#include<vector>
using namespace std;
#define maxn 6
int maps[maxn][maxn];
bool vis[maxn][maxn];
struct paths
{
	int x, y;
}path[maxn][maxn],pathback[100];//path[maxn][maxn]广搜时候用于记录前一个点的坐标  
								//pathback用于最后的输出
int go[4][2]={{1,0},{-1,0},{0,-1},{0,1}};

void bfs()
{
	queue<pair<int ,int > >q;
	q.push(make_pair(0,0));
	vis[0][0]=true;
	path[0][0].x=0;
	path[0][0].y=0;

	while(!q.empty())
	{
		pair<int ,int > p;
		p=q.front();
		q.pop();
		for(int i=0;i<4;i++)
		{
			int x=p.first+go[i][0];
			int y=p.second+go[i][1];
			if(x>=0&&x<5&&y>=0&&y<5&&!vis[x][y]&&maps[x][y]==0)
			{
				path[x][y].x=p.first;
				path[x][y].y=p.second;
				vis[x][y]=true;
				q.push(make_pair(x,y));
			}
		}
	}
}
int main()
{
	memset(vis,0,sizeof vis);
	for(int i=0;i<5;i++)
		for(int j=0;j<5;j++)
		scanf("%d",&maps[i][j]);
		bfs();
		int tot=0;
		int m=4,n=4;
		pathback[tot].x=4;
		pathback[tot++].y=4;
	while(1)
	{
		pathback[tot].x=path[m][n].x;
		pathback[tot++].y=path[m][n].y;
		if(path[m][n].x==0&&path[m][n].y==0)break;
		int a=m,b=n;
		m=path[a][b].x;
		n=path[a][b].y;

	}
	for(int i=tot-1;i>=0;i--)
		printf("(%d, %d)\n",pathback[i].x,pathback[i].y);
    return 0;
}