a.samsonkin
/
DotRecastNetSim
forked from bit/DotRecastNetSim
1
0
Fork 0
Code Pull Requests Activity

move

This commit is contained in:
ikpil 2023-07-13 20:39:22 +09:00
parent 92b4e06578
commit 7846d80528
1 changed files with 24 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

46
src/DotRecast.Detour/DtNavMesh.cs
View File

@ -1711,6 +1711,30 @@ namespace DotRecast.Detour
return DtStatus.DT_SUCCSESS; return DtStatus.DT_SUCCSESS;
} }
public RcVec3f GetPolyCenter(long refs)
{
RcVec3f center = RcVec3f.Zero;
var status = GetTileAndPolyByRef(refs, out var tile, out var poly);
if (status.Succeeded())
{
for (int i = 0; i < poly.vertCount; ++i)
{
int v = poly.verts[i] * 3;
center.x += tile.data.verts[v];
center.y += tile.data.verts[v + 1];
center.z += tile.data.verts[v + 2];
}
float s = 1.0f / poly.vertCount;
center.x *= s;
center.y *= s;
center.z *= s;
}
return center;
}
/** /**
* Get flags for edge in detail triangle. * Get flags for edge in detail triangle.
* *
@ -1737,28 +1761,6 @@ namespace DotRecast.Detour
return tiles; return tiles;
} }
public RcVec3f GetPolyCenter(long refs)
{
RcVec3f center = RcVec3f.Zero;
var status = GetTileAndPolyByRef(refs, out var tile, out var poly);
if (status.Succeeded())
{
for (int i = 0; i < poly.vertCount; ++i)
{
int v = poly.verts[i] * 3;
center.x += tile.data.verts[v];
center.y += tile.data.verts[v + 1];
center.z += tile.data.verts[v + 2];
}
float s = 1.0f / poly.vertCount;
center.x *= s;
center.y *= s;
center.z *= s;
}
return center;
}
} }
} }