hdu_1254_推箱子（双BFS）

#include<cstdio>
#include<queue>
#include<cstring>
using namespace std;
#define FFC(i,a,b) for(int i=a;i<=b;i++)
struct dtm{int x,y,t;};
struct dtb{int x,y,t,mx,my;};
int g[10][10],gg[10][10],t,m,n,x1,y1,x2,y2,d[][2]={1,0,-1,0,0,1,0,-1};
bool v[10][10][4],f[10][10];
bool checkmen(int x,int y){
if(f[x][y]||x<1||x>n||y<1||y>m||gg[x][y]!=0)return 0;
return 1;
}
bool checkbox(int x,int y,int i){
if(v[x][y][i]||x<1||x>n||y<1||y>m||g[x][y]==1)return 0;
return 1;
}
int bfs(int sx,int sy,int ex,int ey){
if(ex<1||ex>n||ey<1||ey>m)return -1;
memset(f,0,sizeof(f));
dtm s,o;s.x=sx,s.y=sy,s.t=0,f[sx][sy]=1;
queue<dtm>Q;Q.push(s);
while(!Q.empty()){
o=Q.front();Q.pop();
if(o.x==ex&&o.y==ey)return o.t;
for(int i=0;i<4;i++){
int xx=o.x+d[i][0],yy=o.y+d[i][1];
if(!checkmen(xx,yy))continue;
s.x=xx,s.y=yy,s.t=t+1,f[xx][yy]=1;
Q.push(s);
}
}
return -1;
}
int fuck(){
memset(v,0,sizeof(v));
dtb s,o;s.x=x1,s.y=y1,s.mx=x2,s.my=y2,s.t=0;
queue<dtb>Q;Q.push(s);
while(!Q.empty()){
o=Q.front();Q.pop();
if(g[o.x][o.y]==3)return o.t;
for(int i=0;i<4;i++){
int xx=o.x+d[i][0],yy=o.y+d[i][1],ok;
if(!checkbox(xx,yy,i))continue;
gg[o.x][o.y]=2;
ok=bfs(o.mx,o.my,o.x-d[i][0],o.y-d[i][1]),gg[o.x][o.y]=0;
if(ok==-1)continue;
s.x=xx,s.y=yy,s.mx=o.x,s.my=o.y,s.t=o.t+1,v[xx][yy][i]=1;
Q.push(s);
}
}
return -1;
}
int main(){
scanf("%d",&t);
while(t--){
scanf("%d%d",&n,&m);
FFC(i,1,n)FFC(j,1,m){
scanf("%d",&g[i][j]);
gg[i][j]=(g[i][j]==1?1:0);
if(g[i][j]==2)x1=i,y1=j;
if(g[i][j]==4)x2=i,y2=j;
}
printf("%d\n",fuck());
}
return 0;
}