| | | 1 | | //======================================================================= |
| | | 2 | | // WideAxis3.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 | | namespace FixedMathSharp.Geometry; |
| | | 9 | | |
| | | 10 | | /// <summary> |
| | | 11 | | /// Stores an exact three-component axis used by rigid wide geometry. |
| | | 12 | | /// </summary> |
| | | 13 | | internal readonly struct WideAxis3 |
| | | 14 | | { |
| | | 15 | | internal readonly Signed320 X; |
| | | 16 | | internal readonly Signed320 Y; |
| | | 17 | | internal readonly Signed320 Z; |
| | | 18 | | |
| | | 19 | | internal WideAxis3(Signed320 x, Signed320 y, Signed320 z) |
| | | 20 | | { |
| | 104924 | 21 | | X = x; |
| | 104924 | 22 | | Y = y; |
| | 104924 | 23 | | Z = z; |
| | 104924 | 24 | | } |
| | | 25 | | |
| | 35372 | 26 | | internal bool IsZero => X.IsZero && Y.IsZero && Z.IsZero; |
| | | 27 | | |
| | | 28 | | internal Signed576 SquaredLength => |
| | 57844 | 29 | | WideArithmetic.AddSigned576( |
| | 57844 | 30 | | WideArithmetic.AddSigned576( |
| | 57844 | 31 | | WideArithmetic.MultiplySigned320(X, X), |
| | 57844 | 32 | | WideArithmetic.MultiplySigned320(Y, Y)), |
| | 57844 | 33 | | WideArithmetic.MultiplySigned320(Z, Z)); |
| | | 34 | | |
| | | 35 | | internal static WideAxis3 Cross(in WideAxis3 left, in WideAxis3 right) => |
| | 12869 | 36 | | new( |
| | 12869 | 37 | | Signed320.NarrowValue(WideArithmetic.SubtractSigned576( |
| | 12869 | 38 | | WideArithmetic.MultiplySigned320(left.Y, right.Z), |
| | 12869 | 39 | | WideArithmetic.MultiplySigned320(left.Z, right.Y))), |
| | 12869 | 40 | | Signed320.NarrowValue(WideArithmetic.SubtractSigned576( |
| | 12869 | 41 | | WideArithmetic.MultiplySigned320(left.Z, right.X), |
| | 12869 | 42 | | WideArithmetic.MultiplySigned320(left.X, right.Z))), |
| | 12869 | 43 | | Signed320.NarrowValue(WideArithmetic.SubtractSigned576( |
| | 12869 | 44 | | WideArithmetic.MultiplySigned320(left.X, right.Y), |
| | 12869 | 45 | | WideArithmetic.MultiplySigned320(left.Y, right.X)))); |
| | | 46 | | |
| | | 47 | | internal static Signed576 Dot(in WideAxis3 left, in WideAxis3 right) => |
| | 40806 | 48 | | WideArithmetic.AddSigned576( |
| | 40806 | 49 | | WideArithmetic.AddSigned576( |
| | 40806 | 50 | | WideArithmetic.MultiplySigned320(left.X, right.X), |
| | 40806 | 51 | | WideArithmetic.MultiplySigned320(left.Y, right.Y)), |
| | 40806 | 52 | | WideArithmetic.MultiplySigned320(left.Z, right.Z)); |
| | | 53 | | |
| | | 54 | | public static WideAxis3 operator -(WideAxis3 value) => |
| | 44 | 55 | | new( |
| | 44 | 56 | | WideArithmetic.SubtractSigned320(default, value.X), |
| | 44 | 57 | | WideArithmetic.SubtractSigned320(default, value.Y), |
| | 44 | 58 | | WideArithmetic.SubtractSigned320(default, value.Z)); |
| | | 59 | | } |