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

算法框图

原创文化更多>>

6万级国产燃油家轿,掀翻合资最后一块自留地? 销量进入20-30万级中型纯电前三,奥迪E5 Sportback凭何成为破局标杆 广汽发布多项自研技术,聚焦动力、车身、座舱与芯片 面子里子底子“层层加码” 荣威i6开启预售 欧拉5深度产品力解析:一款“较真”的纯电紧凑型SUV,究竟有多能打? 中型SUV杀入12万级市场,奇瑞风云T9L上市售12.99万起 新款问界M9要来了!配六激光雷达+全主动悬架,大卖又稳了? 星途EX7豪华大五座的中大型SUV,内饰搭载的30英寸悬浮式中控联屏,成为整车一大亮点 吉利i-HEV智擎混动技术正式发布,重新定义新一代油电混动 风云T9L售价12.99-18.69万元|每一项升级都是诱惑 11.5万欧元起!腾势登陆欧洲,中国豪华电动改写全球规则 比亚迪越野开发中心开放,解密仰望U8硬核进阶密码 荣威i6限时预售6.59万起,油车依旧能打? 车圈高层齐聚论坛:有人讲降本,有人提醒上半场痛点仍存 以中国为轴心全速转型,合资矩阵与重磅新车齐发力 瑞虎7双车杀入8万级市场:奇瑞的“价值平权”与燃油车的精品化反击 东风日产NX8正式上市 重塑20万级新能源SUV价值标杆 真正决定一家中国企业能否走进去的,是它能不能让德国市场和德国产业体系相信 五菱与华为携手,20万级对标理想的华境S正式亮相 探店试驾零跑A10:内饰越级、后排宽敞,8万落地还挑啥刺? 四缸也能博关注?TLD签名版福特Mustang登场,限量550台! “汪曾”组合履新奕境,均为岚图背景有何深意? 长安汽车火力升级 5款新车来袭 长安CS75 PLUS HEV领衔 华境S优势在于华为智能配置、安全硬件扎实、权益力度可观,而且可以依托五菱成熟制造体系保障品质 魏建军官宣,哈弗首款30万SUV即将发布 布加迪EB112,全球限量3台四门超跑概念座驾现世,其中一台即将拍卖 深蓝汽车3月销量成绩亮眼,新能源赛道稳步向前 广汽丰田铂智7上市复盘 下:解答新能源时代“丰田品质”是什么 20万级配置、50万级智驾体验!2026款小鹏MONA M03上市11.98万起 小鹏MONA搭载小鹏自研的混合碳化硅扁线电驱系统,电驱峰值效率达到95%,续航可提升20–30km