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

算法框图

汽车自驾更多>>

吉利、比亚迪1月数据,夏销量破万,没受到春节淡季影响 长安稳居前三,吉利有点猛,长城掉队了? 捷达VA7购车指南,推荐1.4T先到先得版 2025合资车企放大招?丰田便宜卖智驾,日产走技术流! 2025年3大新款新势力SUV:小鹏G6造型微调,蔚来ES6平台升级 2024年全球车企销量排行榜前十出炉,国产比亚迪排名第五! 智能车机评测:2025款上汽名爵MG ES5 2月份新车前瞻:神仙打架,钱包捂不住了? 新能源汽车北方仍少见,旅游城市外来插混车更多 2024现代汽车净利润超600亿人民币! 试驾现代全新帕里斯帝,传统豪车的高级感! 为什么5.8升V8发动机的福特维多利亚皇冠,成为美国警车代名词? 想买电车再等几个月!特斯拉将在今年上半年推出廉价电车model Q! 现代联手通用打造纯电皮卡,竞争Cybertruck! 现代IONIQ9 开启预售,约合33.1万元起! 美国20款电动车冬季续航测试,大众ID.4 福特电马 续航衰减严重! 现代起亚再获英国what car 年度车型大奖! 比亚迪海外表现亮眼,成为新加坡2024年最畅销汽车品牌,未来可期 比亚迪马来西亚获电动汽车销冠,长安在越南合作建厂 率先详解尊界S800:掀开中国百万超豪的神秘面纱 合资燃油紧凑轿车降价榜:最高优惠6万,新能源还香吗? 研究报告:数家欧洲、北美汽车工厂今年可能被关闭或出售 博世智能座舱平台累计出货量突破200万台 2025 CES丨车凌科技全新发布MaaS解决方案 #以场景触发服务 本田要求日产回购雷诺所持股份 NOA加速普及,高阶智驾成为竞争主战场 smart全球扩张提速,2025年目标新增超10个海外市场 BBA汽车行业三巨头24年战报公布,谁是英雄or谁被打击? 2025年电动车电池新选择:钠电池、石墨烯电池还是智能铅酸电池? 尝鲜买新手机获千元优惠 汽车补贴延伸至车后市场