C++ 实现高效的 A* 寻路算法逻辑 _ 曼哈顿距离与优先级队列优化【源码】

千敏吖_3843

千敏吖_3843

2026-05-19

838人浏览

原创

std::priority_queue默认为最大堆,A*需显式构造最小堆,正确比较器应返回a.f > b.f;启发式函数须可采纳,四连通用曼哈顿距离,八连通需匹配斜移代价;须用best_g数组查重,因priority_queue不支持decrease-key。

c++ 实现高效的 a* 寻路算法逻辑 _ 曼哈顿距离与优先级队列优化【源码】

std::priority_queue 必须显式配最小堆,否则 A* 完全反向

默认 std::priority_queue 是最大堆,直接 push 节点后每次 top() 拿到的是 f 最大的节点——搜索会优先往最差方向跑,轻则绕路,重则卡死在局部高 f 区域。

正确做法是提供自定义比较器,且逻辑必须写成 a.f > b.f(注意不是 ):

struct Compare {
    bool operator()(const Node& a, const Node& b) {
        return a.f > b.f;  // 小的 f 排前面 → 实际构建最小堆
    }
};
std::priority_queue<node std::vector>, Compare> open_list;</node>

常见错误:

  • 写成 return a.f → 变成最大堆,行为失控
  • 用 std::greater 却没重载 operator> → 编译失败或未定义行为
  • C++20 用 lambda 时忘记传 decltype(cmp) 给模板参数 → 链接错误

启发式函数必须满足可采纳性,否则最优性崩塌

曼哈顿距离在四连通网格中安全;八连通下若斜移代价为 1.414,却仍用曼哈顿距离,就会高估部分路径的剩余代价,破坏可采纳性——A* 退化为贪心搜索,路径明显绕远甚至找不到解。

按移动模型选 heuristic:

  • 四方向(上下左右):用 abs(dx) + abs(dy)
  • 八方向(含对角线),斜移代价 = 1.414:用 max(abs(dx), abs(dy)) * 1.414 或带开方的欧氏距离 sqrt(dx*dx + dy*dy)
  • 禁止使用 dx*dx + dy*dy(平方欧氏):它不满足三角不等式,会导致 h 过度乐观
  • 禁止返回负值或 NaN:检查输入坐标是否越界,避免 abs 前未校验

不能只靠 priority_queue 查重,必须维护 best_g 数组

std::priority_queue 不支持修改已有节点的 f 值,也没有 decrease-key。如果邻居节点已入队但新算出更小的 g,你无法原地更新——硬改会破坏堆序,后续 pop() 顺序错乱。

C++14
C++14

C++14 对 C++11 的修正与增强版本,适合旧系统维护和较老工具链兼容。

下载

实用方案是「允许重复入队 + 弹出时过滤」:

  • 用二维数组 best_g[y][x] 记录当前已知最小 g 值(初始化为 FLT_MAX)
  • 生成邻居时,先算 tentative_g = current.g + cost
  • 仅当 tentative_g 才更新 best_g 并 push 新节点
  • 每次 open_list.top() 后,立刻检查 current.g != best_g[current.y][current.x] → 若不等,说明已有更优版本,continue

这比手写可更新堆简单可靠,中小地图内存开销可控,且避免了漏掉更优路径的风险。

get_neighbors 必须预筛位移,不能靠 is_walkable 补救

直接循环 {x±1,y}, {x,y±1} 再调用 is_walkable(),看似简洁,实则隐患多:边界检查滞后、对角线规则不统一、数组索引易反(尤其 grid[y][x] 习惯下 y 在前)。

推荐做法:

  • 预先定义位移表:const int dir8[8][2] = {{-1,-1},{-1,0},..., {0,-1}};
  • 遍历每个 dir,立即计算 nx = x + dir[i][0], ny = y + dir[i][1]
  • 紧接着做两层检查:!is_out_of_bounds(ny, nx) 和 grid[ny][nx] != WALL(注意顺序:先防越界,再查障碍)
  • 若支持八连通,斜向移动代价必须设为 1.414(或整数 14),否则算法会“嫌弃”对角线而绕行

这个细节不处理,你会看到路径在空旷区域也坚持横平竖直,明明可以切角却非要拐两个直角。

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

2288

9

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

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

2024.03.14

1059

6

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

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

2024.03.14

467

5

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

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

2024.03.14

347

5

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

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

2024.03.14

426

5

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

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

2024.03.14

600

5

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

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

2024.03.21

1449

9

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

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

2024.03.22

1237

7

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

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

2024.03.25

1345

9

热门下载

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

精品课程

更多
相关推荐
/
热门推荐
/
最新课程
C++ Core Guidelines
C++ Core Guidelines

共0课时 | 0人学习

C++ Reference
C++ Reference

共0课时 | 0人学习

C++ 官方标准说明
C++ 官方标准说明

共0课时 | 0人学习