POJ 3984

走迷宫问题。

题意：给出一幅图，有些点可以到达，有些点不行， 要求出从左上角到右下角的最短路径。

直接广搜，开个数组记录每个节点的前驱。

#include <iostream>
#include <queue>
#include <cstdio>

using namespace std;

int map[5][5];
int fa[5*5];
bool vis[5*5];
int path[4][2] = { {1, 0}, {-1, 0}, {0, 1}, {0, -1} };

bool islegal(int row, int col)
{
    if(row < 0 || row >= 5 || col < 0 || col >= 5 || vis[row*5+col] || map[row][col] == 1) return 0;

    return 1;
}

void bfs(int src, int end)
{
    queue<int> q;
    q.push(src);
    vis[src] = 1;

    while(!q.empty())
    {
        int fr = q.front();
        q.pop();

        if(fr == end) return;

        for(int i = 0; i < 3; i++)
        {
            int row = fr/5;
            int col = fr%5;

            row += path[i][0];
            col += path[i][1];

            if(islegal(row, col))
            {
                fa[row*5+col] = fr;
                vis[row*5+col] = 1;

                q.push(row*5+col);
            }
        }
    }
}

int main()
{
    //freopen("C:/Users/Admin/Desktop/in.txt", "r", stdin);

    for(int i = 0; i < 5; i++)
    {
        for(int j = 0; j < 5; j++)
        cin >> map[i][j];
    }

    for(int i = 0; i < 25; i++) fa[i] = -1;

    int src = 0, end = 24;

    bfs(src, end);
    int ans[30], cnt = 0;

    while(fa[end] != -1)
    {
        ans[cnt] = end;
        ans[++cnt] = fa[end];
        end = fa[end];
    }
    printf("(0, 0)\n");
    for(int i = cnt-1; i >= 0; i--)
    {
        printf("(%d, %d)\n", ans[i]/5, ans[i]%5);
    }


    return 0;
}