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

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

酷芳姑娘_9220

酷芳姑娘_9220

发布时间:2026-04-11 20:03:16

|

930人浏览过

|

来源于php中文网

原创

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。

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

C++14
C++14

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

下载
  • 典型错误: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 估算不准时),导致内存暴涨、性能骤降,甚至错过更优路径。

必须额外维护一个二维数组或哈希表记录「当前已知最小 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。

热门AI工具

更多
SkildArt
SkildArt Hot

SkildArt是一款AI文本写作工具,一站式 AI 视觉创作平台。

讯飞绘文

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

超级简历WonderCV

一款AI办公效率工具,主要用于免费求职简历模版下载制作,应届生职场人必备简历制作神器,适合需要提升相关任务效率的用户。

DeepSeek

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

UP简历
UP简历 Hot

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

豆包大模型

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

Laper
Laper Hot

Laper是专为编剧、导演和制片人推出的 AI 原生剧本创作工具。

PixPix
PixPix Hot

PixPix是一款面向电商视觉生产的AI商品图生成工具。

WorkBuddy

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

相关专题

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

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

2158

2023.09.20

java break和continue
java break和continue

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

747

2025.10.24

java break和continue
java break和continue

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

747

2025.10.24

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

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

5647

2023.07.18

堆和栈区别
堆和栈区别

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

2448

2023.08.10

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

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

5756

2023.08.14

OpenJDK JVM参数怎么调优
OpenJDK JVM参数怎么调优

Java应用运行缓慢,如何调整JVM参数?本专题介绍OpenJDK JVM性能调优的基本流程,涵盖性能指标确认、运行数据采集、内存配置和垃圾回收分析,帮助你先定位瓶颈,再通过对照测试验证效果,避免直接套用参数而影响应用稳定性。

0

2026.10.16

OpenJDK怎么配置Java开发环境
OpenJDK怎么配置Java开发环境

怎样用OpenJDK搭建开发环境?本专题介绍版本选择、下载安装、环境变量配置和编译运行验证,帮助你理清JDK的作用及基本配置流程,并通过简单程序检查环境是否可用,为后续项目开发做好准备。

0

2026.10.16

OpenJDK怎么部署Java应用
OpenJDK怎么部署Java应用

Java项目开发完成后,怎样部署到目标环境并正常运行?本专题介绍OpenJDK应用部署流程,涵盖运行环境准备、版本兼容检查、应用打包、启动参数配置和日志查看,帮助你理清部署前后的操作顺序,减少环境差异造成的运行问题。

0

2026.10.16

热门下载

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

精品课程

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

共0课时 | 0人学习

C++ Reference
C++ Reference

共0课时 | 0人学习

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

共0课时 | 0人学习

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

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