首页 > 生活知识 > 每天学习 > 【自动驾驶】路径规划算法Dijkstra与A

【自动驾驶】路径规划算法Dijkstra与A

发布时间:2024-05-05 16:47:15

在本文中,我们将主要介绍Dijkstra算法和A*算法,从成本计算的角度出发,并逐步展开讨论。我们将从广度优先搜索开始,然后引入Dijkstra算法,与贪心算法进行比较,最终得出A*算法。

成本计算

在路径规划中,成本计算的一个主要因素是距离。距离可以作为一种衡量路径长短的度量指标,通常使用欧几里得距离、曼哈顿距离或其他合适的距离度量方法来计算。本文主要介绍欧几里得距离与曼哈顿距离。

 

 

 

 

广度优先搜索

广度优先搜索(Breadth First Search,BFS )是一种图遍历算法,按照广度方向逐层遍历所有可达节点。

BFS的基本思想是通过维护一个队列,逐层访问节点。具体步骤如下:

1.将起始节点放入队列中,并标记为已访问。

2.当队列非空时,执行以下步骤:

  1. 从队列中取出一个节点,记为当前节点,并标记为已访问。
  2. 如果该节点是目标节点,则返回结果。
  3. 将当前节点的所有未访问过的邻居节点放入队列中。

3.如果队列为空,则表示已经遍历完所有可达节点,算法结束。

算法框图

每天学习更多>>

鸿蒙智行宣布 6 月问界 M9 全系、问界 M8 增程系列 OTA 推送 上汽集团携五品牌登陆香港车展 智己港版IM5、IM6同步上市 小鹏×华为首款车!G7预售23.58万!是精装G6吗? 小鹏汇天完成国内飞行汽车首次无线通信性能测试,明年量产交付 汽车厂商推广高阶智驾免费引质疑 女博士真的很难嫁出去吗?别信老一套说法 重庆大学2025招生5948人,川渝两地占四成,八个工科试验班占62% 定了!仓山区2025年小学划片范围!招生办法出炉! 广州创市级健康学校(幼儿园)774所 赋能千行百业 我国工业机器人出口大增 35万级MPV你选谁?魏牌高山对比腾势D9 DM,究竟有哪些差别? 六口之家的空间救星!领克900如何实现舒适与实用兼得? 雷克萨斯挺不住了!纯进口跌至20万,长近5米喝92油,却难走量 凯美瑞降价12万,买它真划算?尺寸油耗配置全分析 有谁知道传祺向往M8乾崑系列的智电三巨头有多牛? 月销只剩4217辆,大众ID.3风光不再,消费者为何不愿买账了? 2025年车市竞争惨烈,一汽丰田bZ5逆势登场! 为什么比亚迪往死里降价?深度原因是什么? 26万的525Li即将结束?浅谈高息高返 为什么说宝马是运动型轿车的真正王者? 抖音生活服务数据显示江苏省看球酒吧订单环比飙升18倍 科技赋能精细种 一码溯源保品质 电商快运拓销路 智慧农业串起瓜农增收金链条 非遗直播电商火热,“00后”“90后”撑起消费半壁江山 真金白银扶持新质商家,拼多多在为下一个十年布局 6月17日来京东3C数码采销直播间 看吴晓波深度对话奔图打印总经理 必优美多功能读卡器天猫促销,到手价19.5元 二手房挂牌700多万套?最难熬的价格战来了 购买二手房可提公积金交首付 深圳仅三成业主还在捍卫房价? 一加测试165Hz高刷手机与平板组合