迷宫问题 bfs输出路径

迷宫问题
原题链接https://vjudge.net/contest/345248#problem/Q


简单的bfs问题，其中关键在如何将正确路径输出
我们定义一个数组结构体，储存每一个数组的上一个位置，然后输出

#include<cstdio>
#include<cstring>
#include<cstdlib>
#include<cmath>
#include<iostream>
#include<algorithm>
#include<stack>
#include<queue>
using namespace std;
struct node
{
	long long x;
	long long y;
	long long step;
} t1,t2;
node ans[105];//储存路径
long long mv[4][2]= {1,0,-1,0,0,1,0,-1};
long long map[105][105];
long long vis[105][105];
void print(long long x)
{
	long long i;
	for(i=1;i<=x;i++)//输出
	{
		printf("(%lld, %lld)\n",ans[i].x,ans[i].y);
	}
	printf("(4, 4)\n");
	return ;
}
void bfs()
{
	t1.x=0;
	t1.y=0;
	t1.step=0;
	t2.x=4;
	t2.y=4;
	t2.step=0;
	long long cnt=0;
	queue<node>q;
	vis[0][0]=1;
	ans[t1.step]=t1;
	q.push(t1);
	node s,e;
	long long i;
	while(!q.empty())
	{
		s=q.front();
		q.pop();
		if(s.x==t2.x&&s.y==t2.y)
		{
			print(s.step);
			return ;
		}
		for(i=0; i<4; i++)
		{
			e.x=s.x+mv[i][0];
			e.y=s.y+mv[i][1];
			if(e.x<0||e.y<0||e.x>4||e.y>4||vis[e.x][e.y]==1||map[e.x][e.y]==1)
			{
				continue ;
			}
			e.step=s.step+1;
			vis[e.x][e.y]=1;
			ans[e.step]=s;//储存来源路径
			q.push(e);
		}
	}
}
int main()
{
	long long i,j;
	for(i=0; i<5; i++)
	{
		for(j=0; j<5; j++)
		{
			scanf("%lld",&map[i][j]);
		}
	}
/*	for(i=0; i<5; i++)
	{
		for(j=0; j<5; j++)
		{
			printf("%lld ",map[i][j]);
		}
		printf("\n");
	}*/
	bfs();
	return 0;
}