POJ 3984 (BFS迷宫)

题目链接：http://poj.org/problem?id=3984

本题应用bfs迷宫就行了，主要是要记录路径，pre数组用于记录路径，这里用了C++的STL，比较方便，当然用数组模拟队列也是可以的，看写bfs的习惯了，下面是AC代码

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

using namespace std;

int map[7][7];
int pre[30],flag[30];
int dir[4][2]={{1,0},{0,1},{-1,0},{0,-1}};   //四个方向

bool Isleagal(int r,int c)   //判断点是否合法
{
    if(r<0||r>4||c<0||c>4) return false ;
    if(map[r][c]==1) return false;
    return true;
}
void bfs()    //广搜
{
    int x,r,c,tr,tc,next;
    queue <int> q;
    memset(flag,0,sizeof(flag));
    pre[0]=-1;          //记录点的父亲
    flag[0]=1;
    q.push(0);
    while(!q.empty())
    {
        x=q.front();
        q.pop();
        r=x/5; c=x%5;      //求出坐标
        for(int i=0;i<4;i++)
        {
            tr=r+dir[i][0];   //按一定方向增加后坐标
            tc=c+dir[i][1];
            next=tr*5+tc;
            if(Isleagal(tr,tc)&&!flag[next])
            {
                pre[next]=x;
                if(next==24) return ;    //广搜到终点停止
                flag[next]=1;
                q.push(next);
            }
        }
    }
}

void print(int n)   //递归输出结果
{
    if(pre[n]!=-1)
        print(pre[n]);
    printf("(%d, %d)\n",n/5,n%5);
}

int main()
{
    int i,j;
    for(i=0;i<5;i++)
    for(j=0;j<5;j++)
        scanf("%d",&map[i][j]);
    bfs();
    print(24);
    return 0;
}