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

daily update on 20230309 by nitload youmu

Browse Source
This commit is contained in:
Nitload
2023-03-10 01:57:31 +08:00
parent 11cdd85b3b
commit 561196bed2
53 changed files with 1491 additions and 360 deletions
Download Patch File Download Diff File Expand all files Collapse all files
源代码/StgSharp/Vector/Matrix2x2.cs
+9 -46
View File
@@ -14,6 +14,7 @@ namespace StgSharp.Math
[FieldOffset(8)]
public Vec2D row2;
public Matrix2x2(Vec2D c0, Vec2D c1)
{
row1 = c0;
@@ -71,63 +72,25 @@ namespace StgSharp.Math
return $"{row1}\n{row2}";
}
public static Matrix2x2 operator +(Matrix2x2 array1, Matrix2x2 array2)
public static Matrix2x2 operator +(Matrix2x2 matrix1 , Matrix2x2 matrix2)
{
return new Matrix2x2(
array1.row1 + array2.row1,
array1.row2 + array2.row2
matrix1.row1 + matrix2.row1,
matrix1.row2 + matrix2.row2
);
}
public static Matrix2x2 operator -(Matrix2x2 array1, Matrix2x2 array2)
public static Matrix2x2 operator -(Matrix2x2 matrix1, Matrix2x2 matrix2)
{
return new Matrix2x2(
array1.row1 - array2.row1,
array1.row2 - array2.row2
matrix1.row1 - matrix2.row1,
matrix1.row2 - matrix2.row2
);
}
public static unsafe Matrix2x2 operator *(Matrix2x2 array1, Matrix2x2 array2)
{
float* a11 = &array1.row1.X;
float* a12 = a11++ ;
float* a21 = a12++ ;
float* a22 = a21++ ;
float* b11 = &array2.row1.X ;
float* b12 = b11++ ;
float* b21 = b12++ ;
float* b22 = b21++ ;
var s1 = *a21 + *a22;
var s2 = s1 - *a11;
var s3 = *a11 - *a21;
var s4 = *a12 - s2;
var t1 = *b12 - *b11;
var t2 = *b22 - t1;
var t3 = *b22 - *b12;
var t4 = t2 - *b21;
var m1 = *a11 * *b11;
var m2 = *a12 * *b11;
var m3 = s4 * *b22;
var m4 = *a22 * t4;
var m5 = s1 * t1;
var m6 = s2 * t2;
var m7 = s3 * t3;
var u1 = m1 + m2;
var u2 = m1 + m6;
var u3 = u2 + m7;
var u4 = u2 + m5;
var u5 = u4 + m3;
var u6 = u3 - m4;
var u7 = u3 + m5;
return new Matrix2x2(u1,u5,u6,u7);
}
}
}