youmuliu/stgsharp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

daily update on 20230822 by nitload youmu

Browse Source
This commit is contained in:
Nitload
2023-08-22 23:01:20 +08:00
parent 969406c4e4
commit 8aac9fee87
111 changed files with 3205 additions and 11145 deletions
Download Patch File Download Diff File Expand all files Collapse all files
源代码/StgSharp/Math/Linear/matrix3x3.cs
-132
View File
@@ -5,138 +5,6 @@ namespace StgSharp.Math
{
public class Matrix3x3
{
public static Matrix3x3 Unit
= new Matrix3x3(
1,0,0,
0,1,0,
0,0,1
);
internal M128Map map;
internal IntPtr _colum0Ptr;
internal IntPtr _colum1Ptr;
internal IntPtr _colum2Ptr;
private bool _isDisposed;
private Matrix3x3 _transpose;
public Matrix3x3(
float a00, float a01, float a02,
float a10, float a11, float a12,
float a20, float a21, float a22
)
{
_colum0Ptr = internalIO.load_internal(a00,a10,a20,0);
_colum1Ptr = internalIO.load_internal(a01,a11,a21,0);
_colum2Ptr = internalIO.load_internal(a02,a12,a22,0);
_transpose = new Matrix3x3(this);
}
internal Matrix3x3(Matrix3x3 transpose)
{
_transpose = transpose;
}
internal Matrix3x3(
IntPtr colum0Ptr,
IntPtr colum1Ptr,
IntPtr colum2Ptr
)
{
_colum0Ptr= colum0Ptr;
_colum1Ptr= colum1Ptr;
_colum2Ptr= colum2Ptr;
_transpose = new Matrix3x3(this);
}
public unsafe Matrix3x3 Transpose(TransposeMode transposeMode)
{
if (!_isDisposed)
{
(*(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._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._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;
_isDisposed = true;
}
switch (transposeMode)
{
case TransposeMode.New:
return new Matrix3x3(
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();
break;
}
}
public static Matrix3x3 operator +(Matrix3x3 matrix1, Matrix3x3 matrix2)
{
return new Matrix3x3(
internalIO.addps_internal(matrix1._colum0Ptr,matrix2._colum0Ptr),
internalIO.addps_internal(matrix1._colum1Ptr,matrix2._colum1Ptr),
internalIO.addps_internal(matrix1._colum2Ptr,matrix2._colum2Ptr)
);
}
public static Matrix3x3 operator -(Matrix3x3 matrix1, Matrix3x3 matrix2)
{
return new Matrix3x3(
internalIO.subps_internal(matrix1._colum0Ptr,matrix2._colum0Ptr),
internalIO.subps_internal(matrix1._colum1Ptr,matrix2._colum1Ptr),
internalIO.subps_internal(matrix1._colum2Ptr,matrix2._colum2Ptr)
);
}
public static Matrix3x3 operator *(Matrix3x3 matrix, float value)
{
return new Matrix3x3(
internalIO.mulps_const_internal(matrix._colum0Ptr,value),
internalIO.mulps_const_internal(matrix._colum1Ptr,value),
internalIO.mulps_const_internal(matrix._colum2Ptr,value)
);
}
public static Matrix3x3 operator /(Matrix3x3 matrix, float value)
{
return new Matrix3x3(
internalIO.divps_const_internal(matrix._colum0Ptr, value),
internalIO.divps_const_internal(matrix._colum1Ptr, value),
internalIO.divps_const_internal(matrix._colum2Ptr, value)
);
}
~Matrix3x3()
{
if (map==null)
{
internalIO.deinitM128_internal(_colum0Ptr);
internalIO.deinitM128_internal(_colum1Ptr);
internalIO.deinitM128_internal(_colum2Ptr);
}
}
}
}