hdu 1254推箱子（兩次bfs）

相對人是否能到達箱子的四周bfsr,再對箱子bfsx。

對人和箱子的座標進行標記，防止走重複的。

#include <iostream>#include <queue>#include <cstring>using namespace std;struct tuixiang{int x,y,rx,ry,step;}e;int n,m,bz[10][10][10][10],map[10][10];int h[4][2]={1,0,-1,0,0,1,0,-1};int bzr[10][10];int bfsr(tuixiang sr,tuixiang er){queue<tuixiang> my; tuixiang t,tt; int i;my.push(sr); bzr[sr.rx][sr.ry]=bzr[sr.x][sr.y]=1;while(!my.empty()){t=my.front(); my.pop();if(t.rx==er.rx&&t.ry==er.ry) return 1;for(i=0;i<4;i++){tt.rx=t.rx+h[i][0]; tt.ry=t.ry+h[i][1];if(tt.rx>=0&&tt.rx<n&&tt.ry>=0&&tt.ry<m&&!bzr[tt.rx][tt.ry]&&map[tt.rx][tt.ry]!=1){my.push(tt); bzr[tt.rx][tt.ry]=1;}}}return 0;}int bfsx(tuixiang s){queue<tuixiang> my; tuixiang t,tt,rr; int i;my.push(s); bz[s.x][s.y][s.rx][s.ry]=1;while(!my.empty()){t=my.front(); my.pop();if(t.x==e.x&&t.y==e.y) return t.step;for(i=0;i<4;i++){tt.x=t.x+h[i][0]; tt.y=t.y+h[i][1]; tt.rx=t.x; tt.ry=t.y;rr.rx=t.x-h[i][0]; rr.ry=t.y-h[i][1];memset(bzr,0,sizeof(bzr));if(tt.x>=0&&tt.x<n&&tt.y>=0&&tt.y<m&&bfsr(t,rr)&&map[tt.x][tt.y]!=1&&!bz[tt.x][tt.y][tt.rx][tt.ry]){ tt.step=t.step+1; bz[tt.x][tt.y][tt.rx][tt.ry]=1;my.push(tt);}}}return -1;}int main(int argc, char *argv[]){    int t,i,j; tuixiang s;    cin>>t;    while(t--)    {        cin>>n>>m;        memset(bz,0,sizeof(bz));        for(i=0;i<n;i++)        for(j=0;j<m;j++)        {            cin>>map[i][j];            if(map[i][j]==2){    s.x=i; s.y=j;s.step=0;    }            if(map[i][j]==3){   e.x=i; e.y=j;    }            if(map[i][j]==4){   s.rx=i;s.ry=j;}        }        cout<<bfsx(s)<<endl;    }    return 0;}