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

refactor: BuildCompactHeightfield

This commit is contained in:
ikpil 2024-01-11 00:30:46 +09:00
parent 278fb6cc1b
commit 87ef05feb8
1 changed files with 45 additions and 46 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

91
src/DotRecast.Recast/RcCompacts.cs
View File

@ -30,7 +30,6 @@ namespace DotRecast.Recast
public static class RcCompacts public static class RcCompacts
{ {
private const int MAX_LAYERS = RC_NOT_CONNECTED - 1;
private const int MAX_HEIGHT = RcConstants.RC_SPAN_MAX_HEIGHT; private const int MAX_HEIGHT = RcConstants.RC_SPAN_MAX_HEIGHT;
/// @} /// @}
@ -88,80 +87,81 @@ namespace DotRecast.Recast
.ToArray(); .ToArray();
// Fill in cells and spans. // Fill in cells and spans.
int idx = 0; int currentCellIndex = 0;
for (int y = 0; y < zSize; ++y) int numColumns = xSize * zSize;
for (int columnIndex = 0; columnIndex < numColumns; ++columnIndex)
{ {
for (int x = 0; x < xSize; ++x) RcSpan span = heightfield.spans[columnIndex];
// If there are no spans at this cell, just leave the data to index=0, count=0.
if (span == null)
continue;
int tmpIdx = currentCellIndex;
int tmpCount = 0;
for (; span != null; span = span.next)
{ {
RcSpan s = heightfield.spans[x + y * xSize]; if (span.area != RC_NULL_AREA)
// If there are no spans at this cell, just leave the data to index=0, count=0.
if (s == null)
continue;
int tmpIdx = idx;
int tmpCount = 0;
while (s != null)
{ {
if (s.area != RC_NULL_AREA) int bot = span.smax;
{ int top = span.next != null ? (int)span.next.smin : MAX_HEIGHT;
int bot = s.smax; tempSpans[currentCellIndex].y = Math.Clamp(bot, 0, MAX_HEIGHT);
int top = s.next != null ? (int)s.next.smin : MAX_HEIGHT; tempSpans[currentCellIndex].h = Math.Clamp(top - bot, 0, MAX_HEIGHT);
tempSpans[idx].y = Math.Clamp(bot, 0, MAX_HEIGHT); compactHeightfield.areas[currentCellIndex] = span.area;
tempSpans[idx].h = Math.Clamp(top - bot, 0, MAX_HEIGHT); currentCellIndex++;
compactHeightfield.areas[idx] = s.area; tmpCount++;
idx++;
tmpCount++;
}
s = s.next;
} }
compactHeightfield.cells[x + y * xSize] = new RcCompactCell(tmpIdx, tmpCount);
} }
compactHeightfield.cells[columnIndex] = new RcCompactCell(tmpIdx, tmpCount);
} }
// Find neighbour connections. // Find neighbour connections.
int tooHighNeighbour = 0; const int MAX_LAYERS = RC_NOT_CONNECTED - 1;
for (int y = 0; y < zSize; ++y) int maxLayerIndex = 0;
int zStride = xSize; // for readability
for (int z = 0; z < zSize; ++z)
{ {
for (int x = 0; x < xSize; ++x) for (int x = 0; x < xSize; ++x)
{ {
ref RcCompactCell c = ref compactHeightfield.cells[x + y * xSize]; ref RcCompactCell cell = ref compactHeightfield.cells[x + z * zStride];
for (int i = c.index, ni = c.index + c.count; i < ni; ++i) for (int i = cell.index, ni = cell.index + cell.count; i < ni; ++i)
{ {
ref RcCompactSpanBuilder s = ref tempSpans[i]; ref RcCompactSpanBuilder s = ref tempSpans[i];
for (int dir = 0; dir < 4; ++dir) for (int dir = 0; dir < 4; ++dir)
{ {
SetCon(s, dir, RC_NOT_CONNECTED); SetCon(s, dir, RC_NOT_CONNECTED);
int nx = x + GetDirOffsetX(dir); int neighborX = x + GetDirOffsetX(dir);
int ny = y + GetDirOffsetY(dir); int neighborZ = z + GetDirOffsetY(dir);
// First check that the neighbour cell is in bounds. // First check that the neighbour cell is in bounds.
if (nx < 0 || ny < 0 || nx >= xSize || ny >= zSize) if (neighborX < 0 || neighborZ < 0 || neighborX >= xSize || neighborZ >= zSize)
{
continue; continue;
}
// Iterate over all neighbour spans and check if any of the is // Iterate over all neighbour spans and check if any of the is
// accessible from current cell. // accessible from current cell.
ref RcCompactCell nc = ref compactHeightfield.cells[nx + ny * xSize]; ref RcCompactCell neighborCell = ref compactHeightfield.cells[neighborX + neighborZ * xSize];
for (int k = nc.index, nk = nc.index + nc.count; k < nk; ++k) for (int k = neighborCell.index, nk = neighborCell.index + neighborCell.count; k < nk; ++k)
{ {
ref RcCompactSpanBuilder ns = ref tempSpans[k]; ref RcCompactSpanBuilder neighborSpan = ref tempSpans[k];
int bot = Math.Max(s.y, ns.y); int bot = Math.Max(s.y, neighborSpan.y);
int top = Math.Min(s.y + s.h, ns.y + ns.h); int top = Math.Min(s.y + s.h, neighborSpan.y + neighborSpan.h);
// Check that the gap between the spans is walkable, // Check that the gap between the spans is walkable,
// and that the climb height between the gaps is not too high. // and that the climb height between the gaps is not too high.
if ((top - bot) >= walkableHeight && MathF.Abs(ns.y - s.y) <= walkableClimb) if ((top - bot) >= walkableHeight && MathF.Abs(neighborSpan.y - s.y) <= walkableClimb)
{ {
// Mark direction as walkable. // Mark direction as walkable.
int lidx = k - nc.index; int layerIndex = k - neighborCell.index;
if (lidx < 0 || lidx > MAX_LAYERS) if (layerIndex < 0 || layerIndex > MAX_LAYERS)
{ {
tooHighNeighbour = Math.Max(tooHighNeighbour, lidx); maxLayerIndex = Math.Max(maxLayerIndex, layerIndex);
continue; continue;
} }
SetCon(s, dir, lidx); SetCon(s, dir, layerIndex);
break; break;
} }
} }
@ -170,10 +170,9 @@ namespace DotRecast.Recast
} }
} }
if (tooHighNeighbour > MAX_LAYERS) if (maxLayerIndex > MAX_LAYERS)
{ {
throw new Exception("rcBuildCompactHeightfield: Heightfield has too many layers " + tooHighNeighbour throw new Exception($"rcBuildCompactHeightfield: Heightfield has too many layers {maxLayerIndex} (max: {MAX_LAYERS})");
+ " (max: " + MAX_LAYERS + ")");
} }
compactHeightfield.spans = tempSpans.Select(x => x.Build()).ToArray(); compactHeightfield.spans = tempSpans.Select(x => x.Build()).ToArray();