讲师中心 微信公众号
AI工具推荐 视频效率加速

C++如何利用std::priority_queue实现A*寻路算法的队列

梦芳姑娘_5191

梦芳姑娘_5191

发布时间:2026-07-27 14:23:47

|

219人浏览过

|

来源于php中文网

原创

std::priority_queue不能直接用作A*开放列表,因其不支持decrease-key操作,无法更新已入队节点的f值,导致重复入队、内存浪费及可能错过最优路径;需改用std::set或惰性删除堆实现。

c++如何利用std::priority_queue实现a*寻路算法的队列

std::priority_queue 为什么不能直接用作 A* 的开放列表

因为 std::priority_queue 不支持修改已有元素的优先级(即不支持 decrease-key 操作),而 A* 在更新节点 g 值时必须能快速调整其在队列中的位置。一旦某个节点被重新发现且路径更优,你无法直接“把它的优先级调高”,只能插入新副本——这会导致重复节点堆积、内存浪费,甚至逻辑错误(比如已出队的节点又被再次处理)。

常见错误现象:std::priority_queue 中出现多个相同坐标的节点;visited 标记失效;寻路结果正确但性能断崖式下降(尤其在大地图中)。

  • 它底层是堆,只暴露 top()、push()、pop(),没有迭代器,无法定位或修改中间元素
  • 即使你用 std::make_heap 配合 vector 手动维护,也得自己实现 sift-down/sift-up,且容易出错
  • A* 对开放列表的核心要求是:O(1) 查找 + O(log n) 插入/更新,std::priority_queue 只满足后者的一半

替代方案:用 std::set 或 std::unordered\_set + 手动管理的 vector 堆

最实用、易维护的做法是:用 std::unordered_set(或 std::set)做快速存在性检查和去重,再用 std::vector + std::make_heap 维护带优先级的节点序列。这样既能查重,又能控制堆内元素唯一性。

示例结构体(关键点:重载 operator< 用于堆排序,同时用坐标哈希保证集合唯一):

立即学习“C++免费学习笔记(深入)”;

struct Node {
    int x, y;
    float f = 0.0f; // f = g + h
    bool operator<(const Node& other) const { return f > other.f; } // 小顶堆:f 小的优先
};

配合使用:

C++ 算法竞赛自动化测试数据生成与校验框架
C++ 算法竞赛自动化测试数据生成与校验框架

根据原题生成新题面、验证器及完整测试数据,自动套用 testlib 模板,用于用户要求生成测试数据时。

下载
  • std::unordered_set<std::pair<int,int>, PairHash> 存已加入开放列表的坐标(避免重复入队)
  • std::vector<Node> 存所有待处理节点,每次 push_back() 后调用 std::push_heap()
  • 更新节点时:先从 unordered_set 删除旧坐标,再插入新 Node 并 push_heap()

如果坚持用 std::priority\_queue,怎么规避问题

可以,但必须接受“惰性删除”策略:允许重复入队,但在 pop() 时跳过已访问或已更新过的节点。

具体操作:

  • 维护一个二维数组或 std::unordered_map<std::pair<int,int>, float> 记录每个坐标的当前最小 g 值
  • 每次 q.top() 取出后,立刻检查该节点的 g 值是否仍等于记录值;若已变小(说明有更优路径),continue
  • 入队时不检查重复,无条件 push(),靠后续过滤

性能影响:在障碍密集或启发函数较弱时,队列中无效节点可能占 70% 以上;std::priority_queue 大小膨胀,push() 和 pop() 的常数变大。

别忽略的细节:浮点精度与比较稳定性

A* 的 f 值常用 float 计算,但 std::priority_queue 的比较依赖 operator<。若两个 f 值因浮点误差几乎相等,排序行为可能不稳定,导致同一节点多次以不同顺序出队。

建议做法:

  • 用 double 替代 float 提高中间精度
  • 比较时加 epsilon 容差,但注意:堆算法要求严格弱序,不能简单写 abs(a.f - b.f) < eps;稳妥方式是先比整数部分(如将 f 缩放为 long long),或引入第二关键字(如曼哈顿距离、坐标哈希)打破平局
  • 例如:return std::tie(f, x, y) < std::tie(other.f, other.x, other.y);

真正卡住 A* 性能的,往往不是算法本身,而是队列里积压了上千个本该被丢弃的旧状态,或者因为浮点抖动让节点反复进出堆——这些细节比选什么容器更值得花时间盯住。

热门AI工具

更多
DeepSeek

DeepSeek是一款面向对话、写作、编程和推理场景的AI大模型工具。

豆包大模型

豆包大模型是一款由字节跳动推出的企业级大语言模型服务平台。

WorkBuddy

一款AI办公效率工具,主要用于腾讯云推出的AI原生桌面智能体工作台,适合需要提升相关任务效率的用户。

火山引擎

火山引擎是一款面向企业的云计算与AI服务平台。

Lovart
Lovart Hot

一款面向视觉设计创作的AI设计平台,可通过智能体和画布工作流辅助制作海报、Logo、网页、PPT及其他视觉内容。

UP简历
UP简历 Hot

一款AI办公效率工具,主要用于基于AI技术的免费在线简历制作工具,适合需要提升相关任务效率的用户。

二狗PPT
二狗PPT Hot

一款AI演示文稿工具,主要用于专为中式职场打造的AI PPT生成工具,适合需要提升相关任务效率的用户。

Atoms
Atoms Hot

Atoms是一款AI智能体工具,第一支自动构建真实业务的 AI 团队。

讯飞绘文

讯飞绘文是一款由科大讯飞推出的一站式 AIGC 内容运营平台。

相关专题

更多
c++和c语言的区别有哪些
c++和c语言的区别有哪些

c++和c语言的区别:1、面向对象编程(OOP)支持不同;2、新增特性不同;3、标准库不同;4、编译方式不同;5、命名空间不同等等。想了解更多c++的相关内容,可以阅读本专题下面的文章。

2148

2024.03.14

c++和python学习顺序推荐
c++和python学习顺序推荐

一般建议先学习C++,再学习Python,因为这样可以逐步从较为底层的编程语言向更高级的语言过渡。想了解更多python的相关内容,可以阅读本专题下面的文章。

959

2024.03.14

python和c++学习性价比分析
python和c++学习性价比分析

Python易于学习,广泛应用于Web开发、数据科学和人工智能等领域,但性能较低。C语言性能高,适用于对性能要求较高的场景,如游戏开发和系统编程,但学习曲线陡峭,错误处理复杂。想了解更多python的相关内容,可以阅读本专题下面的文章。

387

2024.03.14

c语言和c++一样吗
c语言和c++一样吗

c语言和c++是两种不同的编程语言,虽然有相似之处,但存在显著差异。c语言专注于过程式编程和系统级开发,以简洁、高效著称。c++作为c语言的超集,引入了面向对象编程,增强了代码组织和管理能力,但学习曲线也更陡峭。本专题为大家提供相关的文章、下载、课程内容,供大家免费下载体验。

307

2024.03.14

c语言和c++先学哪个好
c语言和c++先学哪个好

初学者选择学习c语言还是c++语言,需要根据个人学习目标、背景以及编程兴趣和预期应用方向来决定。本专题为大家提供相关的文章、下载、课程内容,供大家免费下载体验。

366

2024.03.14

c语言和c++的区别和联系
c语言和c++的区别和联系

c语言和c++是计算机科学领域应用广泛的编程语言。虽然它们有着相似的基础,但它们在语言类型、语法功能和内存管理方面存在着显著差异。本专题为大家提供相关的文章、下载、课程内容,供大家免费下载体验。

560

2024.03.14

c++软件中文更改教程
c++软件中文更改教程

对于 ide,可通过打开设置,找到语言设置,选择中文,并保存更改。对于非 ide 应用程序,可查找设置或选项,选择语言设置,更改为中文,并保存更改。想了解更多c++的相关内容,可以阅读本专题下面的文章。

1389

2024.03.21

python和java和c++学习性价比分析
python和java和c++学习性价比分析

Python以其易学性、丰富的库和活跃的社区而著称,适合数据科学、人工智能和Web开发。Java以其跨平台性、企业级应用开发和Android应用开发而闻名。C++以其底层控制能力、高效性能和游戏开发而著称。选择哪种语言取决于个人兴趣、职业方向和特定需求。想了解更多python和java和c++的相关内容,可以阅读本专题下面的文章。

1177

2024.03.22

Buffalo框架数据库开发全教程
Buffalo框架数据库开发全教程

本专题围绕Buffalo框架数据库开发,讲解database.yml多环境配置、soda与fizz迁移生成回滚、模型结构体标签、增删改查与条件查询、一对多与多对多关联、数据校验、回调钩子、事务处理及原生SQL执行能力。

80

2026.09.23

热门下载

更多
网站特效
/
网站源码
/
网站素材
/
前端模板

精品课程

更多
相关推荐
/
热门推荐
/
最新课程
Conan 2 Essentials 免费课程
Conan 2 Essentials 免费课程

共0课时 | 0人学习

CMake 与 Conan 集成实践
CMake 与 Conan 集成实践

共0课时 | 0人学习

Conan 2 高级依赖模型介绍
Conan 2 高级依赖模型介绍

共0课时 | 0人学习

关于我们 免责申明 举报中心 意见反馈 讲师合作 广告合作 最新更新
php中文网:公益在线php培训,帮助PHP学习者快速成长!
关注服务号
PHP中文网订阅号
每天精选资源文章推送

Copyright 2014-2026 https://www.php.cn/ All Rights Reserved | php.cn