迷宫问题
原题链接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;
}