C++如何实现简单的A*寻路算法

秋墨小哥_4122

秋墨小哥_4122

2026-05-29

301人浏览

原创

std::priority_queue不支持decrease-key操作,导致a*无法更新已入队节点的f值,从而可能找不到最优路径;应改用std::set或带惰性删除的堆实现。

c++如何实现简单的a*寻路算法

为什么直接用 std::priority_queue 会卡在“找不到更优路径”?

因为 std::priority_queue 不支持修改已入队节点的优先级(即无法做 decrease-key 操作),而 A* 在重估某个已访问节点的 f(n) = g(n) + h(n) 时,必须能更新它在开放列表中的位置。硬塞重复节点会导致内存和时间浪费,还可能错过最优解。

实操建议:

  • 改用 std::set<:pair node>></:pair> 或 std::set 自定义比较器(按 f 值升序),插入/删除/查找都是 O(log n),且可 erase 后重新 insert 实现“更新”
  • 或者用 std::vector + std::make_heap 手动维护,配合一个 std::unordered_map<node float></node> 记录当前最小 f 值,每次 pop 前检查是否过期(lazy deletion)
  • 别用 std::priority_queue<node></node> 直接存结构体——除非你重载了 operator 且确保每次 push 的都是最新状态

曼哈顿距离 vs 欧氏距离:选哪个影响路径平滑性?

网格地图(上下左右移动)用曼哈顿距离:abs(x1 - x2) + abs(y1 - y2);允许斜向移动(8方向)时,用对角线距离更准:max(abs(x1 - x2), abs(y1 - y2))。欧氏距离虽然数学上更“真实”,但在整数网格中会导致浮点误差、比较不稳定,且不满足 A* 要求的“启发函数不能高估”的条件(除非你严格保证浮点精度)。

常见错误现象:路径绕远、反复横跳、甚至死循环(尤其当 h(n) 偶尔大于实际代价时)。

使用场景判断:

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

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

下载
  • 纯四向移动 → 用曼哈顿
  • 八向移动 + 允许斜向成本为 1.4 → 用对角线距离(dx + dy - min(dx, dy)),或预计算查表避免重复开方
  • 任意角度移动(如 navmesh)→ 改用欧氏,但必须用 double 且所有比较加 epsilon 容差

Node 结构里哪些字段不能省?

最少要存这四个:x, y, g, parent。漏掉 parent 就没法回溯路径;只存 f 不存 g 会导致无法正确更新邻居的 g 值(因为 g_new = g_current + cost);没 x/y 就没法算 h,也没法查是否在关闭列表里。

性能提示:

  • 用 std::unordered_set 存关闭列表,key 推荐用 y * width + x(整数哈希比 pair 快)
  • 开放列表若用 std::set,比较函数里别实时算 h——提前算好存在 Node 里,否则每次比较都触发一次计算
  • 不要把整个地图数据存在每个 Node 里,传引用或全局单例访问障碍信息

遇到“路径不存在”却没报错,怎么快速定位?

最常被忽略的是起点或终点本身是障碍物——A* 默认不检查,直接从起点扩展,结果第一个邻居就全被跳过,开放列表变空后静默返回空路径。

调试建议:

  • 初始化时立刻检查 grid[start.y][start.x] 和 grid[end.y][end.x] 是否可通行,不通过直接 return
  • 每次从开放列表 pop 节点后,打一行日志:pop (x,y), g=..., f=...,如果第一行就是终点,说明启发函数爆炸了;如果 pop 几十轮后列表为空,大概率是地图连通性问题
  • 把关闭列表 size 输出出来,正常寻路中它应持续增长;如果卡在 1 或 2 不动,说明邻居遍历逻辑有 bug(比如坐标越界没判,或方向数组写错)

真正难调的不是公式,是边界和状态同步——比如更新邻居时用了旧的 g 值,或忘记把新节点加入开放列表就去设 parent。

C++免费学习笔记(深入):立即使用
在学习笔记中,你将探索 C++ 的入门与实战技巧!

相关文章

PHP速学视频免费教程(入门到精通)
PHP速学视频免费教程(入门到精通)

PHP怎么学习?PHP怎么入门?PHP在哪学?PHP怎么学才快?不用担心,这里为大家提供了PHP速学教程(入门到精通),有需要的小伙伴保存下载就能学习啦!

下载

相关标签:

c++

本站声明:本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系admin@php.cn

相关专题

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

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

2024.03.14

2108

9

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

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

2024.03.14

959

6

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

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

2024.03.14

387

5

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

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

2024.03.14

307

5

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

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

2024.03.14

366

5

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

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

2024.03.14

560

5

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

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

2024.03.21

1389

9

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

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

2024.03.22

1177

7

c++和c语言学习顺序推荐
c++和c语言学习顺序推荐

对于初学者,建议先学习C语言,掌握编程基础后再转入C++,便于理解面向对象编程概念。有编程经验者可直接学习C++,快速接触高级编程技术。想了解更多c++和c语言的相关内容,可以阅读本专题下面的文章。

2024.03.25

1305

9

热门下载

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

精品课程

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

共0课时 | 0人学习

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

共0课时 | 0人学习

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

共0课时 | 0人学习