题目链接:http://acm.hdu.edu.cn/showproblem.php?pid=1254
bfs+dfs
/*dfs 人到箱子 bfs会超内存*/
/*接着就 bfs */
/*人不能穿过箱子*/
/*每次推箱子 人要到目标方向的对立方向才能推,所以dfs 看人能不能从当前位置,走到目标方向的对立方*/
/*某些点 箱子可以经过多次 比如
1
4 3
1 4 1
3 2 0
1 0 0
0 0 0
*/
#include<cstdio>
#include<cstring>
#include<algorithm>
using namespace std;
struct node
{
int x,y;//箱子坐标
int time;
int xx,yy;//人的坐标,人在这个坐标,把箱子推到箱子坐标
}q[1000];
int map[10][10],flag[10][10],vis[10][10][10][10];//map存地图,flag存箱子坐标。vis[x][y][i][j],表示人在(i,j)把箱子推到(x,y)
//因为箱子可以经过同样的点,但每次人在哪往哪推的vis只能出现一次,不能重复。
int t,n,m,sx,sy,px,py,tag;
int dx[]={1,-1,0,0};
int dy[]={0,0,-1,1};
int check(int x,int y)
{
if(x>=1&&x<=n&&y>=1&&y<=m&&map[x][y]!=1) return 1;
return 0;
}
void dfs(int a,int b,int c,int d)
{
if(a==c&&b==d)
{
tag=1;
return;
}
if(tag==0)
{
for(int i=0;i<4;i++)
{
int x=a+dx[i];
int y=b+dy[i];
if(check(x,y)&&!flag[x][y])
{
flag[x][y]=1;
dfs(x,y,c,d);
}
}
}
}
void bfs()
{
int front=0,rear=1;
int i,j,f=-1;
q[front].x=sx;
q[front].y=sy;
q[front].xx=px;
q[front].yy=py;
q[front].time=0;
vis[sx][sy][px][py]=1;
while(front!=rear)
{
if(map[q[front].x][q[front].y]==3)
{
rear=front;
f=q[front].time;
break;
}
int i;
for(i=0;i<4;i++)
{
q[rear].x=q[front].x+dx[i];//目标坐标
q[rear].y=q[front].y+dy[i];
int a=q[front].x-dx[i];//对立坐标
int b=q[front].y-dy[i];
if(check(a,b)&&check(q[rear].x,q[rear].y)&&vis[q[rear].x][q[rear].y][a][b]==0)
{
tag=0;
memset(flag,0,sizeof(flag));
flag[q[front].x][q[front].y]=1;//每次dfs时箱子的坐标不一样,而人不能穿过箱子,所以dfs之前,要记下箱子坐标
flag[q[front].xx][q[front].yy]=1;
dfs(q[front].xx,q[front].yy,a,b);
// printf("%dzz\n",tag);
if(tag==1)
{
vis[q[rear].x][q[rear].y][a][b]=1;
q[rear].time=q[front].time+1;
q[rear].xx=a;
q[rear].yy=b;
rear++;
}
}
}
front++;
}
printf("%d\n",f);
}
int main()
{
scanf("%d",&t);
while(t--)
{
scanf("%d%d",&n,&m);
int i,j;
for(i=1;i<=n;i++)
for(j=1;j<=m;j++)
{
scanf("%d",&map[i][j]);
if(map[i][j]==2)
{
sx=i;sy=j;
}
if(map[i][j]==4)
{
px=i;py=j;
}
}
tag=0;
memset(vis,0,sizeof(vis));
bfs();
}
return 0;
}