refactor: RcVec3f.Min/Max

This commit is contained in:
ikpil 2023-10-25 23:44:01 +09:00
parent 28ad34b032
commit 7eba4e0c9d
13 changed files with 76 additions and 53 deletions

View File

@ -148,38 +148,24 @@ namespace DotRecast.Core.Numerics
return HashCode.Combine(X, Y, Z); return HashCode.Combine(X, Y, Z);
} }
[MethodImpl(MethodImplOptions.AggressiveInlining)] [MethodImpl(MethodImplOptions.AggressiveInlining)]
public void Min(float[] @in, int i) public static RcVec3f Min(RcVec3f value1, RcVec3f value2)
{ {
X = Math.Min(X, @in[i]); return new RcVec3f(
Y = Math.Min(Y, @in[i + 1]); (value1.X < value2.X) ? value1.X : value2.X,
Z = Math.Min(Z, @in[i + 2]); (value1.Y < value2.Y) ? value1.Y : value2.Y,
(value1.Z < value2.Z) ? value1.Z : value2.Z
);
} }
[MethodImpl(MethodImplOptions.AggressiveInlining)] [MethodImpl(MethodImplOptions.AggressiveInlining)]
public void Min(RcVec3f b) public static RcVec3f Max(RcVec3f value1, RcVec3f value2)
{ {
X = Math.Min(X, b.X); return new RcVec3f(
Y = Math.Min(Y, b.Y); (value1.X > value2.X) ? value1.X : value2.X,
Z = Math.Min(Z, b.Z); (value1.Y > value2.Y) ? value1.Y : value2.Y,
} (value1.Z > value2.Z) ? value1.Z : value2.Z
);
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public void Max(RcVec3f b)
{
X = Math.Max(X, b.X);
Y = Math.Max(Y, b.Y);
Z = Math.Max(Z, b.Z);
}
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public void Max(float[] @in, int i)
{
X = Math.Max(X, @in[i]);
Y = Math.Max(Y, @in[i + 1]);
Z = Math.Max(Z, @in[i + 2]);
} }
public override string ToString() public override string ToString()

View File

@ -155,5 +155,25 @@ namespace DotRecast.Core.Numerics
return v; return v;
} }
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static RcVec3f Min(RcVec3f v, float[] @in, int i)
{
return new RcVec3f(
(v.X < @in[i + 0]) ? v.X : @in[i + 0],
(v.Y < @in[i + 1]) ? v.Y : @in[i + 1],
(v.Z < @in[i + 2]) ? v.Z : @in[i + 2]
);
}
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static RcVec3f Max(RcVec3f v, float[] @in, int i)
{
return new RcVec3f(
(v.X > @in[i + 0]) ? v.X : @in[i + 0],
(v.Y > @in[i + 1]) ? v.Y : @in[i + 1],
(v.Z > @in[i + 2]) ? v.Z : @in[i + 2]
);
}
} }
} }

View File

@ -44,8 +44,8 @@ namespace DotRecast.Detour.Extras
RcVec3f bmax = new RcVec3f(data.verts.AsSpan(data.polys[i].verts[0] * 3)); RcVec3f bmax = new RcVec3f(data.verts.AsSpan(data.polys[i].verts[0] * 3));
for (int j = 1; j < data.polys[i].vertCount; j++) for (int j = 1; j < data.polys[i].vertCount; j++)
{ {
bmin.Min(data.verts, data.polys[i].verts[j] * 3); bmin = RcVecUtils.Min(bmin, data.verts, data.polys[i].verts[j] * 3);
bmax.Max(data.verts, data.polys[i].verts[j] * 3); bmax = RcVecUtils.Max(bmax, data.verts, data.polys[i].verts[j] * 3);
} }
it.bmin[0] = Math.Clamp((int)((bmin.X - data.header.bmin.X) * quantFactor), 0, 0x7fffffff); it.bmin[0] = Math.Clamp((int)((bmin.X - data.header.bmin.X) * quantFactor), 0, 0x7fffffff);

View File

@ -406,8 +406,8 @@ namespace DotRecast.Detour
for (int j = 1; j < p.vertCount; ++j) for (int j = 1; j < p.vertCount; ++j)
{ {
v = p.verts[j] * 3; v = p.verts[j] * 3;
bmin.Min(tile.data.verts, v); bmin = RcVecUtils.Min(bmin, tile.data.verts, v);
bmax.Max(tile.data.verts, v); bmax = RcVecUtils.Max(bmax, tile.data.verts, v);
} }
if (DtUtils.OverlapBounds(qmin, qmax, bmin, bmax)) if (DtUtils.OverlapBounds(qmin, qmax, bmin, bmax))

View File

@ -162,8 +162,8 @@ namespace DotRecast.Detour
var bmax = new RcVec3f(option.detailVerts.AsSpan(dv)); var bmax = new RcVec3f(option.detailVerts.AsSpan(dv));
for (int j = 1; j < ndv; j++) for (int j = 1; j < ndv; j++)
{ {
bmin.Min(option.detailVerts, dv + j * 3); bmin = RcVecUtils.Min(bmin, option.detailVerts, dv + j * 3);
bmax.Max(option.detailVerts, dv + j * 3); bmax = RcVecUtils.Max(bmax, option.detailVerts, dv + j * 3);
} }
// BV-tree uses cs for all dimensions // BV-tree uses cs for all dimensions

View File

@ -646,8 +646,8 @@ namespace DotRecast.Detour
for (int j = 1; j < p.vertCount; ++j) for (int j = 1; j < p.vertCount; ++j)
{ {
v = p.verts[j] * 3; v = p.verts[j] * 3;
bmin.Min(tile.data.verts, v); bmin = RcVecUtils.Min(bmin, tile.data.verts, v);
bmax.Max(tile.data.verts, v); bmax = RcVecUtils.Max(bmax, tile.data.verts, v);
} }
if (DtUtils.OverlapBounds(qmin, qmax, bmin, bmax)) if (DtUtils.OverlapBounds(qmin, qmax, bmin, bmax))

View File

@ -61,8 +61,8 @@ namespace DotRecast.Recast.Toolset.Geom
bmax = new RcVec3f(vertices); bmax = new RcVec3f(vertices);
for (int i = 1; i < vertices.Length / 3; i++) for (int i = 1; i < vertices.Length / 3; i++)
{ {
bmin.Min(vertices, i * 3); bmin = RcVecUtils.Min(bmin, vertices, i * 3);
bmax.Max(vertices, i * 3); bmax = RcVecUtils.Max(bmax, vertices, i * 3);
} }
_mesh = new RcTriMesh(vertices, faces); _mesh = new RcTriMesh(vertices, faces);

View File

@ -81,8 +81,8 @@ namespace DotRecast.Recast.Geom
bmax = new RcVec3f(vertices); bmax = new RcVec3f(vertices);
for (int i = 1; i < vertices.Length / 3; i++) for (int i = 1; i < vertices.Length / 3; i++)
{ {
bmin.Min(vertices, i * 3); bmin = RcVecUtils.Min(bmin, vertices, i * 3);
bmax.Max(vertices, i * 3); bmax = RcVecUtils.Max(bmax, vertices, i * 3);
} }
_mesh = new RcTriMesh(vertices, faces); _mesh = new RcTriMesh(vertices, faces);

View File

@ -461,8 +461,8 @@ namespace DotRecast.Recast
RcVec3f bmax = new RcVec3f(verts); RcVec3f bmax = new RcVec3f(verts);
for (int i = 3; i < verts.Length; i += 3) for (int i = 3; i < verts.Length; i += 3)
{ {
bmin.Min(verts, i); bmin = RcVecUtils.Min(bmin, verts, i);
bmax.Max(verts, i); bmax = RcVecUtils.Max(bmax, verts, i);
} }
bmin.Y = minY; bmin.Y = minY;

View File

@ -1004,8 +1004,8 @@ namespace DotRecast.Recast
RcVec3f bmax = new RcVec3f(@in); RcVec3f bmax = new RcVec3f(@in);
for (int i = 1; i < nin; ++i) for (int i = 1; i < nin; ++i)
{ {
bmin.Min(@in, i * 3); bmin = RcVecUtils.Min(bmin, @in, i * 3);
bmax.Max(@in, i * 3); bmax = RcVecUtils.Max(bmax, @in, i * 3);
} }
int x0 = (int)MathF.Floor(bmin.X / sampleDist); int x0 = (int)MathF.Floor(bmin.X / sampleDist);

View File

@ -20,6 +20,7 @@ freely, subject to the following restrictions:
using System; using System;
using DotRecast.Core; using DotRecast.Core;
using DotRecast.Core.Numerics;
namespace DotRecast.Recast namespace DotRecast.Recast
{ {
@ -1230,8 +1231,8 @@ namespace DotRecast.Recast
int maxVertsPerMesh = 0; int maxVertsPerMesh = 0;
for (int i = 0; i < nmeshes; ++i) for (int i = 0; i < nmeshes; ++i)
{ {
mesh.bmin.Min(meshes[i].bmin); mesh.bmin = RcVec3f.Min(mesh.bmin, meshes[i].bmin);
mesh.bmax.Max(meshes[i].bmax); mesh.bmax = RcVec3f.Max(mesh.bmax, meshes[i].bmax);
maxVertsPerMesh = Math.Max(maxVertsPerMesh, meshes[i].nverts); maxVertsPerMesh = Math.Max(maxVertsPerMesh, meshes[i].nverts);
maxVerts += meshes[i].nverts; maxVerts += meshes[i].nverts;
maxPolys += meshes[i].npolys; maxPolys += meshes[i].npolys;

View File

@ -239,10 +239,10 @@ namespace DotRecast.Recast
// Calculate the bounding box of the triangle. // Calculate the bounding box of the triangle.
RcVec3f tmin = new RcVec3f(verts.AsSpan(v0 * 3)); RcVec3f tmin = new RcVec3f(verts.AsSpan(v0 * 3));
RcVec3f tmax = new RcVec3f(verts.AsSpan(v0 * 3)); RcVec3f tmax = new RcVec3f(verts.AsSpan(v0 * 3));
tmin.Min(verts, v1 * 3); tmin = RcVecUtils.Min(tmin, verts, v1 * 3);
tmin.Min(verts, v2 * 3); tmin = RcVecUtils.Min(tmin, verts, v2 * 3);
tmax.Max(verts, v1 * 3); tmax = RcVecUtils.Max(tmax, verts, v1 * 3);
tmax.Max(verts, v2 * 3); tmax = RcVecUtils.Max(tmax, verts, v2 * 3);
// If the triangle does not touch the bbox of the heightfield, skip the triagle. // If the triangle does not touch the bbox of the heightfield, skip the triagle.
if (!OverlapBounds(heightfieldBBMin, heightfieldBBMax, tmin, tmax)) if (!OverlapBounds(heightfieldBBMin, heightfieldBBMax, tmin, tmax))

View File

@ -145,8 +145,24 @@ public class Vector3Tests
[Repeat(100000)] [Repeat(100000)]
public void TestVectorMinMax() public void TestVectorMinMax()
{ {
// Min var v1 = new Vector3(Random.Shared.NextSingle(), Random.Shared.NextSingle(), Random.Shared.NextSingle());
// Max var v2 = new Vector3(Random.Shared.NextSingle(), Random.Shared.NextSingle(), Random.Shared.NextSingle());
var v3 = Vector3.Min(v1, v2);
var v4 = Vector3.Max(v1, v2);
var v11 = new RcVec3f(v1.X, v1.Y, v1.Z);
var v22 = new RcVec3f(v2.X, v2.Y, v2.Z);
var v33 = RcVec3f.Min(v11, v22);
var v44 = RcVec3f.Max(v11, v22);
Assert.That(v3.X, Is.EqualTo(v33.X));
Assert.That(v3.Y, Is.EqualTo(v33.Y));
Assert.That(v3.Z, Is.EqualTo(v33.Z));
Assert.That(v4.X, Is.EqualTo(v44.X));
Assert.That(v4.Y, Is.EqualTo(v44.Y));
Assert.That(v4.Z, Is.EqualTo(v44.Z));
} }
[Test] [Test]