// Copyright (c) 2012-2024 Wojciech Figat. All rights reserved. #if USE_LARGE_WORLDS using Real = System.Double; using Mathr = FlaxEngine.Mathd; #else using Real = System.Single; using Mathr = FlaxEngine.Mathf; #endif // ----------------------------------------------------------------------------- // Original code from SharpDX project. https://github.com/sharpdx/SharpDX/ // Greetings to Alexandre Mutel. Original code published with the following license: // ----------------------------------------------------------------------------- // Copyright (c) 2010-2014 SharpDX - Alexandre Mutel // // Permission is hereby granted, free of charge, to any person obtaining a copy // of this software and associated documentation files (the "Software"), to deal // in the Software without restriction, including without limitation the rights // to use, copy, modify, merge, publish, distribute, sublicense, and/or sell // copies of the Software, and to permit persons to whom the Software is // furnished to do so, subject to the following conditions: // // The above copyright notice and this permission notice shall be included in // all copies or substantial portions of the Software. // // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR // IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE // AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, // OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN // THE SOFTWARE. // ----------------------------------------------------------------------------- // Original code from SlimMath project. http://code.google.com/p/slimmath/ // Greetings to SlimDX Group. Original code published with the following license: // ----------------------------------------------------------------------------- /* * Copyright (c) 2007-2011 SlimDX Group * * Permission is hereby granted, free of charge, to any person obtaining a copy * of this software and associated documentation files (the "Software"), to deal * in the Software without restriction, including without limitation the rights * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell * copies of the Software, and to permit persons to whom the Software is * furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice shall be included in * all copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN * THE SOFTWARE. */ using System; using System.Globalization; using System.ComponentModel; using System.Runtime.CompilerServices; using System.Runtime.InteropServices; namespace FlaxEngine { /// /// Represents a two dimensional mathematical vector. /// [Unmanaged] [Serializable] [StructLayout(LayoutKind.Sequential)] #if FLAX_EDITOR [System.ComponentModel.TypeConverter(typeof(TypeConverters.Vector2Converter))] #endif public unsafe partial struct Vector2 : IEquatable, IFormattable { private static readonly string _formatString = "X:{0:F2} Y:{1:F2}"; /// /// The X component. /// public Real X; /// /// The Y component. /// public Real Y; /// /// The size of the type, in bytes. /// public static readonly int SizeInBytes = Marshal.SizeOf(typeof(Vector2)); /// /// A with all of its components set to zero. /// public static readonly Vector2 Zero; /// /// The X unit (1, 0). /// public static readonly Vector2 UnitX = new Vector2(1.0f, 0.0f); /// /// The Y unit (0, 1). /// public static readonly Vector2 UnitY = new Vector2(0.0f, 1.0f); /// /// A with all of its components set to half. /// public static readonly Vector2 Half = new Vector2(0.5f, 0.5f); /// /// A with all of its components set to one. /// public static readonly Vector2 One = new Vector2(1.0f, 1.0f); /// /// A with all components equal to (or if using 32-bit precision). /// public static readonly Vector2 Minimum = new Vector2(Real.MinValue); /// /// A with all components equal to (or if using 32-bit precision). /// public static readonly Vector2 Maximum = new Vector2(Real.MaxValue); /// /// Initializes a new instance of the struct. /// /// The value that will be assigned to all components. public Vector2(float value) { X = value; Y = value; } /// /// Initializes a new instance of the struct. /// /// Initial value for the X component of the vector. /// Initial value for the Y component of the vector. public Vector2(float x, float y) { X = x; Y = y; } /// /// Initializes a new instance of the struct. /// /// The value that will be assigned to all components. public Vector2(double value) { X = Y = (Real)value; } /// /// Initializes a new instance of the struct. /// /// Initial value for the X component of the vector. /// Initial value for the Y component of the vector. public Vector2(double x, double y) { X = (Real)x; Y = (Real)y; } /// /// Initializes a new instance of the struct. /// /// A vector containing the values with which to initialize the X and Y components. public Vector2(Vector3 value) { X = value.X; Y = value.Y; } /// /// Initializes a new instance of the struct. /// /// A vector containing the values with which to initialize the X and Y components. public Vector2(Vector4 value) { X = value.X; Y = value.Y; } /// /// Initializes a new instance of the struct. /// /// The values to assign to the X and Y components of the vector. This must be an array with two elements. /// Thrown when is null. /// Thrown when contains more or less than two elements. public Vector2(Real[] values) { if (values == null) throw new ArgumentNullException(nameof(values)); if (values.Length != 2) throw new ArgumentOutOfRangeException(nameof(values), "There must be two and only two input values for Vector2."); X = values[0]; Y = values[1]; } /// /// Gets a value indicting whether this instance is normalized. /// public bool IsNormalized => Mathr.IsOne(X * X + Y * Y); /// /// Gets a value indicting whether this vector is zero /// public bool IsZero => Mathr.IsZero(X) && Mathr.IsZero(Y); /// /// Gets a minimum component value /// public Real MinValue => Mathr.Min(X, Y); /// /// Gets a maximum component value /// public Real MaxValue => Mathr.Max(X, Y); /// /// Gets an arithmetic average value of all vector components. /// public Real AvgValue => (X + Y) * (1.0f / 2.0f); /// /// Gets a sum of the component values. /// public Real ValuesSum => X + Y; /// /// Gets a vector with values being absolute values of that vector. /// public Vector2 Absolute => new Vector2(Mathr.Abs(X), Mathr.Abs(Y)); /// /// Gets a vector with values being opposite to values of that vector. /// public Vector2 Negative => new Vector2(-X, -Y); /// /// Gets or sets the component at the specified index. /// /// The value of the X or Y component, depending on the index. /// The index of the component to access. Use 0 for the X component and 1 for the Y component. /// The value of the component at the specified index. /// Thrown when the is out of the range [0,1]. public Real this[int index] { get { switch (index) { case 0: return X; case 1: return Y; } throw new ArgumentOutOfRangeException(nameof(index), "Indices for Vector2 run from 0 to 1, inclusive."); } set { switch (index) { case 0: X = value; break; case 1: Y = value; break; default: throw new ArgumentOutOfRangeException(nameof(index), "Indices for Vector2 run from 0 to 1, inclusive."); } } } /// /// Calculates the length of the vector. /// /// The length of the vector. /// may be preferred when only the relative length is needed and speed is of the essence. public Real Length => (Real)Math.Sqrt(X * X + Y * Y); /// /// Calculates the squared length of the vector. /// /// The squared length of the vector. /// This method may be preferred to when only a relative length is needed and speed is of the essence. public Real LengthSquared => X * X + Y * Y; /// /// Converts the vector into a unit vector. /// public void Normalize() { Real length = (Real)Math.Sqrt(X * X + Y * Y); if (length >= Mathr.Epsilon) { Real inv = 1.0f / length; X *= inv; Y *= inv; } } /// /// Gets the normalized vector. Returned vector has length equal 1. /// public Vector2 Normalized { get { Vector2 result = this; result.Normalize(); return result; } } /// /// Creates an array containing the elements of the vector. /// public Real[] ToArray() { return new[] { X, Y }; } /// /// Adds two vectors. /// /// The first vector to add. /// The second vector to add. /// When the method completes, contains the sum of the two vectors. public static void Add(ref Vector2 left, ref Vector2 right, out Vector2 result) { result = new Vector2(left.X + right.X, left.Y + right.Y); } /// /// Adds two vectors. /// /// The first vector to add. /// The second vector to add. /// The sum of the two vectors. public static Vector2 Add(Vector2 left, Vector2 right) { return new Vector2(left.X + right.X, left.Y + right.Y); } /// /// Performs a component-wise addition. /// /// The input vector /// The scalar value to be added to elements /// The vector with added scalar for each element. public static void Add(ref Vector2 left, ref float right, out Vector2 result) { result = new Vector2(left.X + right, left.Y + right); } /// /// Performs a component-wise addition. /// /// The input vector /// The scalar value to be added to elements /// The vector with added scalar for each element. public static Vector2 Add(Vector2 left, float right) { return new Vector2(left.X + right, left.Y + right); } /// /// Subtracts two vectors. /// /// The first vector to subtract. /// The second vector to subtract. /// When the method completes, contains the difference of the two vectors. public static void Subtract(ref Vector2 left, ref Vector2 right, out Vector2 result) { result = new Vector2(left.X - right.X, left.Y - right.Y); } /// /// Subtracts two vectors. /// /// The first vector to subtract. /// The second vector to subtract. /// The difference of the two vectors. public static Vector2 Subtract(Vector2 left, Vector2 right) { return new Vector2(left.X - right.X, left.Y - right.Y); } /// /// Performs a component-wise subtraction. /// /// The input vector /// The scalar value to be subtracted from elements /// The vector with subtracted scalar for each element. public static void Subtract(ref Vector2 left, ref float right, out Vector2 result) { result = new Vector2(left.X - right, left.Y - right); } /// /// Performs a component-wise subtraction. /// /// The input vector /// The scalar value to be subtracted from elements /// The vector with subtracted scalar for each element. public static Vector2 Subtract(Vector2 left, float right) { return new Vector2(left.X - right, left.Y - right); } /// /// Performs a component-wise subtraction. /// /// The scalar value to be subtracted from elements /// The input vector /// The vector with subtracted scalar for each element. public static void Subtract(ref float left, ref Vector2 right, out Vector2 result) { result = new Vector2(left - right.X, left - right.Y); } /// /// Performs a component-wise subtraction. /// /// The scalar value to be subtracted from elements /// The input vector /// The vector with subtracted scalar for each element. public static Vector2 Subtract(float left, Vector2 right) { return new Vector2(left - right.X, left - right.Y); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// When the method completes, contains the scaled vector. public static void Multiply(ref Vector2 value, float scale, out Vector2 result) { result = new Vector2(value.X * scale, value.Y * scale); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 Multiply(Vector2 value, float scale) { return new Vector2(value.X * scale, value.Y * scale); } /// /// Multiplies a vector with another by performing component-wise multiplication. /// /// The first vector to multiply. /// The second vector to multiply. /// When the method completes, contains the multiplied vector. public static void Multiply(ref Vector2 left, ref Vector2 right, out Vector2 result) { result = new Vector2(left.X * right.X, left.Y * right.Y); } /// /// Multiplies a vector with another by performing component-wise multiplication. /// /// The first vector to multiply. /// The second vector to multiply. /// The multiplied vector. public static Vector2 Multiply(Vector2 left, Vector2 right) { return new Vector2(left.X * right.X, left.Y * right.Y); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// When the method completes, contains the scaled vector. public static void Divide(ref Vector2 value, float scale, out Vector2 result) { result = new Vector2(value.X / scale, value.Y / scale); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 Divide(Vector2 value, float scale) { return new Vector2(value.X / scale, value.Y / scale); } /// /// Scales a vector by the given value. /// /// The amount by which to scale the vector. /// The vector to scale. /// When the method completes, contains the scaled vector. public static void Divide(float scale, ref Vector2 value, out Vector2 result) { result = new Vector2(scale / value.X, scale / value.Y); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 Divide(float scale, Vector2 value) { return new Vector2(scale / value.X, scale / value.Y); } /// /// Reverses the direction of a given vector. /// /// The vector to negate. /// When the method completes, contains a vector facing in the opposite direction. public static void Negate(ref Vector2 value, out Vector2 result) { result = new Vector2(-value.X, -value.Y); } /// /// Reverses the direction of a given vector. /// /// The vector to negate. /// A vector facing in the opposite direction. public static Vector2 Negate(Vector2 value) { return new Vector2(-value.X, -value.Y); } /// /// Returns a containing the 2D Cartesian coordinates of a point specified in Barycentric /// coordinates relative to a 2D triangle. /// /// A containing the 2D Cartesian coordinates of vertex 1 of the triangle. /// A containing the 2D Cartesian coordinates of vertex 2 of the triangle. /// A containing the 2D Cartesian coordinates of vertex 3 of the triangle. /// Barycentric coordinate b2, which expresses the weighting factor toward vertex 2 (specified in ). /// Barycentric coordinate b3, which expresses the weighting factor toward vertex 3 (specified in ). /// When the method completes, contains the 2D Cartesian coordinates of the specified point. public static void Barycentric(ref Vector2 value1, ref Vector2 value2, ref Vector2 value3, float amount1, float amount2, out Vector2 result) { result = new Vector2(value1.X + amount1 * (value2.X - value1.X) + amount2 * (value3.X - value1.X), value1.Y + amount1 * (value2.Y - value1.Y) + amount2 * (value3.Y - value1.Y)); } /// /// Returns a containing the 2D Cartesian coordinates of a point specified in Barycentric /// coordinates relative to a 2D triangle. /// /// A containing the 2D Cartesian coordinates of vertex 1 of the triangle. /// A containing the 2D Cartesian coordinates of vertex 2 of the triangle. /// A containing the 2D Cartesian coordinates of vertex 3 of the triangle. /// Barycentric coordinate b2, which expresses the weighting factor toward vertex 2 (specified in ). /// Barycentric coordinate b3, which expresses the weighting factor toward vertex 3 (specified in ). /// A new containing the 2D Cartesian coordinates of the specified point. public static Vector2 Barycentric(Vector2 value1, Vector2 value2, Vector2 value3, float amount1, float amount2) { Barycentric(ref value1, ref value2, ref value3, amount1, amount2, out Vector2 result); return result; } /// /// Restricts a value to be within a specified range. /// /// The value to clamp. /// The minimum value. /// The maximum value. /// When the method completes, contains the clamped value. public static void Clamp(ref Vector2 value, ref Vector2 min, ref Vector2 max, out Vector2 result) { Real x = value.X; x = x > max.X ? max.X : x; x = x < min.X ? min.X : x; Real y = value.Y; y = y > max.Y ? max.Y : y; y = y < min.Y ? min.Y : y; result = new Vector2(x, y); } /// /// Restricts a value to be within a specified range. /// /// The value to clamp. /// The minimum value. /// The maximum value. /// The clamped value. public static Vector2 Clamp(Vector2 value, Vector2 min, Vector2 max) { Clamp(ref value, ref min, ref max, out Vector2 result); return result; } /// /// Saturates this instance in the range [0,1]. /// public void Saturate() { X = X < 0.0f ? 0.0f : X > 1.0f ? 1.0f : X; Y = Y < 0.0f ? 0.0f : Y > 1.0f ? 1.0f : Y; } /// /// Calculates the area of the triangle. /// /// The first triangle vertex. /// The second triangle vertex. /// The third triangle vertex. /// The triangle area. public static Real TriangleArea(ref Vector2 v0, ref Vector2 v1, ref Vector2 v2) { return Math.Abs((v0.X * (v1.Y - v2.Y) + v1.X * (v2.Y - v0.Y) + v2.X * (v0.Y - v1.Y)) / 2); } /// /// Calculates the distance between two vectors. /// /// The first vector. /// The second vector. /// When the method completes, contains the distance between the two vectors. /// may be preferred when only the relative distance is needed and speed is of the essence. public static void Distance(ref Vector2 value1, ref Vector2 value2, out Real result) { Real x = value1.X - value2.X; Real y = value1.Y - value2.Y; result = (Real)Math.Sqrt(x * x + y * y); } /// /// Calculates the distance between two vectors. /// /// The first vector. /// The second vector. /// The distance between the two vectors. /// may be preferred when only the relative distance is needed and speed is of the essence. public static Real Distance(Vector2 value1, Vector2 value2) { Real x = value1.X - value2.X; Real y = value1.Y - value2.Y; return (Real)Math.Sqrt(x * x + y * y); } /// /// Calculates the distance between two vectors. /// /// The first vector. /// The second vector. /// The distance between the two vectors. /// may be preferred when only the relative distance is needed and speed is of the essence. public static Real Distance(ref Vector2 value1, ref Vector2 value2) { Real x = value1.X - value2.X; Real y = value1.Y - value2.Y; return (Real)Math.Sqrt(x * x + y * y); } /// /// Calculates the squared distance between two vectors. /// /// The first vector. /// The second vector /// When the method completes, contains the squared distance between the two vectors. public static void DistanceSquared(ref Vector2 value1, ref Vector2 value2, out Real result) { Real x = value1.X - value2.X; Real y = value1.Y - value2.Y; result = x * x + y * y; } /// /// Calculates the squared distance between two vectors. /// /// The first vector. /// The second vector /// The squared distance between the two vectors. public static Real DistanceSquared(ref Vector2 value1, ref Vector2 value2) { Real x = value1.X - value2.X; Real y = value1.Y - value2.Y; return x * x + y * y; } /// /// Calculates the squared distance between two vectors. /// /// The first vector. /// The second vector. /// The squared distance between the two vectors. public static Real DistanceSquared(Vector2 value1, Vector2 value2) { Real x = value1.X - value2.X; Real y = value1.Y - value2.Y; return x * x + y * y; } /// /// Tests whether one vector is near another vector. /// /// The left vector. /// The right vector. /// The epsilon. /// true if left and right are near, false otherwise public static bool NearEqual(Vector2 left, Vector2 right, float epsilon = Mathf.Epsilon) { return NearEqual(ref left, ref right, epsilon); } /// /// Tests whether one vector is near another vector. /// /// The left vector. /// The right vector. /// The epsilon. /// true if left and right are near another, false otherwise public static bool NearEqual(ref Vector2 left, ref Vector2 right, float epsilon = Mathf.Epsilon) { return Mathf.WithinEpsilon(left.X, right.X, epsilon) && Mathf.WithinEpsilon(left.Y, right.Y, epsilon); } /// /// Calculates the dot product of two vectors. /// /// First source vector. /// Second source vector. /// When the method completes, contains the dot product of the two vectors. public static void Dot(ref Vector2 left, ref Vector2 right, out Real result) { result = left.X * right.X + left.Y * right.Y; } /// /// Calculates the dot product of two vectors. /// /// First source vector. /// Second source vector. /// The dot product of the two vectors. public static Real Dot(ref Vector2 left, ref Vector2 right) { return left.X * right.X + left.Y * right.Y; } /// /// Calculates the dot product of two vectors. /// /// First source vector. /// Second source vector. /// The dot product of the two vectors. public static Real Dot(Vector2 left, Vector2 right) { return left.X * right.X + left.Y * right.Y; } /// /// Calculates the cross product of two vectors. /// /// First source vector. /// Second source vector. /// When the method completes, contains the cross product of the two vectors. public static void Cross(ref Vector2 left, ref Vector2 right, out Real result) { result = left.X * right.Y - left.Y * right.X; } /// /// Calculates the cross product of two vectors. /// /// First source vector. /// Second source vector. /// The cross product of the two vectors. public static Real Cross(ref Vector2 left, ref Vector2 right) { return left.X * right.Y - left.Y * right.X; } /// /// Calculates the cross product of two vectors. /// /// First source vector. /// Second source vector. /// The cross product of the two vectors. public static Real Cross(Vector2 left, Vector2 right) { return left.X * right.Y - left.Y * right.X; } /// /// Converts the vector into a unit vector. /// /// The vector to normalize. /// When the method completes, contains the normalized vector. public static void Normalize(ref Vector2 value, out Vector2 result) { result = value; result.Normalize(); } /// /// Converts the vector into a unit vector. /// /// The vector to normalize. /// The normalized vector. public static Vector2 Normalize(Vector2 value) { value.Normalize(); return value; } /// /// Makes sure that Length of the output vector is always below max and above 0. /// /// Input Vector. /// Max Length public static Vector2 ClampLength(Vector2 vector, Real max) { return ClampLength(vector, 0, max); } /// /// Makes sure that Length of the output vector is always below max and above min. /// /// Input Vector. /// Min Length /// Max Length public static Vector2 ClampLength(Vector2 vector, Real min, Real max) { ClampLength(vector, min, max, out Vector2 result); return result; } /// /// Makes sure that Length of the output vector is always below max and above min. /// /// Input Vector. /// Min Length /// Max Length /// The result value. public static void ClampLength(Vector2 vector, Real min, Real max, out Vector2 result) { result = vector; var lenSq = result.LengthSquared; if (lenSq > max * max) { var scaleFactor = max / (Real)Math.Sqrt(lenSq); result.X *= scaleFactor; result.Y *= scaleFactor; } if (lenSq < min * min) { var scaleFactor = min / (Real)Math.Sqrt(lenSq); result.X *= scaleFactor; result.Y *= scaleFactor; } } /// /// Returns the vector with components rounded to the nearest integer. /// /// The value. /// The result. public static Vector2 Round(Vector2 v) { return new Vector2(Math.Round(v.X), Math.Round(v.Y)); } /// /// Returns the vector with components containing the smallest integer greater to or equal to the original value. /// /// The value. /// The result. public static Vector2 Ceil(Vector2 v) { return new Vector2(Math.Ceiling(v.X), Math.Ceiling(v.Y)); } /// /// Breaks the components of the vector into an integral and a fractional part. Returns vector made of fractional parts. /// /// The value. /// The result. public static Vector2 Mod(Vector2 v) { return new Vector2(v.X - (int)v.X, v.Y - (int)v.Y); } /// /// Performs a linear interpolation between two vectors. /// /// Start vector. /// End vector. /// Value between 0 and 1 indicating the weight of . /// When the method completes, contains the linear interpolation of the two vectors. /// Passing a value of 0 will cause to be returned; a value of 1 will cause to be returned. public static void Lerp(ref Vector2 start, ref Vector2 end, float amount, out Vector2 result) { result.X = Mathr.Lerp(start.X, end.X, amount); result.Y = Mathr.Lerp(start.Y, end.Y, amount); } /// /// Performs a linear interpolation between two vectors. /// /// Start vector. /// End vector. /// Value between 0 and 1 indicating the weight of . /// The linear interpolation of the two vectors. /// Passing a value of 0 will cause to be returned; a value of 1 will cause to be returned. public static Vector2 Lerp(Vector2 start, Vector2 end, float amount) { Lerp(ref start, ref end, amount, out Vector2 result); return result; } /// /// Performs a linear interpolation between two vectors. /// /// Start vector. /// End vector. /// Value between 0 and 1 indicating the weight of . /// When the method completes, contains the linear interpolation of the two vectors. /// Passing a value of 0 will cause to be returned; a value of 1 will cause to be returned. public static void Lerp(ref Vector2 start, ref Vector2 end, ref Vector2 amount, out Vector2 result) { result.X = Mathr.Lerp(start.X, end.X, amount.X); result.Y = Mathr.Lerp(start.Y, end.Y, amount.Y); } /// /// Performs a linear interpolation between two vectors. /// /// Start vector. /// End vector. /// Value between 0 and 1 indicating the weight of . /// The linear interpolation of the two vectors. /// Passing a value of 0 will cause to be returned; a value of 1 will cause to be returned. public static Vector2 Lerp(Vector2 start, Vector2 end, Vector2 amount) { Lerp(ref start, ref end, ref amount, out Vector2 result); return result; } /// /// Performs a gradual change of a vector towards a specified target over time /// /// Current vector. /// Target vector. /// Used to store the current velocity. /// Determines the approximate time it should take to reach the target vector. /// Defines the upper limit on the speed of the Smooth Damp. public static Vector2 SmoothDamp(Vector2 current, Vector2 target, ref Vector2 currentVelocity, float smoothTime, float maxSpeed) { return SmoothDamp(current, target, ref currentVelocity, smoothTime, maxSpeed, Time.DeltaTime); } /// /// Performs a gradual change of a vector towards a specified target over time /// /// Current vector. /// Target vector. /// Used to store the current velocity. /// Determines the approximate time it should take to reach the target vector. public static Vector2 SmoothDamp(Vector2 current, Vector2 target, ref Vector2 currentVelocity, float smoothTime) { return SmoothDamp(current, target, ref currentVelocity, smoothTime, float.PositiveInfinity, Time.DeltaTime); } /// /// Performs a gradual change of a vector towards a specified target over time /// /// Current vector. /// Target vector. /// Used to store the current velocity. /// Determines the approximate time it should take to reach the target vector. /// Defines the upper limit on the speed of the Smooth Damp. /// Delta Time, represents the time elapsed since last frame. public static Vector2 SmoothDamp(Vector2 current, Vector2 target, ref Vector2 currentVelocity, float smoothTime, [DefaultValue("float.PositiveInfinity")] float maxSpeed, [DefaultValue("Time.DeltaTime")] float deltaTime) { smoothTime = Mathf.Max(0.0001f, smoothTime); Real a = 2f / smoothTime; Real b = a * deltaTime; Real e = 1f / (1f + b + 0.48f * b * b + 0.235f * b * b * b); Real change_x = current.X - target.X; Real change_y = current.Y - target.Y; Vector2 originalTo = target; Real maxChangeSpeed = maxSpeed * smoothTime; Real changeSq = maxChangeSpeed * maxChangeSpeed; Real sqrDist = change_x * change_x + change_y * change_y; if (sqrDist > changeSq) { var dist = (Real)Math.Sqrt(sqrDist); change_x = change_x / dist * maxChangeSpeed; change_y = change_y / dist * maxChangeSpeed; } target.X = current.X - change_x; target.Y = current.Y - change_y; Real temp_x = (currentVelocity.X + a * change_x) * deltaTime; Real temp_y = (currentVelocity.Y + a * change_y) * deltaTime; currentVelocity.X = (currentVelocity.X - a * temp_x) * e; currentVelocity.Y = (currentVelocity.Y - a * temp_y) * e; Real output_x = target.X + (change_x + temp_x) * e; Real output_y = target.Y + (change_y + temp_y) * e; Real x1 = originalTo.X - current.X; Real y1 = originalTo.Y - current.Y; Real x2 = output_x - originalTo.X; Real y2 = output_y - originalTo.Y; if (x1 * x2 + y1 * y2 > 0) { output_x = originalTo.X; output_y = originalTo.Y; currentVelocity.X = (output_x - originalTo.X) / deltaTime; currentVelocity.Y = (output_y - originalTo.Y) / deltaTime; } return new Vector2(output_x, output_y); } /// /// Performs a cubic interpolation between two vectors. /// /// Start vector. /// End vector. /// Value between 0 and 1 indicating the weight of . /// When the method completes, contains the cubic interpolation of the two vectors. public static void SmoothStep(ref Vector2 start, ref Vector2 end, float amount, out Vector2 result) { amount = Mathf.SmoothStep(amount); Lerp(ref start, ref end, amount, out result); } /// /// Performs a cubic interpolation between two vectors. /// /// Start vector. /// End vector. /// Value between 0 and 1 indicating the weight of . /// The cubic interpolation of the two vectors. public static Vector2 SmoothStep(Vector2 start, Vector2 end, float amount) { SmoothStep(ref start, ref end, amount, out Vector2 result); return result; } /// /// Performs a Hermite spline interpolation. /// /// First source position vector. /// First source tangent vector. /// Second source position vector. /// Second source tangent vector. /// Weighting factor. /// When the method completes, contains the result of the Hermite spline interpolation. public static void Hermite(ref Vector2 value1, ref Vector2 tangent1, ref Vector2 value2, ref Vector2 tangent2, float amount, out Vector2 result) { float squared = amount * amount; float cubed = amount * squared; float part1 = 2.0f * cubed - 3.0f * squared + 1.0f; float part2 = -2.0f * cubed + 3.0f * squared; float part3 = cubed - 2.0f * squared + amount; float part4 = cubed - squared; result.X = value1.X * part1 + value2.X * part2 + tangent1.X * part3 + tangent2.X * part4; result.Y = value1.Y * part1 + value2.Y * part2 + tangent1.Y * part3 + tangent2.Y * part4; } /// /// Performs a Hermite spline interpolation. /// /// First source position vector. /// First source tangent vector. /// Second source position vector. /// Second source tangent vector. /// Weighting factor. /// The result of the Hermite spline interpolation. public static Vector2 Hermite(Vector2 value1, Vector2 tangent1, Vector2 value2, Vector2 tangent2, float amount) { Hermite(ref value1, ref tangent1, ref value2, ref tangent2, amount, out Vector2 result); return result; } /// /// Calculates the 2D vector perpendicular to the given 2D vector. The result is always rotated 90-degrees in a counter-clockwise direction for a 2D coordinate system where the positive Y axis goes up. /// /// The input direction. /// The result. public static Vector2 Perpendicular(Vector2 inDirection) { return new Vector2(-inDirection.Y, inDirection.X); } /// /// Calculates the 2D vector perpendicular to the given 2D vector. The result is always rotated 90-degrees in a counter-clockwise direction for a 2D coordinate system where the positive Y axis goes up. /// /// The in direction. /// When the method completes, contains the result of the calculation. public static void Perpendicular(ref Vector2 inDirection, out Vector2 result) { result = new Vector2(-inDirection.Y, inDirection.X); } /// /// Performs a Catmull-Rom interpolation using the specified positions. /// /// The first position in the interpolation. /// The second position in the interpolation. /// The third position in the interpolation. /// The fourth position in the interpolation. /// Weighting factor. /// When the method completes, contains the result of the Catmull-Rom interpolation. public static void CatmullRom(ref Vector2 value1, ref Vector2 value2, ref Vector2 value3, ref Vector2 value4, float amount, out Vector2 result) { float squared = amount * amount; float cubed = amount * squared; result.X = 0.5f * (2.0f * value2.X + (-value1.X + value3.X) * amount + (2.0f * value1.X - 5.0f * value2.X + 4.0f * value3.X - value4.X) * squared + (-value1.X + 3.0f * value2.X - 3.0f * value3.X + value4.X) * cubed); result.Y = 0.5f * (2.0f * value2.Y + (-value1.Y + value3.Y) * amount + (2.0f * value1.Y - 5.0f * value2.Y + 4.0f * value3.Y - value4.Y) * squared + (-value1.Y + 3.0f * value2.Y - 3.0f * value3.Y + value4.Y) * cubed); } /// /// Performs a Catmull-Rom interpolation using the specified positions. /// /// The first position in the interpolation. /// The second position in the interpolation. /// The third position in the interpolation. /// The fourth position in the interpolation. /// Weighting factor. /// A vector that is the result of the Catmull-Rom interpolation. public static Vector2 CatmullRom(Vector2 value1, Vector2 value2, Vector2 value3, Vector2 value4, float amount) { CatmullRom(ref value1, ref value2, ref value3, ref value4, amount, out Vector2 result); return result; } /// /// Returns a vector containing the largest components of the specified vectors. /// /// The first source vector. /// The second source vector. /// When the method completes, contains an new vector composed of the largest components of the source vectors. public static void Max(ref Vector2 left, ref Vector2 right, out Vector2 result) { result.X = left.X > right.X ? left.X : right.X; result.Y = left.Y > right.Y ? left.Y : right.Y; } /// /// Returns a vector containing the largest components of the specified vectors. /// /// The first source vector. /// The second source vector. /// A vector containing the largest components of the source vectors. public static Vector2 Max(Vector2 left, Vector2 right) { Max(ref left, ref right, out Vector2 result); return result; } /// /// Returns a vector containing the smallest components of the specified vectors. /// /// The first source vector. /// The second source vector. /// When the method completes, contains an new vector composed of the smallest components of the source vectors. public static void Min(ref Vector2 left, ref Vector2 right, out Vector2 result) { result.X = left.X < right.X ? left.X : right.X; result.Y = left.Y < right.Y ? left.Y : right.Y; } /// /// Returns a vector containing the smallest components of the specified vectors. /// /// The first source vector. /// The second source vector. /// A vector containing the smallest components of the source vectors. public static Vector2 Min(Vector2 left, Vector2 right) { Min(ref left, ref right, out Vector2 result); return result; } /// /// Returns the absolute value of a vector. /// /// The value. /// A vector which components are less or equal to 0. public static Vector2 Abs(Vector2 v) { return new Vector2(Math.Abs(v.X), Math.Abs(v.Y)); } /// /// Returns the reflection of a vector off a surface that has the specified normal. /// /// The source vector. /// Normal of the surface. /// When the method completes, contains the reflected vector. /// Reflect only gives the direction of a reflection off a surface, it does not determine whether the original vector was close enough to the surface to hit it. public static void Reflect(ref Vector2 vector, ref Vector2 normal, out Vector2 result) { var dot = vector.X * normal.X + vector.Y * normal.Y; result.X = vector.X - 2.0f * dot * normal.X; result.Y = vector.Y - 2.0f * dot * normal.Y; } /// /// Returns the reflection of a vector off a surface that has the specified normal. /// /// The source vector. /// Normal of the surface. /// The reflected vector. /// Reflect only gives the direction of a reflection off a surface, it does not determine whether the original vector was close enough to the surface to hit it. public static Vector2 Reflect(Vector2 vector, Vector2 normal) { Reflect(ref vector, ref normal, out Vector2 result); return result; } /// /// Transforms a 2D vector by the given rotation. /// /// The vector to rotate. /// The rotation to apply. /// When the method completes, contains the transformed . public static void Transform(ref Vector2 vector, ref Quaternion rotation, out Vector2 result) { float x = rotation.X + rotation.X; float y = rotation.Y + rotation.Y; float z = rotation.Z + rotation.Z; float wz = rotation.W * z; float xx = rotation.X * x; float xy = rotation.X * y; float yy = rotation.Y * y; float zz = rotation.Z * z; result = new Vector2(vector.X * (1.0f - yy - zz) + vector.Y * (xy - wz), vector.X * (xy + wz) + vector.Y * (1.0f - xx - zz)); } /// /// Transforms a 2D vector by the given rotation. /// /// The vector to rotate. /// The rotation to apply. /// The transformed . public static Vector2 Transform(Vector2 vector, Quaternion rotation) { Transform(ref vector, ref rotation, out Vector2 result); return result; } /// /// Transforms a 2D vector by the given . /// /// The source vector. /// The transformation . /// When the method completes, contains the transformed . public static void Transform(ref Vector2 vector, ref Matrix transform, out Vector4 result) { result = new Vector4(vector.X * transform.M11 + vector.Y * transform.M21 + transform.M41, vector.X * transform.M12 + vector.Y * transform.M22 + transform.M42, vector.X * transform.M13 + vector.Y * transform.M23 + transform.M43, vector.X * transform.M14 + vector.Y * transform.M24 + transform.M44); } /// /// Transforms a 2D vector by the given . /// /// The source vector. /// The transformation . /// The transformed . public static Vector4 Transform(Vector2 vector, Matrix transform) { Transform(ref vector, ref transform, out Vector4 result); return result; } /// /// Performs a coordinate transformation using the given . /// /// The coordinate vector to transform. /// The transformation . /// When the method completes, contains the transformed coordinates. /// /// A coordinate transform performs the transformation with the assumption that the w component /// is one. The four dimensional vector obtained from the transformation operation has each /// component in the vector divided by the w component. This forces the w component to be one and /// therefore makes the vector homogeneous. The homogeneous vector is often preferred when working /// with coordinates as the w component can safely be ignored. /// public static void TransformCoordinate(ref Vector2 coordinate, ref Matrix transform, out Vector2 result) { var vector = new Vector4 { X = coordinate.X * transform.M11 + coordinate.Y * transform.M21 + transform.M41, Y = coordinate.X * transform.M12 + coordinate.Y * transform.M22 + transform.M42, Z = coordinate.X * transform.M13 + coordinate.Y * transform.M23 + transform.M43, W = 1f / (coordinate.X * transform.M14 + coordinate.Y * transform.M24 + transform.M44) }; result = new Vector2(vector.X * vector.W, vector.Y * vector.W); } /// /// Performs a coordinate transformation using the given . /// /// The coordinate vector to transform. /// The transformation . /// The transformed coordinates. /// /// A coordinate transform performs the transformation with the assumption that the w component /// is one. The four dimensional vector obtained from the transformation operation has each /// component in the vector divided by the w component. This forces the w component to be one and /// therefore makes the vector homogeneous. The homogeneous vector is often preferred when working /// with coordinates as the w component can safely be ignored. /// public static Vector2 TransformCoordinate(Vector2 coordinate, Matrix transform) { TransformCoordinate(ref coordinate, ref transform, out Vector2 result); return result; } /// /// Performs a normal transformation using the given . /// /// The normal vector to transform. /// The transformation . /// When the method completes, contains the transformed normal. /// /// A normal transform performs the transformation with the assumption that the w component /// is zero. This causes the fourth row and fourth column of the matrix to be unused. The /// end result is a vector that is not translated, but all other transformation properties /// apply. This is often preferred for normal vectors as normals purely represent direction /// rather than location because normal vectors should not be translated. /// public static void TransformNormal(ref Vector2 normal, ref Matrix transform, out Vector2 result) { result = new Vector2(normal.X * transform.M11 + normal.Y * transform.M21, normal.X * transform.M12 + normal.Y * transform.M22); } /// /// Performs a normal transformation using the given . /// /// The normal vector to transform. /// The transformation . /// The transformed normal. /// /// A normal transform performs the transformation with the assumption that the w component /// is zero. This causes the fourth row and fourth column of the matrix to be unused. The /// end result is a vector that is not translated, but all other transformation properties /// apply. This is often preferred for normal vectors as normals purely represent direction /// rather than location because normal vectors should not be translated. /// public static Vector2 TransformNormal(Vector2 normal, Matrix transform) { TransformNormal(ref normal, ref transform, out Vector2 result); return result; } /// /// Snaps the input position into the grid. /// /// The position to snap. /// The size of the grid. /// The position snapped to the grid. public static Vector2 SnapToGrid(Vector2 pos, Vector2 gridSize) { pos.X = Mathr.Ceil((pos.X - (gridSize.X * 0.5f)) / gridSize.Y) * gridSize.X; pos.Y = Mathr.Ceil((pos.Y - (gridSize.Y * 0.5f)) / gridSize.X) * gridSize.Y; return pos; } /// /// Adds two vectors. /// /// The first vector to add. /// The second vector to add. /// The sum of the two vectors. public static Vector2 operator +(Vector2 left, Vector2 right) { return new Vector2(left.X + right.X, left.Y + right.Y); } /// /// Multiplies a vector with another by performing component-wise multiplication equivalent to . /// /// The first vector to multiply. /// The second vector to multiply. /// The multiplication of the two vectors. public static Vector2 operator *(Vector2 left, Vector2 right) { return new Vector2(left.X * right.X, left.Y * right.Y); } /// /// Assert a vector (return it unchanged). /// /// The vector to assert (unchanged). /// The asserted (unchanged) vector. public static Vector2 operator +(Vector2 value) { return value; } /// /// Subtracts two vectors. /// /// The first vector to subtract. /// The second vector to subtract. /// The difference of the two vectors. public static Vector2 operator -(Vector2 left, Vector2 right) { return new Vector2(left.X - right.X, left.Y - right.Y); } /// /// Reverses the direction of a given vector. /// /// The vector to negate. /// A vector facing in the opposite direction. public static Vector2 operator -(Vector2 value) { return new Vector2(-value.X, -value.Y); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 operator *(Real scale, Vector2 value) { return new Vector2(value.X * scale, value.Y * scale); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 operator *(Vector2 value, Real scale) { return new Vector2(value.X * scale, value.Y * scale); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 operator /(Vector2 value, Real scale) { return new Vector2(value.X / scale, value.Y / scale); } /// /// Scales a vector by the given value. /// /// The amount by which to scale the vector. /// The vector to scale. /// The scaled vector. public static Vector2 operator /(Real scale, Vector2 value) { return new Vector2(scale / value.X, scale / value.Y); } /// /// Scales a vector by the given value. /// /// The vector to scale. /// The amount by which to scale the vector. /// The scaled vector. public static Vector2 operator /(Vector2 value, Vector2 scale) { return new Vector2(value.X / scale.X, value.Y / scale.Y); } /// /// Remainder of value divided by scale. /// /// The vector to scale. /// The amount by which to scale the vector. /// The remained vector. public static Vector2 operator %(Vector2 value, Real scale) { return new Vector2(value.X % scale, value.Y % scale); } /// /// Remainder of value divided by scale. /// /// The amount by which to scale the vector. /// The vector to scale. /// The remained vector. public static Vector2 operator %(Real value, Vector2 scale) { return new Vector2(value % scale.X, value % scale.Y); } /// /// Remainder of value divided by scale. /// /// The vector to scale. /// The amount by which to scale the vector. /// The remained vector. public static Vector2 operator %(Vector2 value, Vector2 scale) { return new Vector2(value.X % scale.X, value.Y % scale.Y); } /// /// Performs a component-wise addition. /// /// The input vector. /// The scalar value to be added on elements /// The vector with added scalar for each element. public static Vector2 operator +(Vector2 value, Real scalar) { return new Vector2(value.X + scalar, value.Y + scalar); } /// /// Performs a component-wise addition. /// /// The input vector. /// The scalar value to be added on elements /// The vector with added scalar for each element. public static Vector2 operator +(Real scalar, Vector2 value) { return new Vector2(scalar + value.X, scalar + value.Y); } /// /// Performs a component-wise subtraction. /// /// The input vector. /// The scalar value to be subtracted from elements /// The vector with subtracted scalar from each element. public static Vector2 operator -(Vector2 value, Real scalar) { return new Vector2(value.X - scalar, value.Y - scalar); } /// /// Performs a component-wise subtraction. /// /// The input vector. /// The scalar value to be subtracted from elements /// The vector with subtracted scalar from each element. public static Vector2 operator -(Real scalar, Vector2 value) { return new Vector2(scalar - value.X, scalar - value.Y); } /// /// Adds a vector to another by performing component-wise addition. /// /// The first vector to add. /// The second vector to add. /// The sum of the two vectors. public static Float2 operator +(Float2 left, Vector2 right) { return new Float2(left.X + (float)right.X, left.Y + (float)right.Y); } /// /// Subtracts a vector from another by performing component-wise subtraction. /// /// The first vector to add. /// The second vector to add. /// The sum of the two vectors. public static Float2 operator -(Float2 left, Vector2 right) { return new Float2(left.X - (float)right.X, left.Y - (float)right.Y); } /// /// Multiplies a vector with another by performing component-wise multiplication. /// /// The first vector to multiply. /// The second vector to multiply. /// The multiplication of the two vectors. public static Float2 operator *(Float2 left, Vector2 right) { return new Float2(left.X * (float)right.X, left.Y * (float)right.Y); } /// /// Adds a vector to another by performing component-wise addition. /// /// The first vector to add. /// The second vector to add. /// The sum of the two vectors. public static Vector2 operator +(Vector2 left, Float2 right) { return new Vector2(left.X + (Real)right.X, left.Y + (Real)right.Y); } /// /// Subtracts a vector from another by performing component-wise subtraction. /// /// The first vector to add. /// The second vector to add. /// The sum of the two vectors. public static Vector2 operator -(Vector2 left, Float2 right) { return new Vector2(left.X - (Real)right.X, left.Y - (Real)right.Y); } /// /// Multiplies a vector with another by performing component-wise multiplication. /// /// The first vector to multiply. /// The second vector to multiply. /// The multiplication of the two vectors. public static Vector2 operator *(Vector2 left, Float2 right) { return new Vector2(left.X * (Real)right.X, left.Y * (Real)right.Y); } /// /// Tests for equality between two objects. /// /// The first value to compare. /// The second value to compare. /// true if has the same value as ; otherwise,false. [MethodImpl(MethodImplOptions.AggressiveInlining)] public static bool operator ==(Vector2 left, Vector2 right) { return Mathr.NearEqual(left.X, right.X) && Mathr.NearEqual(left.Y, right.Y); } /// /// Tests for inequality between two objects. /// /// The first value to compare. /// The second value to compare. /// true if has a different value than ; otherwise,false. [MethodImpl(MethodImplOptions.AggressiveInlining)] public static bool operator !=(Vector2 left, Vector2 right) { return !Mathr.NearEqual(left.X, right.X) || !Mathr.NearEqual(left.Y, right.Y); } /// /// Performs an implicit conversion from to . /// /// The value. /// The result of the conversion. public static implicit operator Float2(Vector2 value) { return new Float2((float)value.X, (float)value.Y); } /// /// Performs an implicit conversion from to . /// /// The value. /// The result of the conversion. public static implicit operator Double2(Vector2 value) { return new Double2(value.X, value.Y); } /// /// Performs an explicit conversion from to . /// /// The value. /// The result of the conversion. public static explicit operator Vector3(Vector2 value) { return new Vector3(value, 0.0f); } /// /// Performs an explicit conversion from to . /// /// The value. /// The result of the conversion. public static explicit operator Vector4(Vector2 value) { return new Vector4(value, 0.0f, 0.0f); } /// /// Returns a that represents this instance. /// /// A that represents this instance. public override string ToString() { return string.Format(CultureInfo.CurrentCulture, "X:{0} Y:{1}", X, Y); } /// /// Returns a that represents this instance. /// /// The format. /// A that represents this instance. public string ToString(string format) { if (format == null) return ToString(); return string.Format(CultureInfo.CurrentCulture, _formatString, X.ToString(format, CultureInfo.CurrentCulture), Y.ToString(format, CultureInfo.CurrentCulture)); } /// /// Returns a that represents this instance. /// /// The format provider. /// A that represents this instance. public string ToString(IFormatProvider formatProvider) { return string.Format(formatProvider, _formatString, X, Y); } /// /// Returns a that represents this instance. /// /// The format. /// The format provider. /// A that represents this instance. public string ToString(string format, IFormatProvider formatProvider) { if (format == null) return ToString(formatProvider); return string.Format(formatProvider, _formatString, X.ToString(format, formatProvider), Y.ToString(format, formatProvider)); } /// /// Returns a hash code for this instance. /// public override int GetHashCode() { unchecked { return (X.GetHashCode() * 397) ^ Y.GetHashCode(); } } /// /// Determines whether the specified is equal to this instance. /// /// The to compare with this instance. /// true if the specified is equal to this instance; otherwise, false. [MethodImpl(MethodImplOptions.AggressiveInlining)] public bool Equals(ref Vector2 other) { return Mathr.NearEqual(other.X, X) && Mathr.NearEqual(other.Y, Y); } /// /// Determines whether the specified are equal. /// public static bool Equals(ref Vector2 a, ref Vector2 b) { return Mathr.NearEqual(a.X, b.X) && Mathr.NearEqual(a.Y, b.Y); } /// /// Determines whether the specified is equal to this instance. /// /// The to compare with this instance. /// true if the specified is equal to this instance; otherwise, false. [MethodImpl(MethodImplOptions.AggressiveInlining)] public bool Equals(Vector2 other) { return Mathr.NearEqual(other.X, X) && Mathr.NearEqual(other.Y, Y); } /// /// Determines whether the specified is equal to this instance. /// /// The to compare with this instance. /// true if the specified is equal to this instance; otherwise, false. public override bool Equals(object value) { return value is Vector2 other && Mathr.NearEqual(other.X, X) && Mathr.NearEqual(other.Y, Y); } } }