daily update on 20240407 by nitload youmu

2024-04-07 15:08:52 +08:00
parent 127fcdbfd3
commit e1e416bb41
141 changed files with 2578 additions and 2576 deletions
@@ -0,0 +1,69 @@
+using StgSharp.Math;
+
+using System;
+using System.Collections.Generic;
+using System.Linq;
+using System.Numerics;
+using System.Runtime.InteropServices;
+using System.Text;
+using System.Threading.Tasks;
+
+namespace StgSharp
+{
+
+    internal static partial class InternalIO
+    {
+        [DllImport(SSC_libname, EntryPoint = "normalize",
+            CallingConvention = CallingConvention.Cdecl)]
+        internal static extern unsafe void Normalize(M128* source, M128* target);
+
+    }
+
+}
+
+namespace StgSharp.Math
+{
+    public static partial class Linear
+    {
+        public static unsafe void Normalize(ref vec4d source, ref vec4d target)
+        {
+            Vector4 s = source.vec;
+            Vector4 t = target.vec;
+
+            s = Vector4.Normalize(s);
+
+            float dotProduct = Vector4.Dot(s, t);
+            Vector4 projection = Vector4.Multiply(s, t);
+
+            t -= projection;
+
+            source.vec = s;
+            target.vec = t;
+        }
+
+        public static unsafe void Normalize(ref vec3d source, ref vec3d target)
+        {
+            Vector4 s = source.vec;
+            Vector4 t = target.vec;
+
+            s = Vector4.Normalize(s);
+
+            float dotProduct = Vector4.Dot(s, t);
+            Vector4 projection = Vector4.Multiply(s, t);
+
+            t -= projection;
+
+            source.vec = s;
+            target.vec = t;
+        }
+
+        public static vec4d Normalize(vec4d vec)
+        {
+            return new vec4d() { vec = Vector4.Normalize(vec.vec) };
+        }
+        public static vec3d Normalize(vec3d vec)
+        {
+            return new vec3d() { vec = Vector4.Normalize(vec.vec) };
+        }
+    }
+}