forked from mirror/DotRecast
82 lines
3.0 KiB
C#
82 lines
3.0 KiB
C#
|
/*
|
||
|
|
recast4j copyright (c) 2021 Piotr Piastucki piotr@jtilia.org
|
||
|
|
|
||
|
|
This software is provided 'as-is', without any express or implied
|
||
|
|
warranty. In no event will the authors be held liable for any damages
|
||
|
|
arising from the use of this software.
|
||
|
|
Permission is granted to anyone to use this software for any purpose,
|
||
|
|
including commercial applications, and to alter it and redistribute it
|
||
|
|
freely, subject to the following restrictions:
|
||
|
|
1. The origin of this software must not be misrepresented; you must not
|
||
|
|
claim that you wrote the original software. If you use this software
|
||
|
|
in a product, an acknowledgment in the product documentation would be
|
||
|
|
appreciated but is not required.
|
||
|
|
2. Altered source versions must be plainly marked as such, and must not be
|
||
|
|
misrepresented as being the original software.
|
||
|
|
3. This notice may not be removed or altered from any source distribution.
|
||
|
|
*/
|
||
|
|
|
||
|
|
using System.Collections.Generic;
|
||
|
|
using DotRecast.Core;
|
||
|
|
|
||
|
|
namespace DotRecast.Recast
|
||
|
|
{
|
||
|
|
|
||
|
|
public static class PolyMeshRaycast
|
||
|
|
{
|
||
|
|
public static float? raycast(IList<RecastBuilderResult> results, Vector3f src, Vector3f dst)
|
||
|
|
{
|
||
|
|
foreach (RecastBuilderResult result in results)
|
||
|
|
{
|
||
|
|
if (result.getMeshDetail() != null)
|
||
|
|
{
|
||
|
|
float? intersection = raycast(result.getMesh(), result.getMeshDetail(), src, dst);
|
||
|
|
if (null != intersection)
|
||
|
|
{
|
||
|
|
return intersection;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return null;
|
||
|
|
}
|
||
|
|
|
||
|
|
private static float? raycast(PolyMesh poly, PolyMeshDetail meshDetail, Vector3f sp, Vector3f sq)
|
||
|
|
{
|
||
|
|
if (meshDetail != null)
|
||
|
|
{
|
||
|
|
for (int i = 0; i < meshDetail.nmeshes; ++i)
|
||
|
|
{
|
||
|
|
int m = i * 4;
|
||
|
|
int bverts = meshDetail.meshes[m];
|
||
|
|
int btris = meshDetail.meshes[m + 2];
|
||
|
|
int ntris = meshDetail.meshes[m + 3];
|
||
|
|
int verts = bverts * 3;
|
||
|
|
int tris = btris * 4;
|
||
|
|
for (int j = 0; j < ntris; ++j)
|
||
|
|
{
|
||
|
|
Vector3f[] vs = new Vector3f[3];
|
||
|
|
for (int k = 0; k < 3; ++k)
|
||
|
|
{
|
||
|
|
vs[k][0] = meshDetail.verts[verts + meshDetail.tris[tris + j * 4 + k] * 3];
|
||
|
|
vs[k][1] = meshDetail.verts[verts + meshDetail.tris[tris + j * 4 + k] * 3 + 1];
|
||
|
|
vs[k][2] = meshDetail.verts[verts + meshDetail.tris[tris + j * 4 + k] * 3 + 2];
|
||
|
|
}
|
||
|
|
|
||
|
|
float? intersection = Intersections.intersectSegmentTriangle(sp, sq, vs[0], vs[1], vs[2]);
|
||
|
|
if (null != intersection)
|
||
|
|
{
|
||
|
|
return intersection;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
// TODO: check PolyMesh instead
|
||
|
|
}
|
||
|
|
|
||
|
|
return null;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|