| | | 1 | | using System.Runtime.CompilerServices; |
| | | 2 | | |
| | | 3 | | namespace FixedMathSharp; |
| | | 4 | | |
| | | 5 | | /// <summary> |
| | | 6 | | /// Provides extension methods for the Vector3d type to support additional vector operations, comparisons, and conversio |
| | | 7 | | /// </summary> |
| | | 8 | | public static partial class Vector3dExtensions |
| | | 9 | | { |
| | | 10 | | #region Vector3d Operations |
| | | 11 | | |
| | | 12 | | /// <summary> |
| | | 13 | | /// Clamps each component of the vector to the range [-1, 1] in place and returns the modified vector. |
| | | 14 | | /// </summary> |
| | | 15 | | /// <param name="v">The vector to clamp.</param> |
| | | 16 | | /// <returns>The clamped vector with each component between -1 and 1.</returns> |
| | | 17 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 18 | | public static Vector3d ClampOneInPlace(this Vector3d v) |
| | 1 | 19 | | { |
| | 1 | 20 | | v.x = v.x.ClampOne(); |
| | 1 | 21 | | v.y = v.y.ClampOne(); |
| | 1 | 22 | | v.z = v.z.ClampOne(); |
| | 1 | 23 | | return v; |
| | 1 | 24 | | } |
| | | 25 | | |
| | | 26 | | /// <inheritdoc cref="Vector3d.ClampMagnitude(Vector3d, Fixed64)" /> |
| | | 27 | | public static Vector3d ClampMagnitude(this Vector3d value, Fixed64 maxMagnitude) |
| | 1 | 28 | | { |
| | 1 | 29 | | return Vector3d.ClampMagnitude(value, maxMagnitude); |
| | 1 | 30 | | } |
| | | 31 | | |
| | | 32 | | /// <summary> |
| | | 33 | | /// Checks if the distance between two vectors is less than or equal to a specified factor. |
| | | 34 | | /// </summary> |
| | | 35 | | /// <param name="me">The current vector.</param> |
| | | 36 | | /// <param name="other">The vector to compare distance to.</param> |
| | | 37 | | /// <param name="factor">The maximum allowable distance.</param> |
| | | 38 | | /// <returns>True if the distance between the vectors is less than or equal to the factor, false otherwise.</returns |
| | | 39 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 40 | | public static bool CheckDistance(this Vector3d me, Vector3d other, Fixed64 factor) |
| | 1 | 41 | | { |
| | 1 | 42 | | var dis = Vector3d.Distance(me, other); |
| | 1 | 43 | | return dis <= factor; |
| | 1 | 44 | | } |
| | | 45 | | |
| | | 46 | | /// <inheritdoc cref="Vector3d.Rotate(Vector3d, Vector3d, FixedQuaternion)" /> |
| | | 47 | | public static Vector3d Rotate(this Vector3d source, Vector3d position, FixedQuaternion rotation) |
| | 1 | 48 | | { |
| | 1 | 49 | | return Vector3d.Rotate(source, position, rotation); |
| | 1 | 50 | | } |
| | | 51 | | |
| | | 52 | | /// <inheritdoc cref="Vector3d.InverseRotate(Vector3d, Vector3d, FixedQuaternion)" /> |
| | | 53 | | public static Vector3d InverseRotate(this Vector3d source, Vector3d position, FixedQuaternion rotation) |
| | 1 | 54 | | { |
| | 1 | 55 | | return Vector3d.InverseRotate(source, position, rotation); |
| | 1 | 56 | | } |
| | | 57 | | |
| | | 58 | | #endregion |
| | | 59 | | |
| | | 60 | | #region Conversion |
| | | 61 | | |
| | | 62 | | /// <inheritdoc cref="Vector3d.ToDegrees(Vector3d)" /> |
| | | 63 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 64 | | public static Vector3d ToDegrees(this Vector3d radians) |
| | 1 | 65 | | { |
| | 1 | 66 | | return Vector3d.ToDegrees(radians); |
| | 1 | 67 | | } |
| | | 68 | | |
| | | 69 | | /// <inheritdoc cref="Vector3d.ToRadians(Vector3d)" /> |
| | | 70 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 71 | | public static Vector3d ToRadians(this Vector3d degrees) |
| | 1 | 72 | | { |
| | 1 | 73 | | return Vector3d.ToRadians(degrees); |
| | 1 | 74 | | } |
| | | 75 | | |
| | | 76 | | /// <inheritdoc cref="Vector3d.Abs(Vector3d)" /> |
| | | 77 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 78 | | public static Vector3d Abs(this Vector3d value) |
| | 1 | 79 | | { |
| | 1 | 80 | | return Vector3d.Abs(value); |
| | 1 | 81 | | } |
| | | 82 | | |
| | | 83 | | /// <inheritdoc cref="Vector3d.Sign(Vector3d)" /> |
| | | 84 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 85 | | public static Vector3d Sign(Vector3d value) |
| | 1 | 86 | | { |
| | 1 | 87 | | return Vector3d.Sign(value); |
| | 1 | 88 | | } |
| | | 89 | | |
| | | 90 | | #endregion |
| | | 91 | | |
| | | 92 | | #region Equality |
| | | 93 | | |
| | | 94 | | /// <summary> |
| | | 95 | | /// Compares two vectors for approximate equality, allowing a fixed absolute difference. |
| | | 96 | | /// </summary> |
| | | 97 | | /// <param name="me">The current vector.</param> |
| | | 98 | | /// <param name="other">The vector to compare against.</param> |
| | | 99 | | /// <param name="allowedDifference">The allowed absolute difference between each component.</param> |
| | | 100 | | /// <returns>True if the components are within the allowed difference, false otherwise.</returns> |
| | | 101 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 102 | | public static bool FuzzyEqualAbsolute(this Vector3d me, Vector3d other, Fixed64 allowedDifference) |
| | 6 | 103 | | { |
| | 6 | 104 | | return (me.x - other.x).Abs() <= allowedDifference && |
| | 6 | 105 | | (me.y - other.y).Abs() <= allowedDifference && |
| | 6 | 106 | | (me.z - other.z).Abs() <= allowedDifference; |
| | 6 | 107 | | } |
| | | 108 | | |
| | | 109 | | /// <summary> |
| | | 110 | | /// Compares two vectors for approximate equality, allowing a fractional difference (percentage). |
| | | 111 | | /// Handles zero components by only using the allowed percentage difference. |
| | | 112 | | /// </summary> |
| | | 113 | | /// <param name="me">The current vector.</param> |
| | | 114 | | /// <param name="other">The vector to compare against.</param> |
| | | 115 | | /// <param name="percentage">The allowed fractional difference (percentage) for each component.</param> |
| | | 116 | | /// <returns>True if the components are within the allowed percentage difference, false otherwise.</returns> |
| | | 117 | | [MethodImpl(MethodImplOptions.AggressiveInlining)] |
| | | 118 | | public static bool FuzzyEqual(this Vector3d me, Vector3d other, Fixed64? percentage = null) |
| | 44 | 119 | | { |
| | 44 | 120 | | Fixed64 p = percentage ?? Fixed64.Epsilon; |
| | 44 | 121 | | return me.x.FuzzyComponentEqual(other.x, p) && |
| | 44 | 122 | | me.y.FuzzyComponentEqual(other.y, p) && |
| | 44 | 123 | | me.z.FuzzyComponentEqual(other.z, p); |
| | 44 | 124 | | } |
| | | 125 | | |
| | | 126 | | #endregion |
| | | 127 | | } |