迷宫最短路径 广度优先搜索—C

从迷宫的起点到终点的最短路径,用广度优先搜索

#include<stdio.h>
struct node
{
    int x;
    int y;
    int s;
};
int main()
{
    int i,j,k,startx,starty,tx,ty,flag=0;
    int n,m,p,q,min=99999999;
    int a[100][100],book[100][100];
    struct node queue[100],t;
    int head,tail;
    int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};


    scanf("%d%d",&n,&m);
    for(i=1;i<=n;i++)
        for(j=1;j<=m;j++)
            scanf("%d",&a[i][j]);


    scanf("%d%d%d%d",&startx,&starty,&p,&q);
    head=1;
    tail=1;
    queue[tail].x=startx;
    queue[tail].y=starty;
    queue[tail].s=0;
    tail++;
    book[startx][starty]=1;
    while(head<tail)
    {
        t=queue[head];
        for(k=0;k<=3;k++)
        {
           tx=t.x+next[k][0];
           ty=t.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;
               queue[tail].x=tx;
               queue[tail].y=ty;
               queue[tail].s=t.s+1;
               tail++;
           }
           if(tx==p&&ty==q)
            {
                flag=1;
                break;
            }
        }
        if(flag==1)
            break;
        head++;
  }
    printf("%d",queue[tail-1].s);
    return 0;
}
  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值