129 lines
4.6 KiB
C#
129 lines
4.6 KiB
C#
using System;
|
|
using System.Runtime.InteropServices;
|
|
|
|
namespace StgSharp.Math
|
|
{
|
|
|
|
public class Matrix2x4
|
|
{
|
|
internal M128Map _map;
|
|
|
|
internal IntPtr _colum0Ptr;
|
|
internal IntPtr _colum1Ptr;
|
|
internal IntPtr _colum2Ptr;
|
|
internal IntPtr _colum3Ptr;
|
|
|
|
private bool _isTranposed;
|
|
private Matrix4x2 _transpose;
|
|
|
|
public Matrix2x4(
|
|
float a00, float a01, float a02, float a03,
|
|
float a10, float a11, float a12, float a13
|
|
)
|
|
{
|
|
_colum0Ptr = internalIO.load_internal(a00, a10, 0, 0);
|
|
_colum1Ptr = internalIO.load_internal(a01, a11, 0, 0);
|
|
_colum2Ptr = internalIO.load_internal(a02, a12, 0, 0);
|
|
_colum3Ptr = internalIO.load_internal(a03, a13, 0, 0);
|
|
|
|
_transpose = new Matrix4x2(this);
|
|
}
|
|
|
|
internal Matrix2x4(
|
|
IntPtr colum0Ptr,
|
|
IntPtr colum1Ptr,
|
|
IntPtr colum2Ptr,
|
|
IntPtr colum3Ptr
|
|
)
|
|
{
|
|
_colum0Ptr = colum0Ptr;
|
|
_colum1Ptr = colum1Ptr;
|
|
_colum2Ptr = colum2Ptr;
|
|
_colum3Ptr = colum3Ptr;
|
|
|
|
_transpose = new Matrix4x2(this);
|
|
}
|
|
|
|
public unsafe Matrix4x2 Transpose(TransposeMode transposeMode)
|
|
{
|
|
if (_isTranposed)
|
|
{
|
|
(*(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_3 = (*(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_3 = (*(M128*)_colum3Ptr).single_1;
|
|
|
|
_isTranposed = true;
|
|
}
|
|
switch (transposeMode)
|
|
{
|
|
case TransposeMode.New:
|
|
return new Matrix4x2(
|
|
internalIO.load_cpy_internal(_transpose._colum0Ptr),
|
|
internalIO.load_cpy_internal(_transpose._colum1Ptr)
|
|
);
|
|
break;
|
|
case TransposeMode.Copy:
|
|
return _transpose;
|
|
break;
|
|
default:
|
|
throw new Exception();
|
|
break;
|
|
}
|
|
}
|
|
|
|
public static Matrix2x4 operator +(Matrix2x4 matrix1,Matrix2x4 matrix2)
|
|
{
|
|
return new Matrix2x4(
|
|
internalIO.addps_internal(matrix1._colum0Ptr, matrix2._colum0Ptr),
|
|
internalIO.addps_internal(matrix1._colum1Ptr, matrix2._colum1Ptr),
|
|
internalIO.addps_internal(matrix1._colum2Ptr, matrix2._colum2Ptr),
|
|
internalIO.addps_internal(matrix1._colum3Ptr, matrix2._colum3Ptr)
|
|
);
|
|
}
|
|
|
|
public static Matrix2x4 operator -(Matrix2x4 matrix1, Matrix2x4 matrix2)
|
|
{
|
|
return new Matrix2x4(
|
|
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._colum3Ptr, matrix2._colum3Ptr)
|
|
);
|
|
}
|
|
|
|
public static Matrix2x4 operator *(Matrix2x4 matrix, float value)
|
|
{
|
|
return new Matrix2x4(
|
|
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 Matrix2x4 operator /(Matrix2x4 matrix, float value)
|
|
{
|
|
return new Matrix2x4(
|
|
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)
|
|
);
|
|
}
|
|
|
|
internal Matrix2x4(
|
|
Matrix4x2 transpose)
|
|
{
|
|
_transpose = transpose;
|
|
}
|
|
|
|
}
|
|
|
|
}
|