obsidian/笔记文件/2.笔记/多边形地图漏斗寻路算法_第二章.md

96 lines
4.4 KiB
Markdown
Raw Permalink Normal View History

2025-03-26 00:02:56 +08:00
导航地图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语言公式
``` 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]]