obsidian/笔记文件/2.笔记/多边形地图漏斗寻路算法_第二章.md
2025-03-26 00:02:56 +08:00

4.4 KiB
Raw Permalink Blame History

导航地图NavMap会把之前的逻辑串联起来有关键字partial分部类和方法,声明了,各个寻路顶点的数据容器,寻路区域的数组; 还有边界字典borderDic和areaIDDic用来处理可用的区域边界 另外还有3个Action委托函数用来处理Scene场景配合NavView相关逻辑绘制寻路结果

!Pasted image 20240408145744.png

GetBorderLstByAreaID函数接口通过区域id从边界字典borderDic拿到对应的边界队列容器

!Pasted image 20240408155423.png

设置基础节点数据是遍历所有的节点根据索引大小设置key关联字符

!Pasted image 20240408153356.png

继续如果borderDic边界字典容器包含上述key索引就会调用边界的areaID1和areaID2两个区域ID完成新key构建放到areaIDDic边界字典容器而且这个不是单独的边界isShared布尔会设置为true

一开始的时候是没有对应key的就往边界字典borderDic里面构建NavBorder边界体加到容器即可

!Pasted image 20240408153547.png

这是单独边界

!Pasted image 20240408155849.png

这些是isShared为true的共享边界

!Pasted image 20240408160015.png

继续通过边界的isShared布尔变量加到singleLst队列容器再从边界字典borderDic中移除它们 使用上述解析的GetBorderLstByAreaID函数通过区域id索引areaID对区域的边界队列borderLst完成赋值

!Pasted image 20240408155535.png

GetBorderByAreaIDKey接口通过key在区域字典areaIDDic中拿到它的边界

!Pasted image 20240408160642.png

OnXZSegment接口判断叉乘是否为0也就是面积为0点乘为负数也就是方向相反判断落点是否在线条上 这个接口后续是用于判断落点是否在寻路的检测区域内如果在线上那就肯定在区域内了所以直接返回true即可参考向量Dot点乘与Cross叉乘的概念及几何意义

!Pasted image 20240408160737.png

通过PNPoly算法配合OnXZSegment接口判断向量点是否在检测区域内

!Pasted image 20240408161029.png

算法对应的C语言公式

int pnpoly(int nvert, float *vertx, float *verty, float testx, float testy)
{
  int i, j, c = 0;
  for (i = 0, j = nvert-1; i < nvert; j = i++) {
    if ( ((verty[i]>testy) != (verty[j]>testy)) &&
	 (testx < (vertx[j]-vertx[i]) * (testy-verty[i]) / (verty[j]-verty[i]) + vertx[i]) )
       c = !c;
  }
  return c;
}

调用上述检测区域接口判断传参坐标pos是否在检测区域然后返回对应的检测区域id即可

!Pasted image 20240408161401.png

这是一个自定义堆队列类PEQue也是继承自IComparable接口,具体逻辑解析,参考基于堆实现优先级队列即可

!Pasted image 20240408165629.png

导航地图NavMap的分部类对应的脚本位置

!Pasted image 20240408165744.png

它的结构是由两个region组成分别是A星算法和漏斗算法

!Pasted image 20240408165934.png

A星算法主要是用于检测开始点和结束点它们之间的寻路路径所路过的NavArea寻路区域 声明开始点、结束点所在对应的区域m_startArea和m_endArea 而检测队列m_detectQue会使用上述优先级队列相关逻辑 另外还有两个队列容器分别是已完成检测的m_finishLst和最终返回得到的所路过的m_pathLst区域队列容器

!Pasted image 20240408170017.png

检测周边区域的核心逻辑; 完成邻近区域的前一个区域preArea字段和总距离sumDistance字段赋值 通过一系列布尔判断后放到已检测队列容器m_detectQue参考IsPositiveInfinity 通过寻路区域的CalcNavAreaDis接口拿到跟最终位置区域的距离加上当前寻路总距离sumDistance作为priority优先级赋值具体逻辑解析 A星寻路算法即可;

!Pasted image 20240408170541.png

跟A星算法相关逻辑一样倒着获取寻路的前一个节点preArea 从最终寻路的结束点end通过while死循环函数倒着找前一个节点preArea直到它是null空值为止 然后使用分部类NavMap中GetBorderByAreaIDKey接口通过key在区域字典areaIDDic中拿到对应的边界即可

!Pasted image 20240408171039.png