C++ 怎么在NavMesh多边形网格上运行A*寻路算法

梦晨君_5766

梦晨君_5766

2026-11-04

457人浏览

原创

NavMesh应以凸多边形为节点、共享边为邻接关系构建图结构;启发式函数采用目标点投影到NavMesh后的欧氏距离,移动代价用多边形中心距或共享边中点距;路径平滑需通过漏斗算法处理多边形序列生成折线。

c++ 怎么在navmesh多边形网格上运行a*寻路算法

NavMesh顶点和边怎么转成A\*图的节点与邻接关系

NavMesh本身不是图结构,而是由一系列凸多边形(polygons)拼接而成的平面区域。A\*需要显式的图:每个节点有坐标、可访问邻居、到目标的启发式距离。直接对多边形中心或顶点建图都容易出错——比如两个相邻多边形共享一条边,但它们的中心点可能被障碍物挡住,不能直线通行。

正确做法是:以每个多边形为一个图节点(Node),边表示多边形之间的连通性。两个多边形若共享一条完整边(非退化、未被阻挡),就互为邻居。这样避免了采样点失效问题,也天然支持“区域级”寻路决策。

  • NavMeshPolygon 类需带唯一 id 和顶点列表(用于后续路径平滑)
  • 预处理时遍历所有多边形对,用边匹配(如排序后比对顶点序列)判断是否相邻;更高效的做法是建立边→多边形映射表:map>
  • 不建议用顶点作节点:单个顶点可能属于 3–4 个多边形,导致图爆炸,且无法表达“穿过某区域”的语义

怎么定义A\*的启发式函数和移动代价

在NavMesh上,启发式不能简单用欧氏距离——因为两点虽直线近,但可能跨了不可通行区域。稳妥做法是:先对目标点做 closestPointOnNavMesh() 投影,再用该投影点到当前多边形中心的欧氏距离作启发值(h(n))。这要求你已有 NavMesh 的最近点查询能力(通常靠点定位 + 边到线段距离计算)。

移动代价(g(n))也不该是多边形中心间距离。理想代价是“从当前多边形到邻居多边形的最短可行穿越距离”,即两多边形共享边的中点到各自中心的距离和。但实现复杂,常用简化:用两中心距离,或统一设为 1(适合网格粗、区域大小相近的 NavMesh)。

  • 若 NavMesh 多边形尺寸差异大(如有的宽 10 米,有的仅 0.5 米),必须用几何距离加权,否则 A\* 会倾向选小多边形“绕远路”
  • 启发式函数必须满足可采纳性(h(n) ≤ 实际最小代价),否则 A\* 不保证最优;用投影点欧氏距离是安全的,但保守;用跳点搜索(JPS)思想预计算多边形间最小穿越距离可提升精度
  • 不要在启发式里调用完整路径查找——那会让每次 open-set 排序变成 O(N²)

怎么从A\*输出的多边形序列生成平滑的折线路径

A\* 返回的是多边形 ID 序列,比如 [p0, p1, p2, p3],但这只是“经过哪些区域”,不是“走哪条线”。真正路径需用 funnel algorithm(通道算法)收缩:把相邻多边形的共享边看作通道边界,从起点开始逐步收紧左右边界,遇到顶点就输出拐点。

C++14
C++14

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

下载

Funnel 算法输入是多边形序列的“门户边”(portal edges)列表,输出是顶点序列。它不依赖三角剖分,只用凸多边形性质,稳定且快。

  • 每个多边形必须存储其所有边,并能按顺时针/逆时针顺序返回相邻多边形对应的门户边端点
  • 起点和终点要先 clampToPolygon() 到各自多边形内,否则 funnel 可能发散
  • 如果 NavMesh 含凹多边形(不推荐),funnel 会失效;此时需先做耳切法三角化,或改用 string pulling + raycast 修正
  • 输出路径点默认在多边形边上,如需在区域内偏移(如避开墙角),可在 funnel 后对每段线段做 offsetLine() 或采样后局部优化

实际运行时常见的崩溃和卡死点

最常崩在点定位(point-in-polygon)和边匹配阶段:浮点误差导致两个本应重合的边被判定为不共享,结果图断开,A\* 找不到路并持续 expand 直到内存耗尽;或者 funnel 输入门户边顺序错乱,导致左右边界交叉,while 循环不退出。

  • 所有几何比较必须带 epsilon,例如 fabs(a - b) ,不要用 == 比较 float 坐标
  • 构建邻接图前,先验证 NavMesh 数据完整性:检查是否有孤立多边形、重复顶点、零面积多边形(用叉积判)
  • A\* open set 推荐用 std::priority_queue 配自定义 comparator,但注意 operator 必须严格弱序——若 f(n) 相同,需用 id 做第二排序键,否则可能漏节点
  • 调试时先禁用 funnel,直接画出多边形中心连线,确认 A\* 主干逻辑正确;再逐层打开几何细节

NavMesh 寻路真正的难点不在 A\* 本身,而在几何鲁棒性——同一份数据,在不同缩放单位、不同顶点顺序、不同浮点库下,边匹配和点定位结果都可能漂移。把 epsilon、归一化、顶点去重这些事做扎实,比优化启发式重要得多。

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

相关文章

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

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

下载

本站声明:本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系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

1039

6

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

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

2024.03.14

447

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

1429

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

1325

9

热门下载

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

精品课程

更多
相关推荐
/
热门推荐
/
最新课程
C++ 手册教程
C++ 手册教程

共41课时 | 78.6万人学习

C++ Core Guidelines
C++ Core Guidelines

共0课时 | 0人学习

C++ Reference
C++ Reference

共0课时 | 0人学习