| | | 1 | | //======================================================================= |
| | | 2 | | // TopologyVoxelAabb.cs |
| | | 3 | | //======================================================================= |
| | | 4 | | // MIT License, Copyright (c) 2024–present David Oravsky (mrdav30) |
| | | 5 | | // See LICENSE file in the project root for full license information. |
| | | 6 | | //======================================================================= |
| | | 7 | | |
| | | 8 | | using System.Runtime.CompilerServices; |
| | | 9 | | using FixedMathSharp; |
| | | 10 | | using GridForge.Spatial; |
| | | 11 | | |
| | | 12 | | namespace GridForge.Grids.Topology; |
| | | 13 | | |
| | | 14 | | internal readonly struct TopologyVoxelAabb |
| | | 15 | | { |
| | | 16 | | public readonly Vector3d Min; |
| | | 17 | | |
| | | 18 | | public readonly Vector3d Max; |
| | | 19 | | |
| | | 20 | | public TopologyVoxelAabb(Vector3d min, Vector3d max) |
| | | 21 | | { |
| | 198 | 22 | | Min = min; |
| | 198 | 23 | | Max = max; |
| | 198 | 24 | | } |
| | | 25 | | |
| | | 26 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 27 | | public static TopologyVoxelAabb FromVoxel(VoxelGrid grid, Voxel voxel) => |
| | 94 | 28 | | FromIndex(grid, voxel.Index); |
| | | 29 | | |
| | | 30 | | public static TopologyVoxelAabb FromIndex(VoxelGrid grid, VoxelIndex index) |
| | | 31 | | { |
| | 148 | 32 | | Vector3d center = grid.GetWorldPosition(index); |
| | 148 | 33 | | Vector3d halfExtents = GetHalfExtents(grid.Topology); |
| | 148 | 34 | | return new TopologyVoxelAabb(center - halfExtents, center + halfExtents); |
| | | 35 | | } |
| | | 36 | | |
| | | 37 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 38 | | public TopologyVoxelAabb Expand(Fixed64 tolerance) |
| | | 39 | | { |
| | 66 | 40 | | if (tolerance <= Fixed64.Zero) |
| | 32 | 41 | | return this; |
| | | 42 | | |
| | 34 | 43 | | Vector3d expansion = new(tolerance, tolerance, tolerance); |
| | 34 | 44 | | return new TopologyVoxelAabb(Min - expansion, Max + expansion); |
| | | 45 | | } |
| | | 46 | | |
| | | 47 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 48 | | public bool Overlaps(TopologyVoxelAabb other, Fixed64 tolerance) => |
| | 111 | 49 | | AxisOverlaps(Min.X, Max.X, other.Min.X, other.Max.X, tolerance) |
| | 111 | 50 | | && AxisOverlaps(Min.Y, Max.Y, other.Min.Y, other.Max.Y, tolerance) |
| | 111 | 51 | | && AxisOverlaps(Min.Z, Max.Z, other.Min.Z, other.Max.Z, tolerance); |
| | | 52 | | |
| | | 53 | | private static Vector3d GetHalfExtents(IGridTopology topology) |
| | | 54 | | { |
| | 148 | 55 | | GridTopologyMetrics metrics = topology.Metrics; |
| | 148 | 56 | | Fixed64 halfY = metrics.LayerHeight * Fixed64.Half; |
| | | 57 | | |
| | 148 | 58 | | if (topology.Kind == GridTopologyKind.HexPrism) |
| | | 59 | | { |
| | 39 | 60 | | Fixed64 halfHexWidth = HexCoordinateUtility.Sqrt3 * metrics.CellRadius * Fixed64.Half; |
| | 39 | 61 | | return metrics.HexOrientation == HexOrientation.FlatTop |
| | 39 | 62 | | ? new Vector3d(metrics.CellRadius, halfY, halfHexWidth) |
| | 39 | 63 | | : new Vector3d(halfHexWidth, halfY, metrics.CellRadius); |
| | | 64 | | } |
| | | 65 | | |
| | 109 | 66 | | return new Vector3d( |
| | 109 | 67 | | metrics.CellWidth * Fixed64.Half, |
| | 109 | 68 | | halfY, |
| | 109 | 69 | | metrics.CellLength * Fixed64.Half); |
| | | 70 | | } |
| | | 71 | | |
| | | 72 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 73 | | private static bool AxisOverlaps( |
| | | 74 | | Fixed64 firstMin, |
| | | 75 | | Fixed64 firstMax, |
| | | 76 | | Fixed64 secondMin, |
| | | 77 | | Fixed64 secondMax, |
| | | 78 | | Fixed64 tolerance) |
| | | 79 | | { |
| | 319 | 80 | | Fixed64 resolvedTolerance = tolerance > Fixed64.Zero ? tolerance : Fixed64.Zero; |
| | 319 | 81 | | return firstMax >= secondMin - resolvedTolerance |
| | 319 | 82 | | && firstMin <= secondMax + resolvedTolerance; |
| | | 83 | | } |
| | | 84 | | } |