hdu 1254

每次都要判断人能不能走到箱子的一边，然后推箱子

dp[i][j][k]记录从k方向推到i,j的最小格数

 

 

 

 

 

 

 

 

 

#include<stdio.h>

#include<queue>

#include<string.h>

#define inf 0x3fffffff

using namespace std;

int dir[4][2]={0,1,1,0,0,-1,-1,0};

int map[10][10],dp[10][10][4],vis[10][10];

int n,m,Rx,Ry;

struct op

{

	int x,y,step;

	int rx,ry;

};

int judge(int x,int y)

{

	if(x>=0&&x<n&&y>=0&&y<m&&map[x][y]!=1)

		return 1;

	return 0;

}

int bfs1(int sx,int sy,int ex,int ey,int bx,int by)//判断人能不能走到箱子的一边

{

	memset(vis,0,sizeof(vis));

	queue<op>Q;

	int x,y,i;

	op cur,next;

	cur.x=sx;

	cur.y=sy;

	vis[sx][sy]=1;

	Q.push(cur);

	while(!Q.empty())

	{

		cur=Q.front();

		Q.pop();

		if(cur.x==ex&&cur.y==ey)return 1;

	   for(i=0;i<4;i++)

		{

		    next.x=x=cur.x+dir[i][0];

			next.y=y=cur.y+dir[i][1];

			if(judge(x,y)==0||(x==bx&&y==by)||vis[x][y]==1)continue;

			vis[x][y]=1;			

			Q.push(next);

	   }

	}

return 0;	

}

int bfs(int sx,int sy,int ex,int ey)

{

	int i,x,y,rx,ry;

	queue<op>Q;

	op cur,next;

	cur.x=sx;cur.rx=Rx;

	cur.y=sy;cur.ry=Ry;

	cur.step=0;

	Q.push(cur);

	while(!Q.empty())

	{

		cur=Q.front();

		Q.pop();

		if(cur.x==ex&&cur.y==ey)

			return cur.step;

		for(i=0;i<4;i++)

		{

			x=cur.x+dir[i][0];

			y=cur.y+dir[i][1];

			rx=cur.x-dir[i][0];

			ry=cur.y-dir[i][1];

			if(judge(x,y)==0||judge(rx,ry)==0)continue;

			if(bfs1(rx,ry,cur.rx,cur.ry,cur.x,cur.y)==0)continue;

			next.x=x;

			next.y=y;

			next.rx=cur.x;

			next.ry=cur.y;

			next.step=cur.step+1;

			if(next.step<dp[x][y][i])

			{

				Q.push(next);

				dp[x][y][i]=next.step;

			}

		}

	}

	return -1;

}

int main()

{

	int i,j,k,t,ex,ey,sx,sy;

	scanf("%d",&t);

	while(t--)

	{

		scanf("%d%d",&n,&m);

		for(i=0;i<n;i++)

			for(j=0;j<m;j++)

			{

				scanf("%d",&map[i][j]);

				if(map[i][j]==4)

					Rx=i,Ry=j;

				if(map[i][j]==2)

					sx=i,sy=j;

				if(map[i][j]==3)

					ex=i,ey=j;

			}

			for(i=0;i<n;i++)

				for(j=0;j<m;j++)

					for(k=0;k<4;k++)

						dp[i][j][k]=inf;

					k=bfs(sx,sy,ex,ey);

				    printf("%d\n",k);

	}

	return 0;

	

}