修改水

This commit is contained in:
2026-01-01 22:00:33 +08:00
parent 040a222bd6
commit 9ceffccd39
1800 changed files with 103929 additions and 139495 deletions

View File

@@ -67,29 +67,17 @@ namespace Obi
int optimizationIterations,
float optimizationTolerance)
{
var co = new BurstQueryResult { simplexIndex = simplexIndex, queryIndex = shapeIndex };
var co = new BurstQueryResult() { simplexIndex = simplexIndex, queryIndex = shapeIndex };
float4 simplexBary = BurstMath.BarycenterForSimplexOfSize(simplexSize);
var colliderPoint = BurstLocalOptimization.Optimize(ref this, positions, orientations, radii, simplices, simplexStart, simplexSize,
ref simplexBary, out float4 convexPoint, optimizationIterations, optimizationTolerance);
float4 simplexPrevPosition = float4.zero;
float simplexRadius = 0;
for (int j = 0; j < simplexSize; ++j)
{
int particleIndex = simplices[simplexStart + j];
simplexPrevPosition += positions[particleIndex] * simplexBary[j];
simplexRadius += BurstMath.EllipsoidRadius(colliderPoint.normal, orientations[particleIndex], radii[particleIndex].xyz) * simplexBary[j];
}
var colliderPoint = BurstLocalOptimization.Optimize<BurstBoxQuery>(ref this, positions, orientations, radii, simplices, simplexStart, simplexSize,
ref simplexBary, out float4 convexPoint, optimizationIterations, optimizationTolerance);
co.queryPoint = colliderPoint.point;
co.normal = colliderPoint.normal;
co.simplexBary = simplexBary;
co.distance = math.dot(simplexPrevPosition - colliderPoint.point, colliderPoint.normal) - simplexRadius;
if (co.distance <= shape.maxDistance)
results.Enqueue(co);
results.Enqueue(co);
}
}