1254 推箱子

（c语言版）整体思路：主线是以箱子为中心做广搜，能不能扩展某个点的条件是人能不能到到达（箱子要去方向的反方向这点）这时再写一个广搜（搜人能否到达这点），（人的位置总是在箱子移动前的位置可以找到不熟的话做hdu 1026打印路径的题）（要扩展的目标终点也有，可以写）整理代码的严谨性和逻辑性就完成了。

#include<cstdio>#include<cstring>using namespace std;const int N=10;int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};int book[N][N][N][N];struct f{ int x,y,step; int early;}b[4*N*N],c[4*N*N];int a[N][N];int bookx[N][N];int n,m,peox,peoy,bx,by;int jud(int px,int py){//people+box   int head=0,tail=1;   c[head].x=peox,c[head].y=peoy;   if(peox==px&&peoy==py) return 1;//如果人的初始位置满足条件就不需要扩展点了（开始忘了这个细节）   memset(bookx,0,sizeof(bookx));   while(head<tail){       for(int i=0;i<4;i++)       {           int tx=c[head].x+next[i][0],ty=c[head].y+next[i][1];           if(tx<1||tx>n||ty<1||ty>m||a[tx][ty]==1||bookx[tx][ty]) continue;           if(tx==bx&&ty==by) continue;              bookx[tx][ty]=1;            c[tail].x=tx,c[tail++].y=ty;           if(tx==px&&ty==py) {return 1;}       }       head++;   }   return 0;}int main(){    int t;    scanf("%d",&t);    while(t--){        int startx,starty,endx,endy;        scanf("%d%d",&n,&m);//输错行列        for(int i=1;i<=n;i++)         for(int j=1;j<=m;j++)            {             scanf("%d",&a[i][j]);             if(a[i][j]==2){startx=i,starty=j;}             if(a[i][j]==3){endx=i,endy=j;}             if(a[i][j]==4){peox=i,peoy=j;}            }      int head=0,tail=1,flag=0;      b[head].x=startx,b[head].y=starty,b[head].step=0,b[head].early=0;      memset(book,0,sizeof(book));      while(head<tail){          bx=b[head].x,by=b[head].y;//箱子位置        if(head){peox=b[b[head].early].x,peoy=b[b[head].early].y;}//人的位置（为箱子上个的位置）          for(int i=0;i<4;i++)          {              int tx=bx+next[i][0],ty=by+next[i][1];              int px=bx-next[i][0],py=by-next[i][1];              if(tx<1||tx>n||ty<1||ty>m||a[tx][ty]==1) continue;              if(px<1||px>n||py<1||py>m) continue;              if(!book[bx][by][tx][ty]&&jud(px,py)){//四维标记（人的位置（即当前箱子的位置）加箱子的位置）                  book[bx][by][tx][ty]=1;                  b[tail].x=tx,b[tail].y=ty,b[tail].step=b[head].step+1,b[tail++].early=head;                  if(tx==endx&&ty==endy){                        flag=1;break;                  }              }          }          if(flag) break;          head++;      }      if(flag) printf("%d\n",b[tail-1].step);      else printf("-1\n");    }return 0;}