HDU 1254 推箱子（双层BFS）

题目链接：http://acm.hdu.edu.cn/showproblem.php?pid=1254

题意：问能把箱子推到指定位置，箱子最少走几步

思路：分成2部分 ，首先bfs 搜索箱子能够移动到的地方 然后对人进行bfs 看人是否能走到箱子边上 并且让箱子移动到新的位置  

用vis[30][30][30][30]去标记 当人在某个位置箱子在某个位置时的状态     一共有8*8*8*8种状态

AC代码： 

#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
#include<algorithm>
using namespace std;
int map[30][30],vis[30][30][30][30];//vis前两个是箱子的位置，后面是人的位置 
int pvis[30][30];
int d[4][2]={{0,1},{0,-1},{1,0},{-1,0}};
int m,n;
struct per
{
	int x;
	int y;
}pq,ptemp;
struct box
{
	int x;
	int y;
	int px;
	int py;
	int step;
}q,temp;
int  judge(int x,int y)
{
	if(x<=0||x>m||y<=0||y>n||vis[x][y][temp.px][temp.py]==1||map[x][y]==1)
	return 0;
	else return 1;
}
int  bfs1(int x,int y,int f)
{
	int i,j;
	memset(pvis,0,sizeof(pvis));
	queue<struct per>que;
	pq.x=temp.px;
	pq.y=temp.py;
	pvis[pq.x][pq.y]=1;
	que.push(pq);
	while(!que.empty())
	{
		ptemp=que.front();
		que.pop();
		if(ptemp.x==temp.x-d[f][0]&&ptemp.y==temp.y-d[f][1])//如果人可以移动到推箱子的位置 
		{
			return 1;
		}
		for(i=0;i<4;i++)
		{
			int tx=ptemp.x+d[i][0];
			int ty=ptemp.y+d[i][1];
			if(tx>0&&tx<=m&&ty>0&&ty<=n&&map[tx][ty]!=1&&pvis[tx][ty]==0&&(tx!=temp.x||ty!=temp.y))
			                                                         //要保证人和箱子不重合 
			{ 
				pq.x=tx;
				pq.y=ty;
				pvis[pq.x][pq.y]=1;
				que.push(pq);
				
			}
		}
	}
	return 0;   //这里不要忘了，如果找不到 返回0 
}
void bfs()
{
	int i,j;

	q.step=0;
	queue<struct box>que;
	que.push(q);
	vis[q.x][q.y][q.px][q.py]=1;
	while(!que.empty())
	{
	 temp=que.front();
		que.pop();
		if(map[temp.x][temp.y]==3) 
		{
			printf("%d\n",temp.step);
			return;
		}
		for(i=0;i<4;i++)
		{
			int tx=temp.x+d[i][0];
			int ty=temp.y+d[i][1];
			if(judge(tx,ty))//如果箱子能够移动
			{
				if(bfs1(tx,ty,i))//如果这次移动可以由人推着 
				{
					vis[tx][ty][temp.px][temp.py]=1;
					q.x=tx;
					q.y=ty;
					q.step=temp.step+1;
					q.px=temp.x;//移动后人的位置就是箱子之前的位置 
					q.py=temp.y;
					que.push(q);
				}
			}
		}
	}
	printf("-1\n");
}
int main()
{
	int t;
	cin>>t;
	while(t--)
	{
		memset(vis,0,sizeof(vis));
		cin>>m>>n;
		for(int i=1;i<=m;i++)
		{
			for(int j=1;j<=n;j++)
			{
				scanf("%d",&map[i][j]);
				if(map[i][j]==2) //安排箱子初始位置 
				{
					q.x=i;
					q.y=j;
				}
				else if(map[i][j]==4)//安排人的初始位置 
				{
					q.px=i;
					q.py=j;
				}
			}
		}
		bfs();
	}
	return 0;
}