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

算法框图

原创知识更多>>

对话宝马中国CTO:大圆柱真量产?宁德时代亿纬锂能怎么配? 新款别克世纪,依然是最懂高净值人群的超豪华MPV 虽然问道V9价格很亲民,但对于其市场表现,我为啥仍不看好? 35.98万起!第二代腾势D9全面升级,重塑高端MPV格局 上汽大众ID. ERA 9X爆单背后:信任比流量更珍贵 埃安N60用实打实的价格与产品力践行“Easy Life”的松弛感 smart 精灵6号18.99万元起预,精灵2号概念车首发亮相 新能源竞赛换挡时刻,谁是“央企新势力”压舱石? 埃安AION N60正式上市 限时焕新价10.68万起,全系标配激光雷达 长安凯程Robovan亮相:无人物流车终于从“概念”走向“赚钱” 限时换新价6.98万元起,长城欧拉5多动力版本上市 自主品牌全面焕新,广汽集团发布五款新车 加速向智能电动转型捷达品牌全面焕新,首款纯电轿车M6下半年上市 2026北京车展正式开幕,广汽昊铂S600在车展上开启盲订 2026北京车展,宝马展示全新宝马iX3长轴距版、i3长轴距版以及新款宝马7系/i7 2000万的仰望誰买走了?当东方工艺在车展打败西方设计 小马智行重构万亿级出行与物流生态:2027版Robotaxi成本低于23万,首发L4级无人轻卡 奕境品牌首款车型奕境X9亮相 预计下半年上市 北京车展直击:东风登场,展车+技术全亮相 首款纯电轿车的名字——捷达M6 2026北京汽车展览 | 预售价区间20.99-25.99万元 新款领克10/领克10+开启预售 2026北京汽车展览 | 捷途旅行者PLUS C-DM/山海L10悉数亮相 北京汽车展览 | 长安蓝鲸超擎双车炸场,HEV正式进入“七万时代” 全新宝马七系领衔十六款首秀,新世代技术驱动中国跃迁 2026北京车展首秀 | 日产两款全新SUV概念车全球首秀 预计将于年内量产 别再挤六座七座了!岚图泰山 X8:真正懂家庭的都选它 2026北京国际车展 | 全新奥迪SQ8正式上市/奥迪S5 Avant亮相 从单品爆款到全矩阵合围,鸿蒙智行的棋局落子有声 长安第四代逸动/CS75PLUS蓝鲸超擎正式上市 售价约127万元起!2027款宝马M760e官图发布