Daily update on 20230806 by nitload youmu

源代码/StgSharp/Math/Linear/matrix3x4.cs

@@ -6,9 +6,12 @@ namespace StgSharp.Math
 {
     public class Matrix3x4
     {
-        internal IntPtr _row0Ptr;
-        internal IntPtr _row1Ptr;
-        internal IntPtr _row2Ptr;
+        internal M128Map map;
+
+        internal IntPtr _colum0Ptr;
+        internal IntPtr _colum1Ptr;
+        internal IntPtr _colum2Ptr;
+        internal IntPtr _colum3Ptr;
 
         private bool _isTransposed;
         private Matrix4x3 _transpose;
@@ -19,13 +22,27 @@ namespace StgSharp.Math
             float a20, float a21, float a22, float a23
             )
         {
-            _row0Ptr = internalIO.load_internal(a00,a01,a02,a03);
-            _row1Ptr = internalIO.load_internal(a10,a11,a12,a13);
-            _row2Ptr = internalIO.load_internal(a20,a21,a22,a23);
+            _colum0Ptr = internalIO.load_internal(a00,a10,a20,0);
+            _colum1Ptr = internalIO.load_internal(a01,a11,a21,0);
+            _colum2Ptr = internalIO.load_internal(a02,a12,a22,0);
+            _colum2Ptr = internalIO.load_internal(a03,a13,a23,0);
 
             _transpose = new Matrix4x3(this);
         }
 
+        internal Matrix3x4(
+            IntPtr colum0Ptr,
+            IntPtr colum1Ptr,
+            IntPtr colum2Ptr,
+            IntPtr colum3Ptr
+            )
+        {
+            _colum0Ptr = colum0Ptr;
+            _colum1Ptr = colum1Ptr;
+            _colum2Ptr = colum2Ptr;
+            _colum3Ptr = colum3Ptr;
+        }
+
         internal Matrix3x4()
         {
             _transpose = new Matrix4x3(this);
@@ -36,15 +53,38 @@ namespace StgSharp.Math
             _transpose = transpose;
         }
 
-        public Matrix4x3 Transpose(TransposeMode transposeMode)
+        public unsafe Matrix4x3 Transpose(TransposeMode transposeMode)
         {
+            if (!_isTransposed)
+            {
+
+                (*(M128*)_transpose._colum0Ptr).single_0 = (*(M128*)_colum0Ptr).single_0;
+                (*(M128*)_transpose._colum0Ptr).single_1 = (*(M128*)_colum1Ptr).single_0;
+                (*(M128*)_transpose._colum0Ptr).single_2 = (*(M128*)_colum2Ptr).single_0;
+                (*(M128*)_transpose._colum0Ptr).single_2 = (*(M128*)_colum3Ptr).single_0;
+                
+                (*(M128*)_transpose._colum1Ptr).single_0 = (*(M128*)_colum0Ptr).single_1;
+                (*(M128*)_transpose._colum1Ptr).single_1 = (*(M128*)_colum1Ptr).single_1;
+                (*(M128*)_transpose._colum1Ptr).single_2 = (*(M128*)_colum2Ptr).single_1;
+                (*(M128*)_transpose._colum1Ptr).single_2 = (*(M128*)_colum3Ptr).single_1;
+                
+                (*(M128*)_transpose._colum2Ptr).single_0 = (*(M128*)_colum0Ptr).single_2;
+                (*(M128*)_transpose._colum2Ptr).single_1 = (*(M128*)_colum1Ptr).single_2;
+                (*(M128*)_transpose._colum2Ptr).single_2 = (*(M128*)_colum2Ptr).single_2;
+                (*(M128*)_transpose._colum2Ptr).single_2 = (*(M128*)_colum3Ptr).single_2;
+
+            }
             switch (transposeMode)
             {
                 case TransposeMode.New:
-                    return new Matrix4x3();
+                    return new Matrix4x3(
+                        internalIO.load_cpy_internal(_transpose._colum0Ptr),
+                        internalIO.load_cpy_internal(_transpose._colum1Ptr),
+                        internalIO.load_cpy_internal(_transpose._colum2Ptr)
+                        ) ;
                     break;
                 case TransposeMode.Copy:
-
+                    return _transpose;
                     break;
                 default:
                     throw new Exception();
@@ -52,6 +92,59 @@ namespace StgSharp.Math
             }
         }
 
+        public static Matrix3x4 operator +(Matrix3x4 matrix1, Matrix3x4 matrix2)
+        {
+            return new Matrix3x4(
+                internalIO.addps_internal(matrix1._colum0Ptr,matrix1._colum0Ptr),
+                internalIO.addps_internal(matrix1._colum1Ptr,matrix1._colum1Ptr),
+                internalIO.addps_internal(matrix1._colum2Ptr,matrix1._colum2Ptr),
+                internalIO.addps_internal(matrix1._colum2Ptr,matrix1._colum2Ptr)
+                );
+        }
+
+        public static Matrix3x4 operator -(Matrix4x3 matrix1, Matrix3x4 matrix2)
+        {
+            return new Matrix3x4(
+                internalIO.subps_internal(matrix1._colum0Ptr,matrix2._colum0Ptr),
+                internalIO.subps_internal(matrix1._colum1Ptr,matrix2._colum1Ptr),
+                internalIO.subps_internal(matrix1._colum2Ptr,matrix2._colum2Ptr),
+                internalIO.subps_internal(matrix1._colum2Ptr,matrix2._colum2Ptr)
+                );
+        }
+
+        public static Matrix3x4 operator *(Matrix3x4 matrix, float value)
+        {
+            return new Matrix3x4(
+                internalIO.mulps_const_internal(matrix._colum0Ptr,value),
+                internalIO.mulps_const_internal(matrix._colum1Ptr,value),
+                internalIO.mulps_const_internal(matrix._colum2Ptr,value),
+                internalIO.mulps_const_internal(matrix._colum3Ptr,value)
+                );
+        }
+
+        public static Matrix3x4 operator /(Matrix3x4 matrix, float value)
+        {
+            return new Matrix3x4(
+                internalIO.divps_const_internal(matrix._colum0Ptr,value),
+                internalIO.divps_const_internal(matrix._colum1Ptr,value),
+                internalIO.divps_const_internal(matrix._colum2Ptr,value),
+                internalIO.divps_const_internal(matrix._colum3Ptr,value)
+                );
+        }
+
+        ~Matrix3x4()
+        {
+            if (map == null)
+            {
+                internalIO.deinitM128_internal(_colum0Ptr);
+                internalIO.deinitM128_internal(_colum1Ptr);
+                internalIO.deinitM128_internal(_colum2Ptr);
+            }
+            else
+            {
+
+            }
+        }