poj 3984 迷宫问题

题目链接：迷宫问题

题目大意：给你一个5*5的迷宫，要求输出从左上角到右下角的最短路劲，1为墙，不能访问

题目思路：用bfs去写，用一个数组来保存路径，模拟队列，输出路径的时候递归输出就可以了，起点和终点一定是可以访问到的，具体看代码

#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <algorithm>
#include <queue>

using namespace std;

int mp[6][6];
int dir[4][2] = {{0,1},{0,-1},{1,0},{-1,0}};
bool vis[6][6];

struct node{
    int x,y,pre;
}q[205];

bool check(int x,int y){
    if(x < 0||y < 0||x >= 5||y >= 5||vis[x][y]||mp[x][y] == 1) return true;
    return false;
}

void print(int n){
    if(q[n].pre != -1){
        print(q[n].pre);
        printf("(%d, %d)\n",q[n].x,q[n].y);
    }
}

void bfs(){
    int fro = 0,rear = 1;
    q[fro].x = 0,q[fro].y = 0,q[fro].pre = -1;
    vis[0][0] = true;
    while(fro < rear){
        for(int i = 0;i < 4;i++){
            int dx = q[fro].x + dir[i][0];
            int dy = q[fro].y + dir[i][1];
            if(check(dx,dy)) continue;
            vis[dx][dy] = true;
            q[rear].x = dx;
            q[rear].y = dy;
            q[rear].pre = fro;
            rear++;
            if(dx == 4&&dy == 4) print(fro);
        }
        fro++;
    }
}

int main(){
    for(int i = 0;i < 5;i++)
        for(int j = 0;j < 5;j++)
            scanf("%d",&mp[i][j]);
    memset(vis,false,sizeof(vis));
    printf("(0, 0)\n");
    bfs();
    printf("(4, 4)\n");
    return 0;
}