*

Assets/Editor/SourceCommon/Vectors/SourceVector.cs

@@ -0,0 +1,169 @@
+using System;
+
+namespace SourceFormatParser.Common
+{
+	/// <summary>
+	/// Vector x/y/z (float)
+	/// Size: 12 bytes (4 bytes per axis)
+	/// </summary>
+	public struct SourceVector
+	{
+		public float x, y, z;
+
+		public SourceVector(float ix = 0.0f, float iy = 0.0f, float iz = 0.0f)
+		{
+			this.x = ix;
+			this.y = iy;
+			this.z = iz;
+		}
+
+		// Initialization methods
+		public static SourceVector Random(float minVal, float maxVal)
+		{
+			Random rand = new Random();
+			return new SourceVector(
+				ix: minVal + ((float)rand.NextDouble()) * (float)(maxVal - minVal),
+				iy: minVal + ((float)rand.NextDouble()) * (float)(maxVal - minVal),
+				iz: minVal + ((float)rand.NextDouble()) * (float)(maxVal - minVal)
+			);
+		}
+		public void Zero() => x = y = z = 0.0f; ///< zero out a vector
+
+		// equality
+		public static bool operator ==(SourceVector v1, SourceVector v2) => v1.x == v2.x && v1.y == v2.y && v1.z == v2.z;
+		public static bool operator !=(SourceVector v1, SourceVector v2) => !(v1 == v2);
+
+		public override bool Equals(object obj) => this == (SourceVector)obj;
+		public override int GetHashCode() => base.GetHashCode();
+
+		// arithmetic operations
+		public static SourceVector operator +(SourceVector v1, SourceVector v2) => new SourceVector(v1.x + v2.x, v1.y + v2.y, v1.z + v2.z);
+		public static SourceVector operator -(SourceVector v1, SourceVector v2) => new SourceVector(v1.x - v2.x, v1.y - v2.y, v1.z - v2.z);
+		public static SourceVector operator *(SourceVector v1, SourceVector v2) => new SourceVector(v1.x * v2.x, v1.y * v2.y, v1.z * v2.z);
+		public static SourceVector operator *(SourceVector v, float s) => new SourceVector(v.x * s, v.y * s, v.z * s);
+		public static SourceVector operator /(SourceVector v1, SourceVector v2)
+		{
+			return new SourceVector(
+				ix: v2.x != 0.0f ? v1.x / v2.x : 0f,
+				iy: v2.y != 0.0f ? v1.y / v2.y : 0f,
+				iz: v2.z != 0.0f ? v1.z / v2.z : 0f
+				);
+		}
+		public static SourceVector operator /(SourceVector v, float fl)
+		{
+			if (fl == 0.0f)
+				return new SourceVector();
+			float oofl = 1.0f / fl;
+			return new SourceVector(v.x * oofl, v.y * oofl, v.z * oofl);
+		}
+		public static SourceVector operator +(SourceVector v, float s) => new SourceVector(v.x + s, v.y + s, v.z + s); //< broadcast add
+		public static SourceVector operator -(SourceVector v, float s) => new SourceVector(v.x - s, v.y - s, v.z - s); //< broadcast sub			
+
+		// negate the vector components
+		public void Negate()
+		{
+			x = -x;
+			y = -y;
+			z = -z;
+		}
+
+		// Get the vector's magnitude.
+		public float Length() => (float)Math.Sqrt(x * x + y * y + z * z);
+
+		// Get the vector's magnitude squared.
+		public float LengthSqr() => (x * x + y * y + z * z);
+
+		// return true if this vector is (0,0,0) within tolerance
+		public bool IsZero(float tolerance = 0.01f)
+		{
+			return x > -tolerance && x < tolerance &&
+					y > -tolerance && y < tolerance &&
+					z > -tolerance && z < tolerance;
+		}
+
+		public bool IsLengthGreaterThan(float val) => LengthSqr() > val * val;
+		public bool IsLengthLessThan(float val) => LengthSqr() < val * val;
+
+		// check if a vector is within the box defined by two other vectors // check a point against a box
+		public bool WithinAABox(SourceVector boxmin, SourceVector boxmax)
+		{
+			return (x >= boxmin.x) && (x <= boxmax.x) &&
+					(y >= boxmin.y) && (y <= boxmax.y) &&
+					(z >= boxmin.z) && (z <= boxmax.z);
+		}
+
+		// Get the distance from this vector to the other one.
+		public float DistTo(SourceVector vOther)
+		{
+			return new SourceVector(
+				ix: x - vOther.x,
+				iy: y - vOther.y,
+				iz: z - vOther.z
+				).Length();
+		}
+
+		// Get the distance from this vector to the other one squared.
+		// NJS: note, VC wasn't inlining it correctly in several deeply nested inlines due to being an 'out of line' inline.  
+		// may be able to tidy this up after switching to VC7
+		public float DistToSqr(SourceVector vOther)
+		{
+			return new SourceVector(
+				ix: x - vOther.x,
+				iy: y - vOther.y,
+				iz: z - vOther.z
+				).LengthSqr();
+		}
+
+		// Multiply, add, and assign to this (ie: *this = a + b * scalar). This
+		// is about 12% faster than the actual vector equation (because it's done per-component
+		// rather than per-vector).
+		public void MulAdd(SourceVector a, SourceVector b, float scalar)
+		{
+			x = a.x + b.x * scalar;
+			y = a.y + b.y * scalar;
+			z = a.z + b.z * scalar;
+		}
+
+		// Dot product.
+		public float Dot(SourceVector vOther) => (x * vOther.x + y * vOther.y + z * vOther.z);
+
+
+		// 2d
+		public float Length2D() => (float)Math.Sqrt(Length2DSqr());
+		public float Length2DSqr() => (x * x + y * y);
+
+
+		// Cross product between two vectors.
+		public SourceVector Cross(SourceVector vOther)
+		{
+			return new SourceVector(
+				ix: y * vOther.z - z * vOther.y,
+				iy: z * vOther.x - x * vOther.z,
+				iz: x * vOther.y - y * vOther.x
+				);
+		}
+
+		// Returns a vector with the min or max in X, Y, and Z.
+		public SourceVector Min(SourceVector vOther)
+		{
+			return new SourceVector(x < vOther.x ? x : vOther.x,
+									y < vOther.y ? y : vOther.y,
+									z < vOther.z ? z : vOther.z);
+		}
+		public SourceVector Max(SourceVector vOther)
+		{
+			return new SourceVector(x > vOther.x ? x : vOther.x,
+									y > vOther.y ? y : vOther.y,
+									z > vOther.z ? z : vOther.z);
+		}
+
+		public override string ToString() => $"{{{x}; {y}; {z}}}";
+
+		public static SourceVector Empty => new SourceVector();
+#if (UNITY)
+        public UnityEngine.Vector3 toVector3() => new UnityEngine.Vector3(x, y, z);
+#else
+		public System.Numerics.Vector3 toVector3() => new System.Numerics.Vector3(x, y, z);
+#endif
+	}
+}