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

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

发布时间:2024-05-05 16:47:15来源: 152102

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

成本计算

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

 

 

 

 

广度优先搜索

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

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

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

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

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

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

算法框图

每天学习更多>>

篮球——CBA常规赛:北京北汽对阵南京头排苏酒 谷歌Android XR SDK开发者预览版上线:2种空间交互、多模态输入 三星旗舰手机首次:Galaxy S25系列支持A/B无缝安卓系统更新 年底装机必选锐龙9000,这两套配置别错过 2025年车市淘汰赛加剧,新能源品牌该怎么选? 零跑C11:价值之选,开启智能生活 理想造出L4级自动驾驶车辆还要三年 李想:决定胜负的关键 多孩家庭买车该怎么选?70万车主给出了答案 新款捷尼赛思GV70购车指南:高定品质,提供情绪价值 全新AMG GT 63 S E PERFORMANCE将上市 25万级智电SUV特斯拉确实还能打,但为啥还是劝你看看小鹏G9? 日产全新SUV又来了,比普拉多霸气,标配V6动力,可还行? 广汽发布GoMate机器人,探索智能工业未来 陈数联袂全新亚洲龙,共探“有数”哲学 “C+豪华性能三冠王”A7L,把宝马的操控光环抢走了? 2024款广汽传祺GS4 MAX日常实用性测试报告 五菱发力了,推出纯电版五菱之光,能否提升销量? 自带“魔术空间”!五菱之光EV亮相,方盒子造型,大卖稳了 比亚迪 腾势D9科技豪华全能旗舰mpv,通勤旅游,你值得拥有! 吉利作为比亚迪的潜在竞争敌手,优势何在? 20万出头的宝马跑车?宝马2系大降价,新款225i优惠后性价比很高 中金:内地电信5G进入回报期 看好中国移动、中国电信 Win11命令行效率利器,微软AI Shell实测 上海政企启动鸿蒙原生应用开发“加速度” AI终端革新联盟:联想携手20余家企业共筑智能体创新专业委员会 东方电热:新能源汽车PTC电加热器设计产能近400万套 2024年末车市大戏:新能源汽车,谁才是王者? 预计13万起,全球车品质+8295芯片,零跑B10值得期待吗? 小鹏MONA OTA优化升级多项功能 风评差车,理想L8pro用车一年报告