hdu 1254 推箱子（两次广搜）

/*

这题一个下午了，现在终于过了；

用了两次广搜，一次搜箱子到目标地，第二次搜人是可以到推动箱子的地方，要注意的是箱子可能会阻挡人，也可以来回的推。

给几组数据就知道了（这题数据都是后面讨论版中提供的）

10

4 3

0 0 0

0 0 1

0 2 3

1 4 1

 

5 5

0 3 0 0 0

1 0 1 4 0

0 0 1 0 0

1 0 2 0 0

0 0 0 0 0

4 4

1 2 1 1

0 0 0 0

0 4 3 0

0 0 0 0

4 4

0 3 0 0

0 0 2 0

0 0 4 0

0 1 0 1

3 3

0 3 0

1 0 2

0 4 0

5 5

0 1 4 0 0

0 1 1 1 1

0 2 3 0 0

0 0 0 0 0

0 0 0 0 0

4 4

0 1 0 1

0 2 0 4

0 0 0 0

0 3 0 1

*/

#include<iostream>
#include<queue>
#define N 8
using namespace std;
int n, m, str[N][N], mark[N][N], pmark[N][N], dir[4][2]={1,0, -1,0, 0,1, 0,-1};
int s_x, s_y, e_x, e_y, p_x, p_y;

struct node
{
	int x, y, step, dx, dy;
};

int judge(int x, int y)
{
	if(x>=0 && x< n && y>=0 && y<m && str[x][y] != 1)
		return 1;
	else
		return 0;
}

int work(int box_x, int box_y, int end_x, int end_y, int sta_x, int sta_y)
{
	int i, x, y;
	node cur, next;
	queue<node>q2;
	cur.x = sta_x; cur.y = sta_y; cur.step=0;
	q2.push(cur);
	while(!q2.empty())
	{
		cur = q2.front();
		q2.pop();
		if(cur.x==end_x && cur.y==end_y)
			return cur.step;
		for( i=0; i < 4; i++ )
		{
			next.x = x = cur.x + dir[i][0];
			next.y = y = cur.y + dir[i][1];
			next.step = cur.step + 1;
			if(judge(x, y) && pmark[x][y]==0 && (x!=box_x || y!=box_y))
			{
				pmark[x][y] = 1;
				q2.push(next);
			}
		}
	}
	return -1;
}

int bfs()
{
	int i;
	node cur, next;
	queue<node>q1;
	cur.x=s_x; cur.y=s_y; cur.step=0;
	next.dx=cur.dx=p_x; next.dy=cur.dy=p_y;
	q1.push(cur);
	while(!q1.empty())
	{
		cur = q1.front();
		q1.pop();
		if(cur.x==e_x && cur.y==e_y)
			return cur.step;
		for( i=0; i < 4; i++ )
		{
			next.x = cur.x+dir[i][0];
			next.y = cur.y+dir[i][1];
			next.step = cur.step+1;
			//next.dx = cur.x; next.dy = cur.y;
			memset(pmark, 0, sizeof(pmark));
			int ans = work(cur.x, cur.y, cur.x-dir[i][0], cur.y-dir[i][1], cur.dx, cur.dy);
			if(ans!=-1 && judge(next.x, next.y) && mark[next.x][next.y]<=30)
			{
				mark[next.x][next.y] += 1;
				next.dx = cur.x-dir[i][0];
				next.dy = cur.y-dir[i][1];
				q1.push(next);
			}
		}
	}
	return 0;
}

int main()
{
	int T, i, j;
	scanf("%d", &T);
	while(T--)
	{
		scanf("%d%d", &n, &m);
		for( i=0; i < n; i++ )
		{
			for(j=0; j < m; j++ )
			{
				scanf("%d", &str[i][j]);
				if(str[i][j] == 2)
					s_x=i, s_y=j;
				if(str[i][j] == 3)
					e_x=i, e_y=j;
				if(str[i][j] == 4)
					p_x=i, p_y=j;
			}
		}
		memset(mark, 0, sizeof(mark));
		int ans=bfs();
		if(ans==0)
			printf("-1\n");
		else
			printf("%d\n", ans);
	}
	return 0;
}