bfs入门 poj 3984 迷宫问题

一般bfs ,据说可以用万能的打印。

 

#include
int quene[250][3],head,tail,path[250],maze[6][6];
void  visit(int row,int col)
{
    quene[tail][0]=row;
    quene[tail][1]=col;
    quene[tail++][2]=head-1;
    maze[row][col]=-1;
}
void bfs()
{
    int row,col,pre,i;
    head=0;tail=1;
    quene[0][0]=1;
    quene[0][1]=1;
    quene[0][2]=-1;
    maze[1][1]=-1;
    while(head!=tail)
    {
        row=quene[head][0];
        col=quene[head++][1];
        if(row==5&&col==5)
            break;
        if(col+1<6&&maze[row][col+1]==0)
            visit(row,col+1);
        if(row+1<6&&maze[row+1][col]==0)
            visit(row+1,col);
        if(col-1>0&&maze[row][col-1]==0)
            visit(row,col-1);
        if(row-1>0&&maze[row-1][col]==0)
            visit(row-1,col);
    }
    pre=head-1;
    i=0;
    while(pre!=-1)
    {
        path[i++]=pre;
        pre=quene[pre][2];
    }
    for(int j=i-1;j>=0;--j)
        printf("(%d, %d)\n",quene[path[j]][0]-1,quene[path[j]][1]-1);
}
int main()
{
    for(int i=1;i<6;++i)
        for(int j=1;j<6;++j)
            scanf("%d",&maze[i][j]);
    bfs();
    return 0;
}