Kimelas/bgc-net
2
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Отказ от функций GetWeightedSum в пользу AppendScaled; оптимизация версоров / Replacing of GetWeightedSum onto AppendScaled; versor optimization

Browse source
This commit is contained in:
Andrey Pokidov 2024-11-20 01:33:05 +07:00
parent c3dc0b2ecd
commit c66edd3432
14 changed files with 142 additions and 548 deletions
Download patch file Download diff file Expand all files Collapse all files

73
BGC/F64Matrix3x2.cs
View file

@ -170,6 +170,17 @@ namespace BGC
this.r2c3 = r2;
}
public void AppendScaled(in F64Matrix3x2 matrix, double scale)
{
this.r1c1 += matrix.r1c1 * scale;
this.r1c2 += matrix.r1c2 * scale;
this.r1c3 += matrix.r1c3 * scale;
this.r2c1 += matrix.r2c1 * scale;
this.r2c2 += matrix.r2c2 * scale;
this.r2c3 += matrix.r2c3 * scale;
}
public static void Add(in F64Matrix3x2 matrix1, in F64Matrix3x2 matrix2, out F64Matrix3x2 sum)
{
sum.r1c1 = matrix1.r1c1 + matrix2.r1c1;
@ -214,68 +225,6 @@ namespace BGC
quotient.r2c3 = dividend.r2c3 / divisor;
}
public static void GetWeightedSum2(
double weight1, in F64Matrix3x2 matrix1,
double weight2, in F64Matrix3x2 matrix2,
out F64Matrix3x2 sum)
{
sum.r1c1 = matrix1.r1c1 * weight1 + matrix2.r1c1 * weight2;
sum.r1c2 = matrix1.r1c2 * weight1 + matrix2.r1c2 * weight2;
sum.r1c3 = matrix1.r1c3 * weight1 + matrix2.r1c3 * weight2;
sum.r2c1 = matrix1.r2c1 * weight1 + matrix2.r2c1 * weight2;
sum.r2c2 = matrix1.r2c2 * weight1 + matrix2.r2c2 * weight2;
sum.r2c3 = matrix1.r2c3 * weight1 + matrix2.r2c3 * weight2;
}
public static void GetWeightedSum3(
double weight1, in F64Matrix3x2 matrix1,
double weight2, in F64Matrix3x2 matrix2,
double weight3, in F64Matrix3x2 matrix3,
out F64Matrix3x2 sum)
{
sum.r1c1 = matrix1.r1c1 * weight1 + matrix2.r1c1 * weight2 + matrix3.r1c1 * weight3;
sum.r1c2 = matrix1.r1c2 * weight1 + matrix2.r1c2 * weight2 + matrix3.r1c2 * weight3;
sum.r1c3 = matrix1.r1c3 * weight1 + matrix2.r1c3 * weight2 + matrix3.r1c3 * weight3;
sum.r2c1 = matrix1.r2c1 * weight1 + matrix2.r2c1 * weight2 + matrix3.r2c1 * weight3;
sum.r2c2 = matrix1.r2c2 * weight1 + matrix2.r2c2 * weight2 + matrix3.r2c2 * weight3;
sum.r2c3 = matrix1.r2c3 * weight1 + matrix2.r2c3 * weight2 + matrix3.r2c3 * weight3;
}
public static void GetWeightedSum4(
double weight1, in F64Matrix3x2 matrix1,
double weight2, in F64Matrix3x2 matrix2,
double weight3, in F64Matrix3x2 matrix3,
double weight4, in F64Matrix3x2 matrix4,
out F64Matrix3x2 sum)
{
sum.r1c1 = (matrix1.r1c1 * weight1 + matrix2.r1c1 * weight2) + (matrix3.r1c1 * weight3 + matrix4.r1c1 * weight4);
sum.r1c2 = (matrix1.r1c2 * weight1 + matrix2.r1c2 * weight2) + (matrix3.r1c2 * weight3 + matrix4.r1c2 * weight4);
sum.r1c3 = (matrix1.r1c3 * weight1 + matrix2.r1c3 * weight2) + (matrix3.r1c3 * weight3 + matrix4.r1c3 * weight4);
sum.r2c1 = (matrix1.r2c1 * weight1 + matrix2.r2c1 * weight2) + (matrix3.r2c1 * weight3 + matrix4.r2c1 * weight4);
sum.r2c2 = (matrix1.r2c2 * weight1 + matrix2.r2c2 * weight2) + (matrix3.r2c2 * weight3 + matrix4.r2c2 * weight4);
sum.r2c3 = (matrix1.r2c3 * weight1 + matrix2.r2c3 * weight2) + (matrix3.r2c3 * weight3 + matrix4.r2c3 * weight4);
}
public static void GetWeightedSum5(
double weight1, in F64Matrix3x2 matrix1,
double weight2, in F64Matrix3x2 matrix2,
double weight3, in F64Matrix3x2 matrix3,
double weight4, in F64Matrix3x2 matrix4,
double weight5, in F64Matrix3x2 matrix5,
out F64Matrix3x2 sum)
{
sum.r1c1 = (matrix1.r1c1 * weight1 + matrix2.r1c1 * weight2) + (matrix3.r1c1 * weight3 + matrix4.r1c1 * weight4) + matrix5.r1c1 * weight5;
sum.r1c2 = (matrix1.r1c2 * weight1 + matrix2.r1c2 * weight2) + (matrix3.r1c2 * weight3 + matrix4.r1c2 * weight4) + matrix5.r1c2 * weight5;
sum.r1c3 = (matrix1.r1c3 * weight1 + matrix2.r1c3 * weight2) + (matrix3.r1c3 * weight3 + matrix4.r1c3 * weight4) + matrix5.r1c3 * weight5;
sum.r2c1 = (matrix1.r2c1 * weight1 + matrix2.r2c1 * weight2) + (matrix3.r2c1 * weight3 + matrix4.r2c1 * weight4) + matrix5.r2c1 * weight5;
sum.r2c2 = (matrix1.r2c2 * weight1 + matrix2.r2c2 * weight2) + (matrix3.r2c2 * weight3 + matrix4.r2c2 * weight4) + matrix5.r2c2 * weight5;
sum.r2c3 = (matrix1.r2c3 * weight1 + matrix2.r2c3 * weight2) + (matrix3.r2c3 * weight3 + matrix4.r2c3 * weight4) + matrix5.r2c3 * weight5;
}
public static void GetRightProduct(in F64Matrix3x2 matrix, in F64Vector3 vector, out F64Vector2 result)
{
result.x1 = matrix.r1c1 * vector.x1 + matrix.r1c2 * vector.x2 + matrix.r1c3 * vector.x3;