上題目

Problem Description
推箱子是一個很經典的遊戲.今天我們來玩一個簡單版本.在一個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

分析

人能推動箱子的幾個要素

1.人的下一個位置是箱子現在的位置

2.箱子移動的方向是人推箱子時移動的方向

1. 人和箱子說組成的四維座標是用來判斷是否經歷的依據

上程式碼 + 註釋

#include<stdio.h> 
#include<queue> 
 

#include<algorithm> 

using namespace std;

struct Node
{
    int x, y;
    int bx, by;
    int num;
    bool friend operator < (const Node &a, const Node &b)
    {
        return a.num > b.num;
    }//優先佇列 
} star;

int map[9][9];
bool mark[9][9][9][9];//用人跟箱子的位置標記狀態 
int dis[4][2] = { 1
 
, 0, 0, -1, -1, 0, 0, 1 };
int n, m, ans;


void input()// 輸入函式
{
    int i, j;
    for (i = 0; i < n; i++)
    {
        for (j = 0; j < m; j++)
        {
            scanf("%d", &map[i][j]);
            if (map[i][j] == 4)
            {
                star.x = i;
                star.y = j;
                map[i][j] = 0;
            }
            if (map[i][j] == 2)
            {
                star.bx = i;
                star.by = j;
                map[i][j] = 0;
            }
        }
    }
}
//輸入地圖，找到人跟位置的點。 

int BFS()
{
    int i, x, y, num, xx, yy;
    Node now, next;
    priority_queue<Node> Q;

    Q.push(star);

    mark[star.x][star.y][star.bx][star.by] = true;

    while (!Q.empty())
    {
        now = Q.top();
        Q.pop();

        if (map[now.bx][now.by] == 3)
            return now.num;//如果箱子到終點退出搜尋 

        for (i = 0; i < 4; i++)//四個方向迴圈
        {
            x = now.x + dis[i][0];
            y = now.y + dis[i][1];


            if (x < 0 || x >= n || y < 0 || y >= m)//越界 繼續
                continue;

            if (map[x][y] == 1) //牆 繼續
                continue;

            next.bx = now.bx;
            next.by = now.by;
            next.num = now.num;  //注意題目要求統計的是箱子的移動個數
            next.x = x;
            next.y = y;


            if (x == now.bx && y == now.by)//如果下個點是箱子的位置 
            {
                xx = x + dis[i][0];
                yy = y + dis[i][1];

                if (xx < 0 || xx >= n || yy < 0 || yy >= m)
                    continue;

                if (map[xx][yy] == 1)
                    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;
            Q.push(next);
        }
    }
    return -1;
}


int main()
{
    int T, ans;
    scanf("%d", &T);
    while (T--)
    {
        memset(mark, 0, sizeof(mark));//最重要的初始話忘記了，wa了幾次 
        scanf("%d%d", &n, &m);

        input();

        star.num = 0;

        ans = BFS();
        printf("%d\n", ans);
    }
    return 0;
}