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

for unity3d

This commit is contained in:
ikpil 2023-07-18 22:16:06 +09:00
parent 6dbd22ecb7
commit d58f3937de
2 changed files with 31 additions and 24 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
src/DotRecast.Recast.Demo/Tools/TestNavmeshTool.cs
View File

@ -38,7 +38,7 @@ public class TestNavmeshTool : IRcTool
private List<long> m_polys; private List<long> m_polys;
private List<long> m_parent; private List<long> m_parent;
private float m_neighbourhoodRadius; private float m_neighbourhoodRadius;
private readonly RcVec3f[] m_queryPoly = new RcVec3f[4]; private RcVec3f[] m_queryPoly = new RcVec3f[4];
private List<RcVec3f> m_smoothPath; private List<RcVec3f> m_smoothPath;
private DtStatus m_pathFindStatus = DtStatus.DT_FAILURE; private DtStatus m_pathFindStatus = DtStatus.DT_FAILURE;
private readonly List<RcVec3f> randomPoints = new(); private readonly List<RcVec3f> randomPoints = new();
@ -264,7 +264,6 @@ public class TestNavmeshTool : IRcTool
m_distanceToWall = 0; m_distanceToWall = 0;
if (m_sposSet && m_startRef != 0) if (m_sposSet && m_startRef != 0)
{ {
m_distanceToWall = 0.0f;
var result = m_navQuery.FindDistanceToWall(m_startRef, m_spos, 100.0f, m_filter, out var hitDist, out var hitPos, out var hitNormal); var result = m_navQuery.FindDistanceToWall(m_startRef, m_spos, 100.0f, m_filter, out var hitDist, out var hitPos, out var hitNormal);
if (result.Succeeded()) if (result.Succeeded())
{ {
@ -298,33 +297,13 @@ public class TestNavmeshTool : IRcTool
{ {
if (m_sposSet && m_startRef != 0 && m_eposSet) if (m_sposSet && m_startRef != 0 && m_eposSet)
{ {
float nx = (m_epos.z - m_spos.z) * 0.25f;
float nz = -(m_epos.x - m_spos.x) * 0.25f;
float agentHeight = _impl.GetSample() != null ? _impl.GetSample().GetSettings().agentHeight : 0;
m_queryPoly[0].x = m_spos.x + nx * 1.2f;
m_queryPoly[0].y = m_spos.y + agentHeight / 2;
m_queryPoly[0].z = m_spos.z + nz * 1.2f;
m_queryPoly[1].x = m_spos.x - nx * 1.3f;
m_queryPoly[1].y = m_spos.y + agentHeight / 2;
m_queryPoly[1].z = m_spos.z - nz * 1.3f;
m_queryPoly[2].x = m_epos.x - nx * 0.8f;
m_queryPoly[2].y = m_epos.y + agentHeight / 2;
m_queryPoly[2].z = m_epos.z - nz * 0.8f;
m_queryPoly[3].x = m_epos.x + nx;
m_queryPoly[3].y = m_epos.y + agentHeight / 2;
m_queryPoly[3].z = m_epos.z + nz;
var refs = new List<long>(); var refs = new List<long>();
var parentRefs = new List<long>(); var parentRefs = new List<long>();
var costs = new List<float>();
var status = m_navQuery.FindPolysAroundShape(m_startRef, m_queryPoly, m_filter, ref refs, ref parentRefs, ref costs); var status = _impl.FindPolysAroundShape(m_startRef, m_spos, m_epos, m_filter, ref refs, ref parentRefs, out var queryPoly);
if (status.Succeeded()) if (status.Succeeded())
{ {
m_queryPoly = queryPoly;
m_polys = refs; m_polys = refs;
m_parent = parentRefs; m_parent = parentRefs;
} }

28
src/DotRecast.Recast.DemoTool/Tools/TestNavmeshToolImpl.cs
View File

@ -251,5 +251,33 @@ namespace DotRecast.Recast.DemoTool.Tools
return status; return status;
} }
public DtStatus FindPolysAroundShape(long startRef, RcVec3f m_spos, RcVec3f m_epos, IDtQueryFilter filter, ref List<long> resultRef, ref List<long> resultParent, out RcVec3f[] queryPoly)
{
float nx = (m_epos.z - m_spos.z) * 0.25f;
float nz = -(m_epos.x - m_spos.x) * 0.25f;
float agentHeight = GetSample() != null ? GetSample().GetSettings().agentHeight : 0;
queryPoly = new RcVec3f[4];
queryPoly[0].x = m_spos.x + nx * 1.2f;
queryPoly[0].y = m_spos.y + agentHeight / 2;
queryPoly[0].z = m_spos.z + nz * 1.2f;
queryPoly[1].x = m_spos.x - nx * 1.3f;
queryPoly[1].y = m_spos.y + agentHeight / 2;
queryPoly[1].z = m_spos.z - nz * 1.3f;
queryPoly[2].x = m_epos.x - nx * 0.8f;
queryPoly[2].y = m_epos.y + agentHeight / 2;
queryPoly[2].z = m_epos.z - nz * 0.8f;
queryPoly[3].x = m_epos.x + nx;
queryPoly[3].y = m_epos.y + agentHeight / 2;
queryPoly[3].z = m_epos.z + nz;
var costs = new List<float>();
var navQuery = _sample.GetNavMeshQuery();
return navQuery.FindPolysAroundShape(startRef, queryPoly, filter, ref resultRef, ref resultParent, ref costs);
}
} }
} }