首页 > 汽车技巧 > 汽车技巧 > 【自动驾驶】路径规划算法Dijkstra与A

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

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

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

成本计算

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

 

 

 

 

广度优先搜索

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

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

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

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

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

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

算法框图

汽车技巧更多>>

问界M9五座版预告图发布,配备揽境座椅,9月10日发布 吉利星愿官图发布,外观动感,颜值可以 新款起亚K8实车曝光,采用了新设计语言 全新奥迪Q5预告图发布,将在9月2日首发 全新林肯领航员最新实车曝光,车身魁梧,设计风格更犀利 全新奥迪Q5官图发布,采用了全新风格外观和内饰,更年轻化 不知不觉买了这台销冠,开了三个月,告诉你零跑C16值不值得买 全新吉利星愿来袭,仅6.98万起,5座布局带快充,到底香不香? 国内外都很火,零跑C10到底拿什么打动了消费者? 海外版奥德赛配V6+10AT动力,运动套件加身,国产版会同步吗? 9月新能源车销量前十,比亚迪独占6款,Model Y大卖4.8万台 售价6.98万起,定位纯电小型车,入门续航310km,这车香不香? 这款合资B级车,纯电续航520km,6.9秒破百,家用适合吗? 大众ID.4 CROZZ也扛不住了,降价5.41万,底盘舒适度喜人 比亚迪海鸥,如何定义“新一代主流代步车”? 比亚迪员工爆料:我们这蛮多本科进来H级的,在这干4年,级别没长 吉利曾拥有过的五大子品牌,每一个都红极一时,可惜现在只剩一个 宝马上演“川剧变脸”,7月官宣全系涨价,不到俩月重回价格战 奥迪“再出王炸”,暴跌38万,56万一路降至18万 共生美学设计,深蓝L07搭载高通骁龙8155,诠释豪华舒适乘车体验 高通骁龙8至尊版1200元左右的成本,所以手机要涨价? 高通公司首席可持续发展官:终端侧AI是AI的未来 中国电信浙江公司5G联手威星智能,打造未来工厂 库克力推苹果iPad mini 7平板电脑:卓越的性能,全天电池续航 苹果新招数!iPad mini 7突袭,小身材大价格,我的钱包还好吗? 时隔三年,iPad mini7来了,详细解读更新看这篇就够了 时隔三年,苹果悄悄上架新一代iPad mini,专家:逐渐失去遥遥领先的能力 消费电子行业步入上行通道,大摩、野村上调联想集团业绩预测 联想推出AI Now:个人计算正在转变为AI个性化计算 售价24.8万元北汽制造自由王国vala上市复古前脸/侧滑门4座