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

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

千敏吖_3843

千敏吖_3843

发布时间:2026-05-19 08:21:59

|

838人浏览过

|

来源于php中文网

原创

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<Node>, Compare> open_list;

常见错误:

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

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

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

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

按移动模型选 heuristic:

C++14
C++14

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

下载
  • 四方向(上下左右):用 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() 顺序错乱。

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

  • 用二维数组 best_g[y][x] 记录当前已知最小 g 值(初始化为 FLT_MAX)
  • 生成邻居时,先算 tentative_g = current.g + cost
  • 仅当 tentative_g 才更新 <code>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),否则算法会“嫌弃”对角线而绕行

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

热门AI工具

更多
切问学术

切问学术是一款AI论文写作工具,复旦大学NLP团队推出的AI学术智能体。

花生AI
花生AI Hot

一款AI视频创作工具,主要用于B站推出的AI视频创作工具,适合需要提升相关任务效率的用户。

SkildArt
SkildArt Hot

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

WorkBuddy

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

Seko
Seko Hot

一款AI视频创作工具,主要用于商汤科技推出的创编一体的AI短视频创作Agent,适合需要提升相关任务效率的用户。

DeepSeek

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

豆包大模型

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

PixPix
PixPix Hot

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

讯飞智作

讯飞智作是一款AI视频创作工具,AI文本配音工具,数字人课程、营销视频制作。

相关专题

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

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

2288

2024.03.14

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

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

1059

2024.03.14

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

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

467

2024.03.14

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

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

347

2024.03.14

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

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

426

2024.03.14

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

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

600

2024.03.14

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

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

1449

2024.03.21

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

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

1237

2024.03.22

Postman身份认证怎么配置
Postman身份认证怎么配置

本专题从实际API接口调试场景出发,讲解Postman身份认证的完整配置流程,包括常见认证协议介绍、授权参数设置、访问令牌填写、OAuth 2.0授权及认证失败排查,帮助用户正确完成接口授权与访问验证。

0

2026.11.06

热门下载

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

精品课程

更多
相关推荐
/
热门推荐
/
最新课程
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