157 lines
6.7 KiB
C#
157 lines
6.7 KiB
C#
/*
|
|
* Author: Andrey Pokidov
|
|
* License: Apache-2.0
|
|
* Date: 11 Nov 2024
|
|
*/
|
|
|
|
namespace BGC
|
|
{
|
|
public class MatrixProductFP64
|
|
{
|
|
public static void Get2x2At2x2(in Matrix2x2FP64 left, in Matrix2x2FP64 right, out Matrix2x2FP64 product)
|
|
{
|
|
double r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1;
|
|
double r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2;
|
|
|
|
double r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1;
|
|
double r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2;
|
|
|
|
product.r1c1 = r1c1;
|
|
product.r1c2 = r1c2;
|
|
|
|
product.r2c1 = r2c1;
|
|
product.r2c2 = r2c2;
|
|
}
|
|
|
|
public static void Get2x2At3x2(in Matrix2x2FP64 left, in Matrix3x2FP64 right, out Matrix3x2FP64 product)
|
|
{
|
|
double r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1;
|
|
double r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2;
|
|
double r1c3 = left.r1c1 * right.r1c3 + left.r1c2 * right.r2c3;
|
|
|
|
double r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1;
|
|
double r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2;
|
|
double r2c3 = left.r2c1 * right.r1c3 + left.r2c2 * right.r2c3;
|
|
|
|
product.r1c1 = r1c1;
|
|
product.r1c2 = r1c2;
|
|
product.r1c3 = r1c3;
|
|
|
|
product.r2c1 = r2c1;
|
|
product.r2c2 = r2c2;
|
|
product.r2c3 = r2c3;
|
|
}
|
|
|
|
public static void Get2x3At2x2(in Matrix2x3FP64 left, in Matrix2x2FP64 right, out Matrix2x3FP64 product)
|
|
{
|
|
double r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1;
|
|
double r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2;
|
|
|
|
double r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1;
|
|
double r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2;
|
|
|
|
double r3c1 = left.r3c1 * right.r1c1 + left.r3c2 * right.r2c1;
|
|
double r3c2 = left.r3c1 * right.r1c2 + left.r3c2 * right.r2c2;
|
|
|
|
product.r1c1 = r1c1;
|
|
product.r1c2 = r1c2;
|
|
|
|
product.r2c1 = r2c1;
|
|
product.r2c2 = r2c2;
|
|
|
|
product.r3c1 = r3c1;
|
|
product.r3c2 = r3c2;
|
|
}
|
|
|
|
public static void Get2x3At3x2(in Matrix2x3FP64 left, in Matrix3x2FP64 right, out Matrix3x3FP64 product)
|
|
{
|
|
product.r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1;
|
|
product.r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2;
|
|
product.r1c3 = left.r1c1 * right.r1c3 + left.r1c2 * right.r2c3;
|
|
|
|
product.r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1;
|
|
product.r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2;
|
|
product.r2c3 = left.r2c1 * right.r1c3 + left.r2c2 * right.r2c3;
|
|
|
|
product.r3c1 = left.r3c1 * right.r1c1 + left.r3c2 * right.r2c1;
|
|
product.r3c2 = left.r3c1 * right.r1c2 + left.r3c2 * right.r2c2;
|
|
product.r3c3 = left.r3c1 * right.r1c2 + left.r3c2 * right.r2c3;
|
|
}
|
|
|
|
public static void Get3x2At3x3(in Matrix3x2FP64 left, in Matrix3x3FP64 right, out Matrix3x2FP64 product)
|
|
{
|
|
double r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1 + left.r1c3 * right.r3c1;
|
|
double r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2 + left.r1c3 * right.r3c2;
|
|
double r1c3 = left.r1c1 * right.r1c3 + left.r1c2 * right.r2c3 + left.r1c3 * right.r3c3;
|
|
|
|
double r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1 + left.r2c3 * right.r3c1;
|
|
double r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2 + left.r2c3 * right.r3c2;
|
|
double r2c3 = left.r2c1 * right.r1c3 + left.r2c2 * right.r2c3 + left.r2c3 * right.r3c3;
|
|
|
|
product.r1c1 = r1c1;
|
|
product.r1c2 = r1c2;
|
|
product.r1c3 = r1c3;
|
|
|
|
product.r2c1 = r2c1;
|
|
product.r2c2 = r2c2;
|
|
product.r2c3 = r2c3;
|
|
}
|
|
|
|
public static void Get3x2At2x3(in Matrix3x2FP64 left, in Matrix2x3FP64 right, out Matrix2x2FP64 product)
|
|
{
|
|
product.r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1 + left.r1c3 * right.r3c1;
|
|
product.r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2 + left.r1c3 * right.r3c2;
|
|
|
|
product.r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1 + left.r2c3 * right.r3c1;
|
|
product.r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2 + left.r2c3 * right.r3c2;
|
|
}
|
|
|
|
public static void Get3x3At2x3(in Matrix3x3FP64 left, in Matrix2x3FP64 right, out Matrix2x3FP64 product)
|
|
{
|
|
double r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1 + left.r1c3 * right.r3c1;
|
|
double r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2 + left.r1c3 * right.r3c2;
|
|
|
|
double r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1 + left.r2c3 * right.r3c1;
|
|
double r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2 + left.r2c3 * right.r3c2;
|
|
|
|
double r3c1 = left.r3c1 * right.r1c1 + left.r3c2 * right.r2c1 + left.r3c3 * right.r3c1;
|
|
double r3c2 = left.r3c1 * right.r1c2 + left.r3c2 * right.r2c2 + left.r3c3 * right.r3c2;
|
|
|
|
product.r1c1 = r1c1;
|
|
product.r1c2 = r1c2;
|
|
|
|
product.r2c1 = r2c1;
|
|
product.r2c2 = r2c2;
|
|
|
|
product.r3c1 = r3c1;
|
|
product.r3c2 = r3c2;
|
|
}
|
|
|
|
public static void Get3x3At3x3(in Matrix3x3FP64 left, in Matrix3x3FP64 right, out Matrix3x3FP64 product)
|
|
{
|
|
double r1c1 = left.r1c1 * right.r1c1 + left.r1c2 * right.r2c1 + left.r1c3 * right.r3c1;
|
|
double r1c2 = left.r1c1 * right.r1c2 + left.r1c2 * right.r2c2 + left.r1c3 * right.r3c2;
|
|
double r1c3 = left.r1c1 * right.r1c3 + left.r1c2 * right.r2c3 + left.r1c3 * right.r3c3;
|
|
|
|
double r2c1 = left.r2c1 * right.r1c1 + left.r2c2 * right.r2c1 + left.r2c3 * right.r3c1;
|
|
double r2c2 = left.r2c1 * right.r1c2 + left.r2c2 * right.r2c2 + left.r2c3 * right.r3c2;
|
|
double r2c3 = left.r2c1 * right.r1c3 + left.r2c2 * right.r2c3 + left.r2c3 * right.r3c3;
|
|
|
|
double r3c1 = left.r3c1 * right.r1c1 + left.r3c2 * right.r2c1 + left.r3c3 * right.r3c1;
|
|
double r3c2 = left.r3c1 * right.r1c2 + left.r3c2 * right.r2c2 + left.r3c3 * right.r3c2;
|
|
double r3c3 = left.r3c1 * right.r1c3 + left.r3c2 * right.r2c3 + left.r3c3 * right.r3c3;
|
|
|
|
product.r1c1 = r1c1;
|
|
product.r1c2 = r1c2;
|
|
product.r1c3 = r1c3;
|
|
|
|
product.r2c1 = r2c1;
|
|
product.r2c2 = r2c2;
|
|
product.r2c3 = r2c3;
|
|
|
|
product.r3c1 = r3c1;
|
|
product.r3c2 = r3c2;
|
|
product.r3c3 = r3c3;
|
|
}
|
|
}
|
|
}
|