首页 > 车圈原创 > 车圈原创 > 【自动驾驶】路径规划算法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.如果队列为空,则表示已经遍历完所有可达节点,算法结束。

算法框图

车圈原创更多>>

方盒子新选手登场 传祺越7官图正式发布 扒开2026款HR-V的配置表 本田已经这么勇了吗? 极氪8X底盘用料大揭秘,性能旗舰果然名不虚传 全新奔驰纯电GLC SUV开启预售;字节跳动声明无造车计划 比亚迪城市智驾兜底,其他车企为什么不跟? 外卖党、通勤族、预算党:城市通勤电摩到底该怎么挑 从月销过万到月销三千,新款尚界H5预售 能否助其重回万辆? 新势力过“生死线”,出口一片火热,真能止跌回暖 6月上市,零跑C10/C11/C16都改了啥? 消息称印度塔塔汽车计划引进奇瑞整车平台,推进高端电动汽车项目 单品牌力克日系三强,中国汽车改写韩国进口车市场格局 极狐品牌向上的接力棒,问道V9接手了 单月出口三刷纪录、新能源破10万:奇瑞集团5月销量快报 以一敌三碾压日系!比亚迪首次拿下韩国第三 大湾区车展实拍!上汽大众双ePro新车,合资插混终于亲民了 不要被厂家宣传带偏了!大五座和大六座SUV该怎么选? 丰田普锐斯PHEV召回!后车门开关线路有瑕疵免费回厂修正 上汽奥迪摊牌了! E7X的上市定价 让消费者永远是赢家 中国第四款专属配色/氤氲蓝主题/ 劳斯莱斯库里南新色发布 秋季上市 / 单电机续航900km / 启境GX7谍照首曝 GTI 灵魂正式电动化!大众 ID. Polo GTI 登场 80万车主之选,实测全维进阶的新红旗H5,家用商务两相宜! 要买轿车的有福了,上半年还有这5款值得期待,颜值高配置牛! 悦意08预售10.49万起,800V+6C快充,央企新品牌能打动年轻人吗 预售价37万元起,越野“卷王”全新猛士M817性能拉满! 比理想L6、汉兰达都大的星光L,要做一台更有品质的五菱 三品牌矩阵全员登场 蔚来全系阵容亮相粤港澳大湾区车展 10.49-14.49万元 一汽悦意08开启预售 2026款星途ES更多官图发布!智能化升级,配备猎鹰700+27个传感器 何小鹏公开\"抛弃\"激光雷达!纯视觉智驾要赢了