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

算法框图

原创知识更多>>

4月MPV排行榜出炉,岚图梦想家排第一,别克GL8跌到第七? 重磅官宣,JEEP又要回来国产了! 承载式车身带大梁?广汽首款“方盒子”盲猜会火 售价17.98万元起,2026款红旗H6上市,配2.0T+8AT,竞争本田雅阁 总投资额超80亿元 东风汽车与斯泰兰蒂斯集团签署合作协议 1.5T插混,红旗官宣:新车5月20日上市 顶流间的“双向奔赴”!王力宏“力挺”腾势,出任全球代言人 三款重磅新车同日上市 长城猛龙PLUS领衔 最低售16.98万元 全新纯电奔驰GLC,纯电驱动,续航680km,7月正式上市 本田City改款车型的车头造型曝光,更具运动感,沿用原底盘! 敢为泰山 智鉴不凡 岚图泰山X8全场景体验营暨全系深度试驾会落幕 “落后”咋了?捂了大半年,特斯拉用70ms,给国产电动车上了一课 VISION BMW ALPINA(宝马阿尔宾纳设计概念车)全球首秀 岚图泰山X8全场景体验营暨全系深度试驾会圆满落幕 第十八届轩辕蓝皮书论坛开幕,贾可首发汽车十大转折 新一代理想L9上市,但我劝你再等等新问界M9 热爱自由 活出棱角:长城猛龙PLUS正式上市,售价11.69万元起 充电比加油快,腾势N9闪充版刷新豪华旗舰,价格会涨吗? 紧凑型SUV“火力升级”5款新车来袭 领克20、奇瑞风云T7领衔 方盒子2.0:猛龙PLUS如何用“家庭深度定制”开启品类新周期 2026环塔前瞻:长城车队能否再创不败神话? 限时红包价10.99万起,奇瑞风云T9长续航版正式上市 全新一代理想L9上市45.98万元起,能否扛起销量大旗? 现代汽车Q1营收创新高,营利却跌了三成多,这账该咋算? 刚刚,JeePAvenger发布,造型潮流又个性 东风奕派M8官图发布!大六座SUV,华为乾崑辅助驾驶,5月内亮相 奥迪发布新款Q4 Sportback e-tron官图 智界V9上市发布,售价38.98万-51.98万元 小米YU7 GT实车到店,搭载车厘子红车色+红黑内饰,5月底发布 车身加长,可选7座,哈弗猛龙Plus正式上市16.18万元起