POJ-3984迷宫问题

作为BFS初学的练习。

#include<cstdio>
#include<cstring>
#include<iostream>
#include<algorithm>
#include<vector>
#include<queue>
using namespace std;
int s[20][20],d[20][20];
int dx[5] = {1,0,-1,0},dy[5] = {0,1,0,-1};
struct pairs{
    int r,c;
    pairs(int r=0,int c=0):r(r),c(c) {}
} p[20][20];
void print(pairs u) {
    vector<pairs> nodes;
    for(;;) {
        nodes.push_back(u);
        if(d[u.r][u.c]==0) break;
        u=p[u.r][u.c];
    }
    for(int i=nodes.size()-1;i>=0;i--) {
        printf("(%d, %d)\n",nodes[i].r,nodes[i].c);
    }
}
void bfs(){
    queue<pairs> q;
    memset(d,-1,sizeof(d));
    q.push(pairs(0,0));
    d[0][0]=0;
    while(!q.empty()){
        pairs u=q.front(); q.pop();
        if(u.r==4&&u.c==4) { print(u); return ; }
        for(int i=0;i<4;i++){//
            pairs v=pairs(u.r+dx[i],u.c+dy[i]);
            if(d[v.r][v.c]<0&&v.r>=0&&v.r<5&&v.c>=0&&v.c<5&&s[v.r][v.c]==0){
                d[v.r][v.c]=d[u.r][u.c]+1;
                q.push(v);
                p[v.r][v.c]=u;
            }
        }
    }
    return ;
}
int main(){
    for(int i=0;i<5;i++)
        for(int j=0;j<5;j++)
        scanf("%d",&s[i][j]);
        bfs();
    return 0;
}