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

daily update on 202303006 by nitload youmu

Browse Source
This commit is contained in:
Nitload
2023-03-07 00:59:55 +08:00
parent df2af2b2d5
commit 873c408cd4
20 changed files with 291 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files
源代码/StgSharp/Vector/Array4x4.cs
+81 -1
View File
@@ -67,8 +67,88 @@ namespace StgSharp.Math
{
return $"{this.row1}\n{this.row2}\n{this.row3}\n{this.row4}";
}
public static Array4x4 operator +(Array4x4 array1, Array4x4 array2)
{
return new Array4x4(
array1.row1 + array2.row1,
array1.row2 + array2.row2,
array1.row3 + array2.row3,
array1.row4 + array2.row4
);
}
public static Array4x4 operator -(Array4x4 array1, Array4x4 array2)
{
return new Array4x4(
array1.row1 - array2.row1,
array1.row2 - array2.row2,
array1.row3 - array2.row3,
array1.row4 - array2.row4
);
}
public static Array4x4 operator *(Array4x4 array, float x)
{
return new Array4x4(
array.row1 * x,
array.row2 * x,
array.row3 * x,
array.row4 * x
);
}
public static unsafe Array4x4 operator *(Array4x4 array1, Array4x4 array2)
{
float* p1 = &array1.row1.X;
float* p2 = &array2.row1.X;
Array2x2 a11 = new Array2x2(*p1,*(p1 + 1),*(p1 + 4),*(p1 + 5));
Array2x2 a12 = new Array2x2(*(p1 + 2), *(p1 + 3),*(p1 + 6),*(p1 + 7));
Array2x2 a21 = new Array2x2(*(p1 + 8), *(p1 + 9),*(p1 + 12),*(p1 + 13));
Array2x2 a22 = new Array2x2(*(p1 + 10), *(p1 + 11),*(p1 + 14),*(p1 + 15));
Array2x2 b11 = new Array2x2(*p1, *(p1 + 1), *(p1 + 4), *(p1 + 5));
Array2x2 b12 = new Array2x2(*(p1 + 2), *(p1 + 3), *(p1 + 6), *(p1 + 7));
Array2x2 b21 = new Array2x2(*(p1 + 8), *(p1 + 9), *(p1 + 12), *(p1 + 13));
Array2x2 b22 = new Array2x2(*(p1 + 10), *(p1 + 11), *(p1 + 14), *(p1 + 15));
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 Array4x4(
new Vec4D(u1.row1,u5.row1),
new Vec4D(u1.row2,u5.row2),
new Vec4D(u6.row1,u7.row1),
new Vec4D(u6.row2,u7.row2)
);
}
}
}