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

算法框图

科技创作更多>>

腾势N8L闪充版实车到店,35-40万预售补齐综合产品力 续航最高605km 吉利银河星舰7 EV将于6月10日正式上市 比亚迪澄清人形机器人传闻:代号“尧舜禹”等多项描述均不实 17.49万元起 纯电续航127km 一汽-大众迈腾PHEV 开启预售 放下溢价惯性后,奔驰给35万级豪华纯电上了一课 华为高管官宣享界SUV即将问世:定位方盒子SUV 比亚迪大唐EV搭载超快充技术,将于6月17日上市,预售25—32万元 从城市通勤到长途自驾,理想L9表现如何?老司机带你一探究竟 全新一代奥迪Q7预告,放心,还是传统门把手 环塔收官焕新登场,瑞虎8冠军家族新品发布 5月车市回暖,出口激增成主要拉动力 宾利新款飞驰官图,回归单头灯,调校更运动 新车“轮番轰炸”密集上市,国产爆款为何越来越稀缺? 领克10+和领克10开卖,信息量够大 魏牌高山7新款官图曝光,优化外观升级车身尺寸 比亚迪Racco即将上市,价格竞猜直接送车 错位对标,极狐问道V9 vs魏牌高山,家用MPV到底该选谁? 吉利5月卖23.8万辆背后,藏着三个“反常识”的信号 马自达最大的问题不是车,而是没人能说清马自达是什么 同日亮剑!问界M9对比蔚来ES9,双9对决谁能笑到最后 新款吉利牛仔上市,限时优享价7.59万元起 华为境系首车,预售21.99万起的启境GT7藏着哪些惊喜 奕境X9:华为乾崑够新的技术,奕境全搭载 零跑A10实测分享:顶配不到9万,续航505km,配激光雷达+8295芯片 中式豪华旗舰平权:2026 款魏牌 V9X 新车解析 10.49万元起!一汽悦意08开启预售,增程/纯电动力,顶配激光雷达 6.18万起,全新吉利星愿轮胎会说话 有华为和宁德时代护航,极狐问道V9却定了个低价,行得通吗? 首搭“迪迪虾”+纯电续航310km,比亚迪宋Ultra DM-i售12.99万起 9万起配半固态加后驱五连杆,MG4X