C++实现简单的A*寻路算法 _ 启发式函数与优先级队列【源码】

酷芳姑娘_9220

酷芳姑娘_9220

2026-04-11

930人浏览

原创

a*绕路或卡死主因是启发式函数不满足可采纳性或优先队列配置错误:四连通用曼哈顿距离,八连通需匹配斜移代价;c++中priority_queue需自定义升序比较器,并辅以best_g数组查重。

c++实现简单的a*寻路算法 _ 启发式函数与优先级队列【源码】

为什么你的 A* 一直绕路或卡死?检查 heuristic 是否满足可采纳性

绝大多数 A* 行为异常(比如不走直线、重复访问节点、找不到最优解)都源于启发式函数写错了。最常见的是用了欧氏距离但没开方,或者在网格地图里误用对角线距离却没加权重校正。

在四连通(上下左右)网格中,manhattan_distance 是安全且可采纳的;八连通(含斜向)时,若允许斜移代价为 1.414,则启发式必须用 chebyshev 或带权重的欧氏距离,否则会破坏可采纳性——A* 就退化成 Dijkstra,甚至失效。

  • 错误示例:heuristic = sqrt(dx*dx + dy*dy)(未取整、未适配移动代价模型)
  • 正确做法:四向移动就用 abs(dx) + abs(dy);八向且斜移代价为 1.414,启发式应为 max(abs(dx), abs(dy)) * 1.414 或直接用 sqrt() 但确保所有边权一致
  • 调试技巧:打印前 5 个出队节点的 f = g + h 值,观察 h 是否单调非增(理想情况下应随接近终点而稳定下降)

std::priority_queue 默认不是最小堆,你得自己配 Compare

C++ 的 std::priority_queue 默认是最大堆,而 A* 需要每次取出 f 值最小的节点。直接写 priority_queue<node></node> 会导致算法完全反向搜索。

必须显式提供比较器,且注意逻辑取反:你要“小的优先”,就得让 operator() 返回 true 当第一个参数「应该排在后面」——即按 f 升序,实际要写成 a.f > b.f。

  • 典型错误:struct Compare { bool operator()(const Node& a, const Node& b) { return a.f → 这反而建了最大堆
  • 正确写法:struct Compare { bool operator()(const Node& a, const Node& b) { return a.f > b.f; } };,然后声明为 priority_queue<node vector>, Compare></node>
  • 更简洁方式(C++20 起):auto cmp = [](const Node& a, const Node& b) { return a.f > b.f; };,再用 priority_queue<node vector>, decltype(cmp)></node>

开放列表与关闭列表不能只靠 priority_queue 查重

std::priority_queue 不支持随机访问和修改,也无法高效判断某节点是否已在队列中。如果仅靠它管理开放列表,同一坐标可能被多次插入(尤其在 h 估算不准时),导致内存暴涨、性能骤降,甚至错过更优路径。

C++14
C++14

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

下载

必须额外维护一个二维数组或哈希表记录「当前已知最小 g 值」,每次生成邻居时先比对:若新 g 更小,才更新并入队;否则跳过。

  • 推荐结构:vector<vector>> best_g(height, vector<int>(width, INT_MAX))</int></vector>,初始化为无穷大
  • 关键判断:if (new_g
  • 关闭列表可用 vector<vector>> closed</vector>,但注意:一旦节点出队就设为 true,后续即使有更优 g 到达该点,也不再处理(这是标准 A* 的剪枝行为)

网格越界、障碍物检测必须在邻居扩展时立刻做

很多实现把边界检查放在主循环开头或节点构造里,结果在生成邻居时直接用 x+1 算下标,导致数组越界崩溃或读到脏内存。障碍物检测也常被漏掉,让算法往墙里钻。

所有邻居坐标计算后,必须立即验证:是否在 [0, width) 和 [0, height) 内;对应地图值是否为通行(如 grid[y][x] == 0);且未被关闭(!closed[y][x])。

  • 错误顺序:for each dir → nx = x+dx, ny = y+dy → push to pq → later check bounds
  • 正确顺序:nx = x+dx; ny = y+dy; if (nx = w || ny = h) continue; if (grid[ny][nx] != 0 || closed[ny][nx]) continue;
  • 性能提示:把地图存为 vector<vector>></vector> 比 vector<vector>></vector> 更省内存,访问更快;障碍物值统一用 1,通行用 0,避免分支预测失败

真正难的不是写完 A*,而是让 heuristic 和移动代价模型严格匹配,同时不让 priority_queue 和查重逻辑互相打架。这两个地方一错,算法就既慢又错,还不好 debug。

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

相关文章

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

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

下载

相关标签:

c++

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

相关专题

更多
c语言const用法
c语言const用法

const是关键字,可以用于声明常量、函数参数中的const修饰符、const修饰函数返回值、const修饰指针。详细介绍:1、声明常量,const关键字可用于声明常量,常量的值在程序运行期间不可修改,常量可以是基本数据类型,如整数、浮点数、字符等,也可是自定义的数据类型;2、函数参数中的const修饰符,const关键字可用于函数的参数中,表示该参数在函数内部不可修改等等。

2023.09.20

2138

7

java break和continue
java break和continue

本专题整合了java break和continue的区别相关内容,阅读专题下面的文章了解更多详细内容。

2025.10.24

747

6

java break和continue
java break和continue

本专题整合了java break和continue的区别相关内容,阅读专题下面的文章了解更多详细内容。

2025.10.24

747

6

堆和栈的区别
堆和栈的区别

堆和栈的区别:1、内存分配方式不同;2、大小不同;3、数据访问方式不同;4、数据的生命周期。本专题为大家提供堆和栈的区别的相关的文章、下载、课程内容,供大家免费下载体验。

2023.07.18

5567

5

堆和栈区别
堆和栈区别

堆(Heap)和栈(Stack)是计算机中两种常见的内存分配机制。它们在内存管理的方式、分配方式以及使用场景上有很大的区别。本文将详细介绍堆和栈的特点、区别以及各自的使用场景。php中文网给大家带来了相关的教程以及文章欢迎大家前来学习阅读。

2023.08.10

2428

6

页面置换算法
页面置换算法

页面置换算法是操作系统中用来决定在内存中哪些页面应该被换出以便为新的页面提供空间的算法。本专题为大家提供页面置换算法的相关文章,大家可以免费体验。

2023.08.14

5676

4

Python uv使用教程
Python uv使用教程

本专题汇总了 Python uv 使用教程与高效使用指南,从 uv 安装配置、常用命令到虚拟环境、依赖管理与项目打包,系统讲解如何用 uv 替代 pip 与 poetry,全面提升 Python 项目开发效率,助你快速上手这一现代化包管理工具,打造干净高效的 Python 工作流。

2026.10.15

0

15

剧云AI短剧创作教程合集
剧云AI短剧创作教程合集

本专题聚焦剧云AI短剧创作,讲解从短剧灵感、梗概、全局大纲到分集、分场和正文的完整流程及节奏设计方法。

2026.10.14

0

15

剧云AI剧本创作零基础入门
剧云AI剧本创作零基础入门

本专题系统讲解剧云AI剧本创作流程,涵盖灵感、梗概、大纲、分场与正文生成,帮助新手快速完成首个中文剧本项目。

2026.10.14

0

14

热门下载

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

精品课程

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

共0课时 | 0人学习

C++ Reference
C++ Reference

共0课时 | 0人学习

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

共0课时 | 0人学习