bfs （迷宫问题）

输入 迷宫行列数，以及迷宫组成，输入起点终点坐标

输出 最小步数 逆序输出路径  （书上的一道题，就不打字全抄了）

输入 

5 4
0 0 1 0
0 0 0  0
0 0 1 0
0 1 0 0
0 0 0 1
1 1 4 3

输出

7
4 3
4 4
3 4
2 4
2 3
2 2
1 2
1 1

#include <stdio.h>
#include <stdlib.h>
int book[51][51]; //标记走过的点
int a[51][51];  //存储迷宫组成  1表示障碍物 0表示空地
int flag;      //表示是否到终点
typedef struct abc
{
    int x;
    int y;
    int f;  //这个点上一步在队列中的下标
    int s;   //这个点是第几步
} DIAN;
DIAN dian[2502];     //队列，存储走过的点。按步数大小存储 队列前面的步数小
int main()
{
    //freopen("in.txt","r",stdin);
    int next[4][2]= {{0,1},{1,0},{-1,0},{0,-1}};
    int n,m;
    scanf("%d%d",&n,&m);
    for(int i=1; i<=n; i++)
    {
        for(int j=1; j<=m; j++)
        {
            scanf("%d",&a[i][j]);
        }
    }
    int head=1;
    int tail=1;
    int startx;
    int starty;
    scanf("%d%d",&startx,&starty);
    int p,q;
    scanf("%d%d",&p,&q);
    dian[tail].x=startx;
    dian[tail].y=starty;
    dian[tail].f=0;
    dian[tail].s=0;
    tail++;
    book[startx][starty]=1;
    while(head<tail)
    {
        int tx,ty;
        for(int k=0; k<4; k++)             //四个方向尝试
        {
            tx=dian[head].x+next[k][0];
            ty=dian[head].y+next[k][1];
            if(tx<1||tx>n||ty<1||ty>m)continue;
            if(book[tx][ty]==0&&a[tx][ty]==0)
            {
                book[tx][ty]=1;
                dian[tail].x=tx;
                dian[tail].y=ty;
                dian[tail].f=head;
                dian[tail].s=dian[head].s+1;
                tail++;

            }
            if(tx==p&&ty==q)flag=1;
            if(flag)break;
        }
        if(flag)break;
        head++;     //一个点进行尝试后就要抛弃出队
    }
    printf("%d\n",dian[tail-1].s);
    int g=tail-1;

    while(1)     //逆序输出，当时题目没要求输出，随便搞了个，应该可以用栈或vector顺序输出
    {
        printf("%d %d\n",dian[g].x,dian[g].y);
        g=dian[g].f;
        if(g==1)
        {
            printf("%d %d\n",startx,starty);
            break;
        }
    }
    return 0;
}