啊哈算法之BFS

1#include <stdio.h>
#include <stdlib.h>
struct node
{
int x;//横坐标
int y;//纵坐标
int f;//父亲节点在队列中的编号
int s;//步数
};

int main()
{
struct node que[2501];//开辟结构体节点
int a[50][50]={0};//初始化地图
int book[50][50]={0};//初始化记录数组
int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
int i,j,k;//循环中用到的循环变量
int startx,starty;//起点坐标
int p,q;//终点坐标
int flag=0;//表示是否到达终点
int tx,ty;//定义下一个点坐标
int n,m;//迷宫有n行m列
int head,tail;//定义队列头尾指针
head=tail=1;//头尾指针初始化
printf(“请输入迷宫行数n与列数：m\n”);
scanf("%d %d",&n,&m);
printf(“请输入迷宫：\n”);
for(i=1;i<=n;i++)
for(j=1;j<=m;j++)
scanf("%d",&a[i][j]);
printf(“请输入起点坐标：\n”);
scanf("%d %d",&startx,&starty);
printf(“请输入终点坐标：\n”);
scanf("%d %d",&p,&q);
que[tail].x=startx;
que[tail].y=starty;
que[tail].f=0;
que[tail].s=0;//初始化第一个节点
book[startx][starty]=1;//标记第一个节点已经在路径中
tail++;//尾指针指向下一个节点
while(head<tail)//当队列不空时
{
for(k=0;k<=3;k++)
{
tx=que[head].x+next[k][0];
ty=que[head].y+next[k][1];//计算下一个点坐标

        if(tx<1 || tx>n ||ty<1 || ty>m)
            continue;//坐标越界，结束本次循环
        if(a[tx][ty]==0&&book[tx][ty]==0)//如果不是障碍物并且不在路径中
        {
            book[tx][ty]=1;//加入路径中
            que[tail].x=tx;
            que[tail].y=ty;
            que[tail].f=head;
            que[tail].s=que[head].s+1;//新节点入队列
            tail++;//尾指针后移
        }
         if(tx==p&&ty==q)
        {
                flag=1;
                break;//如果已经到达终点，可以不用再计算拓展其他节点
        }
    }//for
    if(flag==1)
        break;//如果已经到达终点，不再进行while循环
        head++;//程序走到这一步说明上一个节点已经处理完毕，出队列
}//while
printf("最小步数为：\n");
printf("%d",que[tail-1].s);
return 0;

}
值得注意的是 判断是否为目标节点的哪个IF语句不能放在开始，也就是说与深度优先搜索不同，不能一开始就判断边界，而应该对这个节点处理后再判断，否则会少一个步长