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

daily update on 20230316 by nitload youmu

Browse Source
This commit is contained in:
Nitload
2023-03-17 01:52:35 +08:00
parent 2b3c6cea88
commit 167e33a3dd
95 changed files with 191669 additions and 85 deletions
Download Patch File Download Diff File Expand all files Collapse all files
源代码/StgSharp/Vector/Vector.Multiple.cs
+62 -5
View File
@@ -771,7 +771,6 @@ namespace StgSharp.Math
}
public static unsafe Matrix4x2 multiple(this Matrix4x2 matrix1, Matrix2x2 matrix2)
{
float* p = &matrix1.row1.X;
@@ -845,7 +844,7 @@ namespace StgSharp.Math
);
}
/// <summary>
/// <summary>
///
/// </summary>
/// <param name="matrix1"></param>
@@ -911,15 +910,73 @@ namespace StgSharp.Math
var a22 = new Colum2D(*(p1 + 8), *(p1 + 11));
var b1 = new Matrix2x2(*(p2 + 0), *(p2 + 0), *(p2 + 0), *(p2 + 0));
var B2 = matrix2.row3;
var b2 = matrix2.row3;
var c1 = a11.multiple(b1) + a12.multiple(b2);
var c2 = a21.multiple(b1) + a22.multiple(b2);
return new Matrix4x2(c1.row1,c1.row2,c2.row1,c2.row2);
}
public static unsafe Matrix4x3 multiple(this Matrix4x3 matrix1, Matrix3x3 matrix2)
{ }
{
float* p1 = &matrix1.row1.X;
float* p2 = &matrix2.row1.X;
var a11 = new Matrix2x2(*(p1 + 0), *(p1 + 1), *(p1 + 3), *(p1 + 4));
var a12 = new Colum2D(*(p1 + 2), *(p1 + 5));
var a21 = new Matrix2x2(*(p1 + 6), *(p1 + 7), *(p1 + 9), *(p1 + 10));
var a22 = new Colum2D(*(p1 + 8), *(p1 + 11));
var b11 = new Matrix2x2(*(p2 + 0), *(p2 + 1), *(p2 + 3), *(p2 + 4));
var b12 = new Colum2D(*(p2 + 2), *(p2 + 5));
var b21 = new Vec2D(*(p2 + 9), *(p2 + 10));
var b22 = matrix2.row3.Z;
var c11 = a11.multiple(b11) + a12.multiple(b21);
var c12 = a11.multiple(b12) + a12 * b22;
var c21 = a21.multiple(b11) + a22.multiple(b21);
var c22 = a21.multiple(b12) + a22 * b22;
float* p3 = &c11.row1.X;
float* p4 = &c21.row1.X;
return new Matrix4x3(
*(p3 + 0), *(p3 + 1),c12.X,
*(p3 + 2), *(p3 + 3),c12.Y,
*(p4 + 0), *(p4 + 1),c22.X,
*(p4 + 2), *(p4 + 3),c22.Y
);
}
public static unsafe Matrix4x4 multiple(this Matrix4x3 matrix1, Matrix3x4 matrix2)
{ }
{
float* p1 = &matrix1.row1.X;
float* p2 = &matrix2.row1.X;
var a11 = new Matrix2x2(*(p1 + 0), *(p1 + 1), *(p1 + 3), *(p1 + 4));
var a12 = new Colum2D(*(p1 + 2), *(p1 + 5));
var a21 = new Matrix2x2(*(p1 + 6), *(p1 + 7), *(p1 + 9), *(p1 + 10));
var a22 = new Colum2D(*(p1 + 8), *(p1 + 11));
var b11 = new Matrix2x2(*(p2 + 0), *(p2 + 1), *(p2 + 4), *(p2 + 5));
var b12 = new Matrix2x2(*(p2 + 2), *(p2 + 3), *(p2 + 6), *(p2 + 7));
var b21 = matrix2.row3.Point1;
var b22 = matrix2.row3.Point2;
var c11 = a11.multiple(b11) + a12.multiple(b21);
var c12 = a11.multiple(b12) + a12.multiple(b22);
var c21 = a21.multiple(b11) + a22.multiple(b21);
var c22 = a21.multiple(b12) + a22.multiple(b22);
return new Matrix4x4(
new Vec4D(c11.row1, c12.row1),
new Vec4D(c11.row2, c12.row2),
new Vec4D(c21.row1, c22.row1),
new Vec4D(c21.row2, c22.row2)
);
}
/// <summary>
///