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

算法框图

每天学习更多>>

2025年3月车企销量TOP10:排名背后的\"屠杀逻辑\" 问鼎\"汽车界奥斯卡\"PACE大奖!Aurobay混动系统中国动力新突破 Melexis宣布中国战略新动向,强调供应链的本地化 中汽创智倾转构型“江豚1号”飞行汽车验证机首飞成功 从MCU到DSP,国芯科技产品链覆盖汽车电子核心场景,形成成熟产品矩阵 钛3上市,方程豹终于想明白了? 别克GL8 ENCASA申报图 将于上海车展亮相 越野风格 捷尼赛思X Gran Equator发布 TCL C11K:点亮客厅,解锁观影新姿势 本田与索尼强强联手,推出新车,预计明年交车 “加价”买了仅499元起的红米14C,其实没必要过度神话它有多良心 雷军:小米 SU7 上月交付量超过特斯拉 Model 3 加量不加价!华为Pocket3来了:麒麟9010加持+全新设计 Q4中国手机市场调研报告出炉:华为重新成为第一 中高端市场TOP1!2024年OPPO都做了什么?AI推动高端机型销量猛涨 OPPO宣布降价清仓,12GB+512GB仅售1411元,4年流畅+五星抗摔 丰田RAV4荣放:油电混合,优惠3.5万,省油耐用选它如何? 中型车也开始大降价:奔驰C级降幅最大,雅阁帕萨特超5万 中汽协:2024年销量排名前十轿车生产企业共销售791.5万辆 三十万辆销量神话,五菱汽车:国民神车,还是潜力股?全球征途 长城汽车产品矩阵的分析和投资机会 潍坊:沿链聚合 集群发展,打造现代智能农机装备研发应用新高地 媲美百万豪车气场!长安CS75 PLUS 2025款哈弗猛龙正式亮相,终于搭载方灯,配1.5T混动,6秒破百 新款本田思域详细介绍,激进运动的前脸,谁看了不着迷? 奔驰“话事人”回答2024:事事难成事事成 比亚迪海豚和埃安AION UT对比,谁才是10万级的真香电动车? 东风日产首款纯电轿车正式官宣 年度创新科技轿车:新奥迪A3家族 微星笔记本获专业媒体平台的17项奖项和认可推荐