Math classes inling optimizations

2DGAMELIB/_2DGAMELIB/VectorMath.cs

@@ -0,0 +1,76 @@
+using System;
+using System.Runtime.CompilerServices;
+
+namespace _2DGAMELIB
+{
+    public static class VectorMath
+    {
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static void Add(ref Vector2D a, ref Vector2D b, out Vector2D result)
+    	{
+    		result.X = a.X + b.X;
+    		result.Y = a.Y + b.Y;
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static void Subtract(ref Vector2D a, ref Vector2D b, out Vector2D result)
+    	{
+    		result.X = a.X - b.X;
+    		result.Y = a.Y - b.Y;
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static double DistanceSquared(this Vector2D a, Vector2D b)
+    	{
+    		double num = a.X - b.X;
+    		double num2 = a.Y - b.Y;
+    		return num * num + num2 * num2;
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static void Dot(ref Vector2D a, ref Vector2D b, out double result)
+    	{
+    		result = a.X * b.X + a.Y * b.Y;
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static double Cross(ref Vector2D a, ref Vector2D b)
+    	{
+    		return a.X * b.Y - a.Y * b.X;
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static Vector2D newNormalize(this Vector2D vector)
+    	{
+    		vector.Normalize();
+    		return vector;
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static double Angle(ref Vector2D a, ref Vector2D b)
+    	{
+    		Dot(ref a, ref b, out var r);
+    		r /= a.Length() * b.Length();
+    		if (r > 1.0)
+    		{
+    			r = 1.0;
+    		}
+    		else if (r < -1.0)
+    		{
+    			r = -1.0;
+    		}
+    		return System.Math.Acos(r);
+    	}
+		
+		[MethodImpl(MethodImplOptions.AggressiveInlining)]
+    	public static double Angle02π(this Vector2D a, Vector2D b)
+    	{
+    		double num = Angle(ref a, ref b);
+    		if (Cross(ref a, ref b) < 0.0)
+    		{
+    			num = System.Math.PI * 2.0 - num;
+    		}
+    		return num;
+    	}
+    }
+}