推箱子 bfs

推箱子
原题链接https://vjudge.net/contest/345248#problem/O


用bfs模拟推箱子的过程,对于箱子到达的位置以及人到达的位置都要判断，只有箱子能走，并且人能到达箱子的后面推它才能算对。
注意在进行箱子的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;//步数
	long long x1;//人上一次的位置
	long long y1;//人上一次的位置
} t1,t2,t3;
long long c;
long long n,m;
long long map[105][105];//地图
long long vis[105][105][5];//标记箱子
long long vis1[105][105];//标记人
long long mv[4][2]= {1,0,-1,0,0,1,0,-1};//方向
long long bfs1(node st,long long f)
{
	memset(vis1,0,sizeof(vis1));
	queue<node>tq;
	st.x-=mv[f][0];//找到要推箱子人要到达的位置
	st.y-=mv[f][1];
	tq.push(st);
	long long i;
	node s,e;
	while(!tq.empty())
	{
		s=tq.front();
		tq.pop();
		if(s.x1==st.x&&s.y1==st.y)//人能去推箱子
		{
			return 1;
		}
		for(i=0; i<4; i++)
		{
			e.x1=s.x1+mv[i][0];
			e.y1=s.y1+mv[i][1];
			//	printf("%lld %lld*****************\n",e.x1,e.y1);
			if(e.x1<0||e.y1<0||e.x1>n-1||e.y1>m-1||vis1[e.x1][e.y1]==1||map[e.x1][e.y1]==1||(e.x1==(st.x+mv[f][0])&&e.y1==(st.y+mv[f][1])))
			{
				continue;
			}
			vis1[e.x1][e.y1]=1;
			tq.push(e);
		}
	}
	return -1;
}
void bfs()
{
	queue<node>q;
	t1.x1=t3.x;//刚开始推箱子时人开始的位置
	t1.y1=t3.y;
	q.push(t1);
	node s,e;
	long long i,j;
	while(!q.empty())
	{
		s=q.front();
		q.pop();
		//	printf("%lld %lld***\n",s.x,s.y);
		if(s.x==t2.x&&s.y==t2.y)//箱子到到目的地
		{
			printf("%lld\n",s.step);
			c=1;
			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>n-1||e.y>m-1||vis[e.x][e.y][i]==1||map[e.x][e.y]==1)
			{
				continue;
			}
			if(s.x-mv[i][0]<0||s.y-mv[i][1]<0||s.x-mv[i][0]>n-1||s.y-mv[i][1]>m-1||map[s.x-mv[i][0]][s.y-mv[i][1]]==1)
			{
				continue;
			}
			long long p=bfs1(s,i);
			if(p==-1)
			{
				continue;
			}
			e.x1=s.x;//记录推了箱子之后人的位置
			e.y1=s.y;
			vis[e.x][e.y][i]=1;
			e.step=s.step+1;
			q.push(e);
		}
	}
}
int main()
{
	long long t;
	scanf("%lld",&t);
	while(t--)
	{
		memset(map,0,sizeof(map));
		memset(vis,0,sizeof(vis));
		scanf("%lld %lld",&n,&m);
		long long i,j;
		c=0;
		for(i=0; i<n; i++)
		{
			for(j=0; j<m; j++)
			{
				scanf("%lld",&map[i][j]);
				if(map[i][j]==2)//箱子起始位置
				{
					t1.x=i;
					t1.y=j;
					t1.step=0;
				}
				if(map[i][j]==3)//目标位置
				{
					t2.x=i;
					t2.y=j;
					t2.step=0;
				}
				if(map[i][j]==4)//人起始位置
				{
					t3.x=i;
					t3.y=j;
					t3.step=0;
				}
			}
		}
		/*	for(i=0; i<n; i++)
			{
				for(j=0; j<m; j++)
				{
					printf("%lld",map[i][j]);
				}
				printf("\n");
			}*/
		bfs();
		if(c==0)
		{
			printf("-1\n");
		}
	}
	return 0;
}