1.实现方式

使用队列实现

2.例题

《啊哈算法-解救小哈》

#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include <ctype.h>
#include <string.h>
const  int max=1000;
struct note{
    int x;      //横坐标
    int y;      //纵坐标
    int f;      //父亲在队列中的编号，如果输出路径
    int s;      //步数
};
 
int main() {
    int startx,starty,p,q,n,m,flag,tx,ty;
    struct note que[2501];
    int head,tail;
    int a[51][51]={0};  //用来存储地图
    int book[51][51]={0};   //记录哪些点已经在队列中，防止一个点被重复扩展，并全部初始化为0
    int next[4][2]={
        {0,1},          //向右走
        {1,0},          //向下走
        {0,-1},         //向左走
        {-1,0}          //向上走
    };
    
    scanf("%d %d",&n,&m);   //n行m列
    //读入迷宫
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
            scanf("%d",&a[i][j]);
    scanf("%d %d %d %d",&startx,&starty,&p,&q);
    //队列初始化
    head=1;
    tail=1;
    //往队列插入迷宫入口坐标
    que[tail].x=startx;
    que[tail].y=starty;
    que[tail].f=0;
    que[tail].s=0;
    tail++;
    book[startx][starty]=1;
    
    flag=0; //用来标记是否已经到达目标点，0表示还没有达到，1表示达到
    //当队列不为空的时候循环
    while(head<tail){
        //枚举四个方向
        for (int k=0; k<=3; k++) {
            //计算下一个点的坐标
            tx=que[head].x+next[k][0];
            ty=que[head].y+next[k][1];
            //判断是否越界
            if(a[tx][ty]==0&&book[tx][ty]==0){
                //把这个点标记为已经走过
                //注意宽搜每个点只入队一次，所以和深搜不同，无需将book数组还原
                book[tx][ty]=1;
                //插入新的点到队列中
                que[tail].x=tx;
                que[tail].y=ty;
                que[tail].f=head; //因为这个点是从head扩展出来，所以它的父亲是head，求路径用
                que[tail].s=que[head].s+1;  //步数是父亲的步数+1
                tail++;
            }
            //如果到目标点，停止扩展，任务结束，退出循环
            if(tx==p&&ty==q){
                flag=1;
                break;
            }
        }
        if(flag==1)
            break;
        head++;         //当一个点扩展结束后，head++才能对后面的点再进行扩展
    }
    //打印队列中末尾最后一个点的步数
    //tail是指向队列队尾的下一个位置，所以这需要-1
    printf("%d\n",que[tail-1].s);
    return 0;
}