| | | 1 | | //======================================================================= |
| | | 2 | | // ExactContactImpulseState.cs |
| | | 3 | | //======================================================================= |
| | | 4 | | // MIT License, Copyright (c) 2026-present David Oravsky (mrdav30) |
| | | 5 | | // See LICENSE file in the project root for full license information. |
| | | 6 | | //======================================================================= |
| | | 7 | | |
| | | 8 | | using System; |
| | | 9 | | |
| | | 10 | | namespace Gravitas.CollisionHandling; |
| | | 11 | | |
| | | 12 | | /// <summary> |
| | | 13 | | /// Retains oversized impulses for one frozen contact row during one solver step. |
| | | 14 | | /// Normal numerators share the row's fixed denominator. Tangents retain rounded |
| | | 15 | | /// Q32.32 integer magnitudes, so repeated disk projections cannot grow radicals. |
| | | 16 | | /// </summary> |
| | | 17 | | internal sealed class ExactContactImpulseState |
| | | 18 | | { |
| | | 19 | | internal const int Words = 48; |
| | | 20 | | private ulong[]? _normal; |
| | | 21 | | private ulong[]? _tangents; |
| | | 22 | | internal bool HasNormal { get; private set; } |
| | | 23 | | internal bool HasTangents { get; private set; } |
| | | 24 | | internal int PrimarySign { get; private set; } |
| | | 25 | | internal int SecondarySign { get; private set; } |
| | 112 | 26 | | internal ReadOnlySpan<ulong> NormalNumerator => HasNormal ? _normal!.AsSpan(0, Words) : ReadOnlySpan<ulong>.Empty; |
| | 13 | 27 | | internal ReadOnlySpan<ulong> NormalDenominator => HasNormal ? _normal!.AsSpan(Words, Words) : ReadOnlySpan<ulong>.Em |
| | 69 | 28 | | internal ReadOnlySpan<ulong> PrimaryMagnitude => HasTangents ? _tangents!.AsSpan(0, Words) : ReadOnlySpan<ulong>.Emp |
| | 54 | 29 | | internal ReadOnlySpan<ulong> SecondaryMagnitude => HasTangents ? _tangents!.AsSpan(Words, Words) : ReadOnlySpan<ulon |
| | | 30 | | |
| | | 31 | | internal void Clear() |
| | | 32 | | { |
| | 44 | 33 | | HasNormal = HasTangents = false; |
| | 44 | 34 | | PrimarySign = SecondarySign = 0; |
| | 44 | 35 | | } |
| | | 36 | | |
| | | 37 | | internal void SetNormal(ReadOnlySpan<ulong> numerator, ReadOnlySpan<ulong> denominator) |
| | | 38 | | { |
| | 145 | 39 | | _normal ??= new ulong[Words * 2]; |
| | 145 | 40 | | numerator.CopyTo(_normal.AsSpan(0, Words)); |
| | 145 | 41 | | denominator.CopyTo(_normal.AsSpan(Words, Words)); |
| | 145 | 42 | | HasNormal = true; |
| | 145 | 43 | | } |
| | | 44 | | |
| | | 45 | | internal void SetTangents(ReadOnlySpan<ulong> primary, int primarySign, |
| | | 46 | | ReadOnlySpan<ulong> secondary, int secondarySign) |
| | | 47 | | { |
| | 24 | 48 | | _tangents ??= new ulong[Words * 2]; |
| | 24 | 49 | | primary.CopyTo(_tangents.AsSpan(0, Words)); |
| | 24 | 50 | | secondary.CopyTo(_tangents.AsSpan(Words, Words)); |
| | 24 | 51 | | PrimarySign = primarySign; |
| | 24 | 52 | | SecondarySign = secondarySign; |
| | 24 | 53 | | HasTangents = true; |
| | 24 | 54 | | } |
| | | 55 | | } |