ACM暑假集训（Ⅲ）搜索 A-A / HDU 1254 ：推箱子 （BFS）

题目：

推箱子是一个很经典的游戏.今天我们来玩一个简单版本.在一个M*N的房间里有一个箱子和一个搬运工,搬运工的工作就是把箱子推到指定的位置,注意,搬运工只能推箱子而不能拉箱子,因此如果箱子被推到一个角上(如图2)那么箱子就不能再被移动了,如果箱子被推到一面墙上,那么箱子只能沿着墙移动.

现在给定房间的结构,箱子的位置,搬运工的位置和箱子要被推去的位置,请你计算出搬运工至少要推动箱子多少格

Input
输入数据的第一行是一个整数T(1<=T<=20),代表测试数据的数量.然后是T组测试数据,每组测试数据的第一行是两个正整数M,N(2<=M,N<=7),代表房间的大小,然后是一个M行N列的矩阵,代表房间的布局,其中0代表空的地板,1代表墙,2代表箱子的起始位置,3代表箱子要被推去的位置,4代表搬运工的起始位置.
Output
对于每组测试数据,输出搬运工最少需要推动箱子多少格才能帮箱子推到指定位置,如果不能推到指定位置则输出-1.

Sample Input
1
5 5
0 3 0 0 0
1 0 1 4 0
0 0 1 0 0
1 0 2 0 0
0 0 0 0 0

Sample Output
4

AC代码：

#include<iostream>
using namespace std;
#include<cstring>
#include<queue>
int a[10][10],M,N;
struct student{
    int x,y,bx,by,num;
    friend bool operator<(student s1,student s2){
        return s1.num>s2.num;
    }
}star;
bool mark[9][9][9][9];
int bfs(){
    int dx[4]={0,0,1,-1},dy[4]={1,-1,0,0};
    student now,next;
    priority_queue <student> p;
    p.push(star);
    mark[star.x][star.y][star.bx][star.by] = true;
    while(!p.empty()){
        now=p.top();
        p.pop();
        if(a[now.bx][now.by]==3) return now.num;
        for(int i=0;i<4;i++){
            int x=now.x+dx[i];
            int y=now.y+dy[i];

            if(a[x][y]==1||x<0||x>=M||y<0||y>=N) continue;
            next.x=x;
            next.y=y;
            next.bx=now.bx;
            next.by=now.by;
            next.num=now.num;
            if(x==now.bx&&y==now.by){//如果下个点是箱子的位置 
                int xx=x+dx[i],yy=y+dy[i];//搬运工此时只能从走过来的那一个方向推箱子（不用for i:0 ~ 4） 
                if(a[xx][yy]==1||xx<0||xx>=M||yy<0||yy>=N) continue;                        //墙 继续    //越界 继续
                next.bx=xx;
                next.by=yy;
                next.num++;
            }
            if (mark[x][y][next.bx][next.by])//如果推完后的状态已经经历过就不推了 
                continue;
            mark[x][y][next.bx][next.by] = true;
            p.push(next);
        }
    }
    return -1;
}

int main()
{    
    int T;
    cin>>T;
    while(T--){
        memset(mark, 0, sizeof(mark));                     //初始化不能忘记，否则wa 
        cin>>M>>N;
        for(int i=0;i<M;i++){
            for(int j=0;j<N;j++){
                cin>>a[i][j];
                if(a[i][j]==4){
                    star.x=i;
                    star.y=j;
                    star.num=0;
                    a[i][j]=0;
                }
                if(a[i][j]==2){
                    star.bx=i;
                    star.by=j;
                    a[i][j]=0;
                }
            }
        }
        cout<<bfs()<<endl;
    }
}