| | | 1 | | //======================================================================= |
| | | 2 | | // TriangleShellMassProperties.TriangleCoordinates.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 FixedMathSharp; |
| | | 9 | | using FixedMathSharp.Geometry; |
| | | 10 | | |
| | | 11 | | namespace Gravitas.Colliders; |
| | | 12 | | |
| | | 13 | | /// <summary> |
| | | 14 | | /// Stores the three triangle vertices in the scalar form used by shell mass integration. |
| | | 15 | | /// </summary> |
| | | 16 | | internal readonly struct TriangleCoordinates |
| | | 17 | | { |
| | | 18 | | internal readonly Signed192 AX, AY, AZ, BX, BY, BZ, CX, CY, CZ; |
| | | 19 | | internal TriangleCoordinates(in FixedTriangle triangle, in ScaledRigidFrame3d frame, bool exactScale) |
| | | 20 | | { |
| | 175992 | 21 | | if (exactScale) |
| | | 22 | | { |
| | 873 | 23 | | frame.GetScaledLocalPointNumerators(triangle.A, out AX, out AY, out AZ); |
| | 873 | 24 | | frame.GetScaledLocalPointNumerators(triangle.B, out BX, out BY, out BZ); |
| | 873 | 25 | | frame.GetScaledLocalPointNumerators(triangle.C, out CX, out CY, out CZ); |
| | | 26 | | } |
| | | 27 | | else |
| | | 28 | | { |
| | 525357 | 29 | | AX = Signed192.Raw(triangle.A.X); AY = Signed192.Raw(triangle.A.Y); AZ = Signed192.Raw(triangle.A.Z); |
| | 525357 | 30 | | BX = Signed192.Raw(triangle.B.X); BY = Signed192.Raw(triangle.B.Y); BZ = Signed192.Raw(triangle.B.Z); |
| | 525357 | 31 | | CX = Signed192.Raw(triangle.C.X); CY = Signed192.Raw(triangle.C.Y); CZ = Signed192.Raw(triangle.C.Z); |
| | | 32 | | } |
| | 175119 | 33 | | } |
| | | 34 | | } |