From cb1bec0328a4c1532c974dc358f6dfaf11002aba Mon Sep 17 00:00:00 2001 From: DBotThePony Date: Sat, 19 Feb 2022 18:48:44 +0700 Subject: [PATCH] KVector initial commit --- build.gradle.kts | 12 + gradle.properties | 3 +- .../matrix/generated/MultiplicationsByte.java | 3024 +++++++++++++++++ .../generated/MultiplicationsDouble.java | 3024 +++++++++++++++++ .../generated/MultiplicationsFloat.java | 3024 +++++++++++++++++ .../matrix/generated/MultiplicationsInt.java | 3024 +++++++++++++++++ .../matrix/generated/MultiplicationsLong.java | 3024 +++++++++++++++++ .../generated/MultiplicationsShort.java | 3024 +++++++++++++++++ .../dbotthepony/kvector/api/DoubleMatrix.kt | 111 + .../ru/dbotthepony/kvector/api/FloatMatrix.kt | 111 + .../ru/dbotthepony/kvector/api/Matrix.kt | 437 +++ .../ru/dbotthepony/kvector/api/Struct.kt | 82 + .../ru/dbotthepony/kvector/api/Vector.kt | 433 +++ .../kvector/api/concrete/DoubleMatrix.kt | 166 + .../kvector/api/concrete/FloatMatrix.kt | 167 + .../dbotthepony/kvector/matrix/functions.kt | 521 +++ .../matrix/generated/DeterminantsByte.kt | 94 + .../matrix/generated/DeterminantsDouble.kt | 94 + .../matrix/generated/DeterminantsFloat.kt | 94 + .../matrix/generated/DeterminantsInt.kt | 94 + .../matrix/generated/DeterminantsLong.kt | 94 + .../matrix/generated/DeterminantsShort.kt | 94 + .../kvector/matrix/ndouble/Matrix2d.kt | 228 ++ .../kvector/matrix/ndouble/Matrix3d.kt | 393 +++ .../kvector/matrix/ndouble/Matrix4d.kt | 569 ++++ .../kvector/matrix/ndouble/MatrixVd.kt | 316 ++ .../kvector/matrix/nfloat/Matrix2f.kt | 226 ++ .../kvector/matrix/nfloat/Matrix3f.kt | 394 +++ .../kvector/matrix/nfloat/Matrix4f.kt | 543 +++ .../kvector/matrix/nfloat/MatrixVf.kt | 316 ++ .../kvector/narray/TwoDimensional.kt | 210 ++ .../kvector/vector/ndouble/Vector2d.kt | 407 +++ .../kvector/vector/ndouble/Vector3d.kt | 663 ++++ .../kvector/vector/ndouble/Vector4d.kt | 1372 ++++++++ .../kvector/vector/nfloat/Vector2f.kt | 395 +++ .../kvector/vector/nfloat/Vector3f.kt | 680 ++++ .../kvector/vector/nfloat/Vector4f.kt | 1363 ++++++++ .../kvector/vector/nint/Vector2i.kt | 331 ++ .../kvector/vector/nint/Vector3i.kt | 632 ++++ .../kvector/vector/nint/Vector4i.kt | 1329 ++++++++ .../dbotthepony/kstarbound/test/MathTests.kt | 72 + 41 files changed, 31189 insertions(+), 1 deletion(-) create mode 100644 src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsByte.java create mode 100644 src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsDouble.java create mode 100644 src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsFloat.java create mode 100644 src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsInt.java create mode 100644 src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsLong.java create mode 100644 src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsShort.java create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/DoubleMatrix.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/FloatMatrix.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/Matrix.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/Struct.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/Vector.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/DoubleMatrix.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/FloatMatrix.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/functions.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsByte.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsDouble.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsFloat.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsInt.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsLong.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsShort.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix2d.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix3d.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix4d.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/MatrixVd.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix2f.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix3f.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix4f.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/MatrixVf.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/narray/TwoDimensional.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector2d.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector3d.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector4d.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector2f.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector3f.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector4f.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector2i.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector3i.kt create mode 100644 src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector4i.kt diff --git a/build.gradle.kts b/build.gradle.kts index 7b12a8a5..7b8fa953 100644 --- a/build.gradle.kts +++ b/build.gradle.kts @@ -26,9 +26,21 @@ java.toolchain.languageVersion.set(JavaLanguageVersion.of(17)) tasks.compileKotlin { kotlinOptions { jvmTarget = "17" + freeCompilerArgs += "-opt-in=kotlin.RequiresOptIn" } } +sourceSets { + create("kvector") { + + } +} + +sourceSets.test { + compileClasspath += sourceSets["kvector"].output + runtimeClasspath += sourceSets["kvector"].output +} + dependencies { implementation(kotlin("stdlib")) implementation(kotlin("reflect")) diff --git a/gradle.properties b/gradle.properties index 29e08e8c..75ea1583 100644 --- a/gradle.properties +++ b/gradle.properties @@ -1 +1,2 @@ -kotlin.code.style=official \ No newline at end of file +kotlin.code.style=official +org.gradle.jvmargs=-Xmx2g -XX:MaxMetaspaceSize=512m diff --git a/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsByte.java b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsByte.java new file mode 100644 index 00000000..5d873d7f --- /dev/null +++ b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsByte.java @@ -0,0 +1,3024 @@ +package ru.dbotthepony.kvector.matrix.generated; + +import ru.dbotthepony.kvector.api.*; +import ru.dbotthepony.kvector.narray.*; + +// Some metaprogramming +///////////////////////////////// +// THIS FILE IS AUTO GENERATED // +// DO NOT EDIT // +///////////////////////////////// + +public final class MultiplicationsByte { + private MultiplicationsByte() {} + + private static IMatrixSetterByte multiplyMatrix2x2x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x2x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x2x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x2x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x2x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x2x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x2x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x2x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x2x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x2x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x2x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x2x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x2x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x2x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x2x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x2x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41)); + output.set(4, 4, (byte) (f_c04*s_c40 + f_c14*s_c41)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x3x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x3x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x3x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x3x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x3x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x3x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x3x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x3x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x3x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x3x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x3x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x3x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x3x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x3x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x3x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x3x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42)); + output.set(4, 4, (byte) (f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x4x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x4x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x4x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x4x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x4x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x4x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x4x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x4x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x4x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x4x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x4x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x4x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x4x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x4x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x4x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x4x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43)); + output.set(4, 4, (byte) (f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x5x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x5x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x5x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix2x5x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + final byte s_c44 = matrix2.get(4, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x5x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x5x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x5x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix3x5x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + final byte s_c44 = matrix2.get(4, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x5x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x5x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x5x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix4x5x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + final byte s_c44 = matrix2.get(4, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x5x2(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte f_c44 = matrix1.get(4, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x5x3(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte f_c44 = matrix1.get(4, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x5x4(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte f_c44 = matrix1.get(4, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34)); + return output; + } + + private static IMatrixSetterByte multiplyMatrix5x5x5(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final byte f_c00 = matrix1.get(0, 0); + final byte f_c10 = matrix1.get(1, 0); + final byte f_c20 = matrix1.get(2, 0); + final byte f_c30 = matrix1.get(3, 0); + final byte f_c40 = matrix1.get(4, 0); + final byte f_c01 = matrix1.get(0, 1); + final byte f_c11 = matrix1.get(1, 1); + final byte f_c21 = matrix1.get(2, 1); + final byte f_c31 = matrix1.get(3, 1); + final byte f_c41 = matrix1.get(4, 1); + final byte f_c02 = matrix1.get(0, 2); + final byte f_c12 = matrix1.get(1, 2); + final byte f_c22 = matrix1.get(2, 2); + final byte f_c32 = matrix1.get(3, 2); + final byte f_c42 = matrix1.get(4, 2); + final byte f_c03 = matrix1.get(0, 3); + final byte f_c13 = matrix1.get(1, 3); + final byte f_c23 = matrix1.get(2, 3); + final byte f_c33 = matrix1.get(3, 3); + final byte f_c43 = matrix1.get(4, 3); + final byte f_c04 = matrix1.get(0, 4); + final byte f_c14 = matrix1.get(1, 4); + final byte f_c24 = matrix1.get(2, 4); + final byte f_c34 = matrix1.get(3, 4); + final byte f_c44 = matrix1.get(4, 4); + final byte s_c00 = matrix2.get(0, 0); + final byte s_c10 = matrix2.get(1, 0); + final byte s_c20 = matrix2.get(2, 0); + final byte s_c30 = matrix2.get(3, 0); + final byte s_c40 = matrix2.get(4, 0); + final byte s_c01 = matrix2.get(0, 1); + final byte s_c11 = matrix2.get(1, 1); + final byte s_c21 = matrix2.get(2, 1); + final byte s_c31 = matrix2.get(3, 1); + final byte s_c41 = matrix2.get(4, 1); + final byte s_c02 = matrix2.get(0, 2); + final byte s_c12 = matrix2.get(1, 2); + final byte s_c22 = matrix2.get(2, 2); + final byte s_c32 = matrix2.get(3, 2); + final byte s_c42 = matrix2.get(4, 2); + final byte s_c03 = matrix2.get(0, 3); + final byte s_c13 = matrix2.get(1, 3); + final byte s_c23 = matrix2.get(2, 3); + final byte s_c33 = matrix2.get(3, 3); + final byte s_c43 = matrix2.get(4, 3); + final byte s_c04 = matrix2.get(0, 4); + final byte s_c14 = matrix2.get(1, 4); + final byte s_c24 = matrix2.get(2, 4); + final byte s_c34 = matrix2.get(3, 4); + final byte s_c44 = matrix2.get(4, 4); + output.set(0, 0, (byte) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (byte) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (byte) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (byte) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (byte) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (byte) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (byte) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (byte) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (byte) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (byte) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + output.set(2, 0, (byte) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (byte) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (byte) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (byte) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(2, 4, (byte) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24)); + output.set(3, 0, (byte) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (byte) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (byte) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (byte) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + output.set(3, 4, (byte) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34)); + output.set(4, 0, (byte) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (byte) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + output.set(4, 2, (byte) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44)); + output.set(4, 3, (byte) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44)); + output.set(4, 4, (byte) (f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43 + f_c44*s_c44)); + return output; + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * + * @return new Byte2Dimensional + */ + @org.jetbrains.annotations.Nullable + public static Byte2Dimensional multiplyMatrix(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix2x2x2(matrix1, matrix2, new Byte2Dimensional(2, 2)); + case 3: return (Byte2Dimensional) multiplyMatrix2x2x3(matrix1, matrix2, new Byte2Dimensional(3, 2)); + case 4: return (Byte2Dimensional) multiplyMatrix2x2x4(matrix1, matrix2, new Byte2Dimensional(4, 2)); + case 5: return (Byte2Dimensional) multiplyMatrix2x2x5(matrix1, matrix2, new Byte2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix3x2x2(matrix1, matrix2, new Byte2Dimensional(2, 3)); + case 3: return (Byte2Dimensional) multiplyMatrix3x2x3(matrix1, matrix2, new Byte2Dimensional(3, 3)); + case 4: return (Byte2Dimensional) multiplyMatrix3x2x4(matrix1, matrix2, new Byte2Dimensional(4, 3)); + case 5: return (Byte2Dimensional) multiplyMatrix3x2x5(matrix1, matrix2, new Byte2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix4x2x2(matrix1, matrix2, new Byte2Dimensional(2, 4)); + case 3: return (Byte2Dimensional) multiplyMatrix4x2x3(matrix1, matrix2, new Byte2Dimensional(3, 4)); + case 4: return (Byte2Dimensional) multiplyMatrix4x2x4(matrix1, matrix2, new Byte2Dimensional(4, 4)); + case 5: return (Byte2Dimensional) multiplyMatrix4x2x5(matrix1, matrix2, new Byte2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix5x2x2(matrix1, matrix2, new Byte2Dimensional(2, 5)); + case 3: return (Byte2Dimensional) multiplyMatrix5x2x3(matrix1, matrix2, new Byte2Dimensional(3, 5)); + case 4: return (Byte2Dimensional) multiplyMatrix5x2x4(matrix1, matrix2, new Byte2Dimensional(4, 5)); + case 5: return (Byte2Dimensional) multiplyMatrix5x2x5(matrix1, matrix2, new Byte2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix2x3x2(matrix1, matrix2, new Byte2Dimensional(2, 2)); + case 3: return (Byte2Dimensional) multiplyMatrix2x3x3(matrix1, matrix2, new Byte2Dimensional(3, 2)); + case 4: return (Byte2Dimensional) multiplyMatrix2x3x4(matrix1, matrix2, new Byte2Dimensional(4, 2)); + case 5: return (Byte2Dimensional) multiplyMatrix2x3x5(matrix1, matrix2, new Byte2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix3x3x2(matrix1, matrix2, new Byte2Dimensional(2, 3)); + case 3: return (Byte2Dimensional) multiplyMatrix3x3x3(matrix1, matrix2, new Byte2Dimensional(3, 3)); + case 4: return (Byte2Dimensional) multiplyMatrix3x3x4(matrix1, matrix2, new Byte2Dimensional(4, 3)); + case 5: return (Byte2Dimensional) multiplyMatrix3x3x5(matrix1, matrix2, new Byte2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix4x3x2(matrix1, matrix2, new Byte2Dimensional(2, 4)); + case 3: return (Byte2Dimensional) multiplyMatrix4x3x3(matrix1, matrix2, new Byte2Dimensional(3, 4)); + case 4: return (Byte2Dimensional) multiplyMatrix4x3x4(matrix1, matrix2, new Byte2Dimensional(4, 4)); + case 5: return (Byte2Dimensional) multiplyMatrix4x3x5(matrix1, matrix2, new Byte2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix5x3x2(matrix1, matrix2, new Byte2Dimensional(2, 5)); + case 3: return (Byte2Dimensional) multiplyMatrix5x3x3(matrix1, matrix2, new Byte2Dimensional(3, 5)); + case 4: return (Byte2Dimensional) multiplyMatrix5x3x4(matrix1, matrix2, new Byte2Dimensional(4, 5)); + case 5: return (Byte2Dimensional) multiplyMatrix5x3x5(matrix1, matrix2, new Byte2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix2x4x2(matrix1, matrix2, new Byte2Dimensional(2, 2)); + case 3: return (Byte2Dimensional) multiplyMatrix2x4x3(matrix1, matrix2, new Byte2Dimensional(3, 2)); + case 4: return (Byte2Dimensional) multiplyMatrix2x4x4(matrix1, matrix2, new Byte2Dimensional(4, 2)); + case 5: return (Byte2Dimensional) multiplyMatrix2x4x5(matrix1, matrix2, new Byte2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix3x4x2(matrix1, matrix2, new Byte2Dimensional(2, 3)); + case 3: return (Byte2Dimensional) multiplyMatrix3x4x3(matrix1, matrix2, new Byte2Dimensional(3, 3)); + case 4: return (Byte2Dimensional) multiplyMatrix3x4x4(matrix1, matrix2, new Byte2Dimensional(4, 3)); + case 5: return (Byte2Dimensional) multiplyMatrix3x4x5(matrix1, matrix2, new Byte2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix4x4x2(matrix1, matrix2, new Byte2Dimensional(2, 4)); + case 3: return (Byte2Dimensional) multiplyMatrix4x4x3(matrix1, matrix2, new Byte2Dimensional(3, 4)); + case 4: return (Byte2Dimensional) multiplyMatrix4x4x4(matrix1, matrix2, new Byte2Dimensional(4, 4)); + case 5: return (Byte2Dimensional) multiplyMatrix4x4x5(matrix1, matrix2, new Byte2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix5x4x2(matrix1, matrix2, new Byte2Dimensional(2, 5)); + case 3: return (Byte2Dimensional) multiplyMatrix5x4x3(matrix1, matrix2, new Byte2Dimensional(3, 5)); + case 4: return (Byte2Dimensional) multiplyMatrix5x4x4(matrix1, matrix2, new Byte2Dimensional(4, 5)); + case 5: return (Byte2Dimensional) multiplyMatrix5x4x5(matrix1, matrix2, new Byte2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix2x5x2(matrix1, matrix2, new Byte2Dimensional(2, 2)); + case 3: return (Byte2Dimensional) multiplyMatrix2x5x3(matrix1, matrix2, new Byte2Dimensional(3, 2)); + case 4: return (Byte2Dimensional) multiplyMatrix2x5x4(matrix1, matrix2, new Byte2Dimensional(4, 2)); + case 5: return (Byte2Dimensional) multiplyMatrix2x5x5(matrix1, matrix2, new Byte2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix3x5x2(matrix1, matrix2, new Byte2Dimensional(2, 3)); + case 3: return (Byte2Dimensional) multiplyMatrix3x5x3(matrix1, matrix2, new Byte2Dimensional(3, 3)); + case 4: return (Byte2Dimensional) multiplyMatrix3x5x4(matrix1, matrix2, new Byte2Dimensional(4, 3)); + case 5: return (Byte2Dimensional) multiplyMatrix3x5x5(matrix1, matrix2, new Byte2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix4x5x2(matrix1, matrix2, new Byte2Dimensional(2, 4)); + case 3: return (Byte2Dimensional) multiplyMatrix4x5x3(matrix1, matrix2, new Byte2Dimensional(3, 4)); + case 4: return (Byte2Dimensional) multiplyMatrix4x5x4(matrix1, matrix2, new Byte2Dimensional(4, 4)); + case 5: return (Byte2Dimensional) multiplyMatrix4x5x5(matrix1, matrix2, new Byte2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Byte2Dimensional) multiplyMatrix5x5x2(matrix1, matrix2, new Byte2Dimensional(2, 5)); + case 3: return (Byte2Dimensional) multiplyMatrix5x5x3(matrix1, matrix2, new Byte2Dimensional(3, 5)); + case 4: return (Byte2Dimensional) multiplyMatrix5x5x4(matrix1, matrix2, new Byte2Dimensional(4, 5)); + case 5: return (Byte2Dimensional) multiplyMatrix5x5x5(matrix1, matrix2, new Byte2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + default: return null; + } + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * This method writes the result to specified [output] + * @return provided IMatrixSetterByte if mapping exists and computed, or null if mapping does not exist + */ + @org.jetbrains.annotations.Nullable + public static IMatrixSetterByte multiplyMatrix(final IMatrixGetterByte matrix1, final IMatrixGetterByte matrix2, final IMatrixSetterByte output) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x2x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x2x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x2x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x2x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x3x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x3x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x3x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x3x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x4x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x4x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x4x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x4x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x5x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x5x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x5x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x5x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + default: return null; + } + } +} diff --git a/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsDouble.java b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsDouble.java new file mode 100644 index 00000000..3696c029 --- /dev/null +++ b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsDouble.java @@ -0,0 +1,3024 @@ +package ru.dbotthepony.kvector.matrix.generated; + +import ru.dbotthepony.kvector.api.*; +import ru.dbotthepony.kvector.narray.*; + +// Some metaprogramming +///////////////////////////////// +// THIS FILE IS AUTO GENERATED // +// DO NOT EDIT // +///////////////////////////////// + +public final class MultiplicationsDouble { + private MultiplicationsDouble() {} + + private static IMatrixSetterDouble multiplyMatrix2x2x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x2x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x2x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x2x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x2x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x2x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x2x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x2x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x2x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x2x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x2x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x2x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x2x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x2x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x2x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x2x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x3x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x3x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x3x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x3x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x3x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x3x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x3x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x3x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x3x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x3x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x3x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x3x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x3x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x3x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x3x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x3x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x4x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x4x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x4x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x4x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x4x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x4x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x4x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x4x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x4x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x4x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x4x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x4x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x4x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x4x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x4x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x4x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x5x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x5x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x5x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix2x5x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + final double s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x5x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x5x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x5x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix3x5x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + final double s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x5x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x5x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x5x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix4x5x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + final double s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x5x2(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double f_c44 = matrix1.get(4, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x5x3(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double f_c44 = matrix1.get(4, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x5x4(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double f_c44 = matrix1.get(4, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + return output; + } + + private static IMatrixSetterDouble multiplyMatrix5x5x5(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final double f_c00 = matrix1.get(0, 0); + final double f_c10 = matrix1.get(1, 0); + final double f_c20 = matrix1.get(2, 0); + final double f_c30 = matrix1.get(3, 0); + final double f_c40 = matrix1.get(4, 0); + final double f_c01 = matrix1.get(0, 1); + final double f_c11 = matrix1.get(1, 1); + final double f_c21 = matrix1.get(2, 1); + final double f_c31 = matrix1.get(3, 1); + final double f_c41 = matrix1.get(4, 1); + final double f_c02 = matrix1.get(0, 2); + final double f_c12 = matrix1.get(1, 2); + final double f_c22 = matrix1.get(2, 2); + final double f_c32 = matrix1.get(3, 2); + final double f_c42 = matrix1.get(4, 2); + final double f_c03 = matrix1.get(0, 3); + final double f_c13 = matrix1.get(1, 3); + final double f_c23 = matrix1.get(2, 3); + final double f_c33 = matrix1.get(3, 3); + final double f_c43 = matrix1.get(4, 3); + final double f_c04 = matrix1.get(0, 4); + final double f_c14 = matrix1.get(1, 4); + final double f_c24 = matrix1.get(2, 4); + final double f_c34 = matrix1.get(3, 4); + final double f_c44 = matrix1.get(4, 4); + final double s_c00 = matrix2.get(0, 0); + final double s_c10 = matrix2.get(1, 0); + final double s_c20 = matrix2.get(2, 0); + final double s_c30 = matrix2.get(3, 0); + final double s_c40 = matrix2.get(4, 0); + final double s_c01 = matrix2.get(0, 1); + final double s_c11 = matrix2.get(1, 1); + final double s_c21 = matrix2.get(2, 1); + final double s_c31 = matrix2.get(3, 1); + final double s_c41 = matrix2.get(4, 1); + final double s_c02 = matrix2.get(0, 2); + final double s_c12 = matrix2.get(1, 2); + final double s_c22 = matrix2.get(2, 2); + final double s_c32 = matrix2.get(3, 2); + final double s_c42 = matrix2.get(4, 2); + final double s_c03 = matrix2.get(0, 3); + final double s_c13 = matrix2.get(1, 3); + final double s_c23 = matrix2.get(2, 3); + final double s_c33 = matrix2.get(3, 3); + final double s_c43 = matrix2.get(4, 3); + final double s_c04 = matrix2.get(0, 4); + final double s_c14 = matrix2.get(1, 4); + final double s_c24 = matrix2.get(2, 4); + final double s_c34 = matrix2.get(3, 4); + final double s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43 + f_c44*s_c44); + return output; + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * + * @return new Double2Dimensional + */ + @org.jetbrains.annotations.Nullable + public static Double2Dimensional multiplyMatrix(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix2x2x2(matrix1, matrix2, new Double2Dimensional(2, 2)); + case 3: return (Double2Dimensional) multiplyMatrix2x2x3(matrix1, matrix2, new Double2Dimensional(3, 2)); + case 4: return (Double2Dimensional) multiplyMatrix2x2x4(matrix1, matrix2, new Double2Dimensional(4, 2)); + case 5: return (Double2Dimensional) multiplyMatrix2x2x5(matrix1, matrix2, new Double2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix3x2x2(matrix1, matrix2, new Double2Dimensional(2, 3)); + case 3: return (Double2Dimensional) multiplyMatrix3x2x3(matrix1, matrix2, new Double2Dimensional(3, 3)); + case 4: return (Double2Dimensional) multiplyMatrix3x2x4(matrix1, matrix2, new Double2Dimensional(4, 3)); + case 5: return (Double2Dimensional) multiplyMatrix3x2x5(matrix1, matrix2, new Double2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix4x2x2(matrix1, matrix2, new Double2Dimensional(2, 4)); + case 3: return (Double2Dimensional) multiplyMatrix4x2x3(matrix1, matrix2, new Double2Dimensional(3, 4)); + case 4: return (Double2Dimensional) multiplyMatrix4x2x4(matrix1, matrix2, new Double2Dimensional(4, 4)); + case 5: return (Double2Dimensional) multiplyMatrix4x2x5(matrix1, matrix2, new Double2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix5x2x2(matrix1, matrix2, new Double2Dimensional(2, 5)); + case 3: return (Double2Dimensional) multiplyMatrix5x2x3(matrix1, matrix2, new Double2Dimensional(3, 5)); + case 4: return (Double2Dimensional) multiplyMatrix5x2x4(matrix1, matrix2, new Double2Dimensional(4, 5)); + case 5: return (Double2Dimensional) multiplyMatrix5x2x5(matrix1, matrix2, new Double2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix2x3x2(matrix1, matrix2, new Double2Dimensional(2, 2)); + case 3: return (Double2Dimensional) multiplyMatrix2x3x3(matrix1, matrix2, new Double2Dimensional(3, 2)); + case 4: return (Double2Dimensional) multiplyMatrix2x3x4(matrix1, matrix2, new Double2Dimensional(4, 2)); + case 5: return (Double2Dimensional) multiplyMatrix2x3x5(matrix1, matrix2, new Double2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix3x3x2(matrix1, matrix2, new Double2Dimensional(2, 3)); + case 3: return (Double2Dimensional) multiplyMatrix3x3x3(matrix1, matrix2, new Double2Dimensional(3, 3)); + case 4: return (Double2Dimensional) multiplyMatrix3x3x4(matrix1, matrix2, new Double2Dimensional(4, 3)); + case 5: return (Double2Dimensional) multiplyMatrix3x3x5(matrix1, matrix2, new Double2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix4x3x2(matrix1, matrix2, new Double2Dimensional(2, 4)); + case 3: return (Double2Dimensional) multiplyMatrix4x3x3(matrix1, matrix2, new Double2Dimensional(3, 4)); + case 4: return (Double2Dimensional) multiplyMatrix4x3x4(matrix1, matrix2, new Double2Dimensional(4, 4)); + case 5: return (Double2Dimensional) multiplyMatrix4x3x5(matrix1, matrix2, new Double2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix5x3x2(matrix1, matrix2, new Double2Dimensional(2, 5)); + case 3: return (Double2Dimensional) multiplyMatrix5x3x3(matrix1, matrix2, new Double2Dimensional(3, 5)); + case 4: return (Double2Dimensional) multiplyMatrix5x3x4(matrix1, matrix2, new Double2Dimensional(4, 5)); + case 5: return (Double2Dimensional) multiplyMatrix5x3x5(matrix1, matrix2, new Double2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix2x4x2(matrix1, matrix2, new Double2Dimensional(2, 2)); + case 3: return (Double2Dimensional) multiplyMatrix2x4x3(matrix1, matrix2, new Double2Dimensional(3, 2)); + case 4: return (Double2Dimensional) multiplyMatrix2x4x4(matrix1, matrix2, new Double2Dimensional(4, 2)); + case 5: return (Double2Dimensional) multiplyMatrix2x4x5(matrix1, matrix2, new Double2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix3x4x2(matrix1, matrix2, new Double2Dimensional(2, 3)); + case 3: return (Double2Dimensional) multiplyMatrix3x4x3(matrix1, matrix2, new Double2Dimensional(3, 3)); + case 4: return (Double2Dimensional) multiplyMatrix3x4x4(matrix1, matrix2, new Double2Dimensional(4, 3)); + case 5: return (Double2Dimensional) multiplyMatrix3x4x5(matrix1, matrix2, new Double2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix4x4x2(matrix1, matrix2, new Double2Dimensional(2, 4)); + case 3: return (Double2Dimensional) multiplyMatrix4x4x3(matrix1, matrix2, new Double2Dimensional(3, 4)); + case 4: return (Double2Dimensional) multiplyMatrix4x4x4(matrix1, matrix2, new Double2Dimensional(4, 4)); + case 5: return (Double2Dimensional) multiplyMatrix4x4x5(matrix1, matrix2, new Double2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix5x4x2(matrix1, matrix2, new Double2Dimensional(2, 5)); + case 3: return (Double2Dimensional) multiplyMatrix5x4x3(matrix1, matrix2, new Double2Dimensional(3, 5)); + case 4: return (Double2Dimensional) multiplyMatrix5x4x4(matrix1, matrix2, new Double2Dimensional(4, 5)); + case 5: return (Double2Dimensional) multiplyMatrix5x4x5(matrix1, matrix2, new Double2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix2x5x2(matrix1, matrix2, new Double2Dimensional(2, 2)); + case 3: return (Double2Dimensional) multiplyMatrix2x5x3(matrix1, matrix2, new Double2Dimensional(3, 2)); + case 4: return (Double2Dimensional) multiplyMatrix2x5x4(matrix1, matrix2, new Double2Dimensional(4, 2)); + case 5: return (Double2Dimensional) multiplyMatrix2x5x5(matrix1, matrix2, new Double2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix3x5x2(matrix1, matrix2, new Double2Dimensional(2, 3)); + case 3: return (Double2Dimensional) multiplyMatrix3x5x3(matrix1, matrix2, new Double2Dimensional(3, 3)); + case 4: return (Double2Dimensional) multiplyMatrix3x5x4(matrix1, matrix2, new Double2Dimensional(4, 3)); + case 5: return (Double2Dimensional) multiplyMatrix3x5x5(matrix1, matrix2, new Double2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix4x5x2(matrix1, matrix2, new Double2Dimensional(2, 4)); + case 3: return (Double2Dimensional) multiplyMatrix4x5x3(matrix1, matrix2, new Double2Dimensional(3, 4)); + case 4: return (Double2Dimensional) multiplyMatrix4x5x4(matrix1, matrix2, new Double2Dimensional(4, 4)); + case 5: return (Double2Dimensional) multiplyMatrix4x5x5(matrix1, matrix2, new Double2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Double2Dimensional) multiplyMatrix5x5x2(matrix1, matrix2, new Double2Dimensional(2, 5)); + case 3: return (Double2Dimensional) multiplyMatrix5x5x3(matrix1, matrix2, new Double2Dimensional(3, 5)); + case 4: return (Double2Dimensional) multiplyMatrix5x5x4(matrix1, matrix2, new Double2Dimensional(4, 5)); + case 5: return (Double2Dimensional) multiplyMatrix5x5x5(matrix1, matrix2, new Double2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + default: return null; + } + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * This method writes the result to specified [output] + * @return provided IMatrixSetterDouble if mapping exists and computed, or null if mapping does not exist + */ + @org.jetbrains.annotations.Nullable + public static IMatrixSetterDouble multiplyMatrix(final IMatrixGetterDouble matrix1, final IMatrixGetterDouble matrix2, final IMatrixSetterDouble output) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x2x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x2x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x2x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x2x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x3x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x3x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x3x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x3x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x4x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x4x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x4x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x4x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x5x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x5x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x5x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x5x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + default: return null; + } + } +} diff --git a/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsFloat.java b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsFloat.java new file mode 100644 index 00000000..da618f4f --- /dev/null +++ b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsFloat.java @@ -0,0 +1,3024 @@ +package ru.dbotthepony.kvector.matrix.generated; + +import ru.dbotthepony.kvector.api.*; +import ru.dbotthepony.kvector.narray.*; + +// Some metaprogramming +///////////////////////////////// +// THIS FILE IS AUTO GENERATED // +// DO NOT EDIT // +///////////////////////////////// + +public final class MultiplicationsFloat { + private MultiplicationsFloat() {} + + private static IMatrixSetterFloat multiplyMatrix2x2x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x2x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x2x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x2x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x2x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x2x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x2x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x2x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x2x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x2x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x2x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x2x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x2x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x2x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x2x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x2x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x3x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x3x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x3x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x3x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x3x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x3x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x3x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x3x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x3x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x3x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x3x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x3x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x3x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x3x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x3x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x3x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x4x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x4x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x4x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x4x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x4x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x4x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x4x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x4x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x4x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x4x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x4x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x4x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x4x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x4x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x4x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x4x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x5x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x5x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x5x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix2x5x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + final float s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x5x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x5x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x5x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix3x5x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + final float s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x5x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x5x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x5x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix4x5x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + final float s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x5x2(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float f_c44 = matrix1.get(4, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x5x3(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float f_c44 = matrix1.get(4, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x5x4(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float f_c44 = matrix1.get(4, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + return output; + } + + private static IMatrixSetterFloat multiplyMatrix5x5x5(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final float f_c00 = matrix1.get(0, 0); + final float f_c10 = matrix1.get(1, 0); + final float f_c20 = matrix1.get(2, 0); + final float f_c30 = matrix1.get(3, 0); + final float f_c40 = matrix1.get(4, 0); + final float f_c01 = matrix1.get(0, 1); + final float f_c11 = matrix1.get(1, 1); + final float f_c21 = matrix1.get(2, 1); + final float f_c31 = matrix1.get(3, 1); + final float f_c41 = matrix1.get(4, 1); + final float f_c02 = matrix1.get(0, 2); + final float f_c12 = matrix1.get(1, 2); + final float f_c22 = matrix1.get(2, 2); + final float f_c32 = matrix1.get(3, 2); + final float f_c42 = matrix1.get(4, 2); + final float f_c03 = matrix1.get(0, 3); + final float f_c13 = matrix1.get(1, 3); + final float f_c23 = matrix1.get(2, 3); + final float f_c33 = matrix1.get(3, 3); + final float f_c43 = matrix1.get(4, 3); + final float f_c04 = matrix1.get(0, 4); + final float f_c14 = matrix1.get(1, 4); + final float f_c24 = matrix1.get(2, 4); + final float f_c34 = matrix1.get(3, 4); + final float f_c44 = matrix1.get(4, 4); + final float s_c00 = matrix2.get(0, 0); + final float s_c10 = matrix2.get(1, 0); + final float s_c20 = matrix2.get(2, 0); + final float s_c30 = matrix2.get(3, 0); + final float s_c40 = matrix2.get(4, 0); + final float s_c01 = matrix2.get(0, 1); + final float s_c11 = matrix2.get(1, 1); + final float s_c21 = matrix2.get(2, 1); + final float s_c31 = matrix2.get(3, 1); + final float s_c41 = matrix2.get(4, 1); + final float s_c02 = matrix2.get(0, 2); + final float s_c12 = matrix2.get(1, 2); + final float s_c22 = matrix2.get(2, 2); + final float s_c32 = matrix2.get(3, 2); + final float s_c42 = matrix2.get(4, 2); + final float s_c03 = matrix2.get(0, 3); + final float s_c13 = matrix2.get(1, 3); + final float s_c23 = matrix2.get(2, 3); + final float s_c33 = matrix2.get(3, 3); + final float s_c43 = matrix2.get(4, 3); + final float s_c04 = matrix2.get(0, 4); + final float s_c14 = matrix2.get(1, 4); + final float s_c24 = matrix2.get(2, 4); + final float s_c34 = matrix2.get(3, 4); + final float s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43 + f_c44*s_c44); + return output; + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * + * @return new Float2Dimensional + */ + @org.jetbrains.annotations.Nullable + public static Float2Dimensional multiplyMatrix(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix2x2x2(matrix1, matrix2, new Float2Dimensional(2, 2)); + case 3: return (Float2Dimensional) multiplyMatrix2x2x3(matrix1, matrix2, new Float2Dimensional(3, 2)); + case 4: return (Float2Dimensional) multiplyMatrix2x2x4(matrix1, matrix2, new Float2Dimensional(4, 2)); + case 5: return (Float2Dimensional) multiplyMatrix2x2x5(matrix1, matrix2, new Float2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix3x2x2(matrix1, matrix2, new Float2Dimensional(2, 3)); + case 3: return (Float2Dimensional) multiplyMatrix3x2x3(matrix1, matrix2, new Float2Dimensional(3, 3)); + case 4: return (Float2Dimensional) multiplyMatrix3x2x4(matrix1, matrix2, new Float2Dimensional(4, 3)); + case 5: return (Float2Dimensional) multiplyMatrix3x2x5(matrix1, matrix2, new Float2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix4x2x2(matrix1, matrix2, new Float2Dimensional(2, 4)); + case 3: return (Float2Dimensional) multiplyMatrix4x2x3(matrix1, matrix2, new Float2Dimensional(3, 4)); + case 4: return (Float2Dimensional) multiplyMatrix4x2x4(matrix1, matrix2, new Float2Dimensional(4, 4)); + case 5: return (Float2Dimensional) multiplyMatrix4x2x5(matrix1, matrix2, new Float2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix5x2x2(matrix1, matrix2, new Float2Dimensional(2, 5)); + case 3: return (Float2Dimensional) multiplyMatrix5x2x3(matrix1, matrix2, new Float2Dimensional(3, 5)); + case 4: return (Float2Dimensional) multiplyMatrix5x2x4(matrix1, matrix2, new Float2Dimensional(4, 5)); + case 5: return (Float2Dimensional) multiplyMatrix5x2x5(matrix1, matrix2, new Float2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix2x3x2(matrix1, matrix2, new Float2Dimensional(2, 2)); + case 3: return (Float2Dimensional) multiplyMatrix2x3x3(matrix1, matrix2, new Float2Dimensional(3, 2)); + case 4: return (Float2Dimensional) multiplyMatrix2x3x4(matrix1, matrix2, new Float2Dimensional(4, 2)); + case 5: return (Float2Dimensional) multiplyMatrix2x3x5(matrix1, matrix2, new Float2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix3x3x2(matrix1, matrix2, new Float2Dimensional(2, 3)); + case 3: return (Float2Dimensional) multiplyMatrix3x3x3(matrix1, matrix2, new Float2Dimensional(3, 3)); + case 4: return (Float2Dimensional) multiplyMatrix3x3x4(matrix1, matrix2, new Float2Dimensional(4, 3)); + case 5: return (Float2Dimensional) multiplyMatrix3x3x5(matrix1, matrix2, new Float2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix4x3x2(matrix1, matrix2, new Float2Dimensional(2, 4)); + case 3: return (Float2Dimensional) multiplyMatrix4x3x3(matrix1, matrix2, new Float2Dimensional(3, 4)); + case 4: return (Float2Dimensional) multiplyMatrix4x3x4(matrix1, matrix2, new Float2Dimensional(4, 4)); + case 5: return (Float2Dimensional) multiplyMatrix4x3x5(matrix1, matrix2, new Float2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix5x3x2(matrix1, matrix2, new Float2Dimensional(2, 5)); + case 3: return (Float2Dimensional) multiplyMatrix5x3x3(matrix1, matrix2, new Float2Dimensional(3, 5)); + case 4: return (Float2Dimensional) multiplyMatrix5x3x4(matrix1, matrix2, new Float2Dimensional(4, 5)); + case 5: return (Float2Dimensional) multiplyMatrix5x3x5(matrix1, matrix2, new Float2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix2x4x2(matrix1, matrix2, new Float2Dimensional(2, 2)); + case 3: return (Float2Dimensional) multiplyMatrix2x4x3(matrix1, matrix2, new Float2Dimensional(3, 2)); + case 4: return (Float2Dimensional) multiplyMatrix2x4x4(matrix1, matrix2, new Float2Dimensional(4, 2)); + case 5: return (Float2Dimensional) multiplyMatrix2x4x5(matrix1, matrix2, new Float2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix3x4x2(matrix1, matrix2, new Float2Dimensional(2, 3)); + case 3: return (Float2Dimensional) multiplyMatrix3x4x3(matrix1, matrix2, new Float2Dimensional(3, 3)); + case 4: return (Float2Dimensional) multiplyMatrix3x4x4(matrix1, matrix2, new Float2Dimensional(4, 3)); + case 5: return (Float2Dimensional) multiplyMatrix3x4x5(matrix1, matrix2, new Float2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix4x4x2(matrix1, matrix2, new Float2Dimensional(2, 4)); + case 3: return (Float2Dimensional) multiplyMatrix4x4x3(matrix1, matrix2, new Float2Dimensional(3, 4)); + case 4: return (Float2Dimensional) multiplyMatrix4x4x4(matrix1, matrix2, new Float2Dimensional(4, 4)); + case 5: return (Float2Dimensional) multiplyMatrix4x4x5(matrix1, matrix2, new Float2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix5x4x2(matrix1, matrix2, new Float2Dimensional(2, 5)); + case 3: return (Float2Dimensional) multiplyMatrix5x4x3(matrix1, matrix2, new Float2Dimensional(3, 5)); + case 4: return (Float2Dimensional) multiplyMatrix5x4x4(matrix1, matrix2, new Float2Dimensional(4, 5)); + case 5: return (Float2Dimensional) multiplyMatrix5x4x5(matrix1, matrix2, new Float2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix2x5x2(matrix1, matrix2, new Float2Dimensional(2, 2)); + case 3: return (Float2Dimensional) multiplyMatrix2x5x3(matrix1, matrix2, new Float2Dimensional(3, 2)); + case 4: return (Float2Dimensional) multiplyMatrix2x5x4(matrix1, matrix2, new Float2Dimensional(4, 2)); + case 5: return (Float2Dimensional) multiplyMatrix2x5x5(matrix1, matrix2, new Float2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix3x5x2(matrix1, matrix2, new Float2Dimensional(2, 3)); + case 3: return (Float2Dimensional) multiplyMatrix3x5x3(matrix1, matrix2, new Float2Dimensional(3, 3)); + case 4: return (Float2Dimensional) multiplyMatrix3x5x4(matrix1, matrix2, new Float2Dimensional(4, 3)); + case 5: return (Float2Dimensional) multiplyMatrix3x5x5(matrix1, matrix2, new Float2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix4x5x2(matrix1, matrix2, new Float2Dimensional(2, 4)); + case 3: return (Float2Dimensional) multiplyMatrix4x5x3(matrix1, matrix2, new Float2Dimensional(3, 4)); + case 4: return (Float2Dimensional) multiplyMatrix4x5x4(matrix1, matrix2, new Float2Dimensional(4, 4)); + case 5: return (Float2Dimensional) multiplyMatrix4x5x5(matrix1, matrix2, new Float2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Float2Dimensional) multiplyMatrix5x5x2(matrix1, matrix2, new Float2Dimensional(2, 5)); + case 3: return (Float2Dimensional) multiplyMatrix5x5x3(matrix1, matrix2, new Float2Dimensional(3, 5)); + case 4: return (Float2Dimensional) multiplyMatrix5x5x4(matrix1, matrix2, new Float2Dimensional(4, 5)); + case 5: return (Float2Dimensional) multiplyMatrix5x5x5(matrix1, matrix2, new Float2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + default: return null; + } + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * This method writes the result to specified [output] + * @return provided IMatrixSetterFloat if mapping exists and computed, or null if mapping does not exist + */ + @org.jetbrains.annotations.Nullable + public static IMatrixSetterFloat multiplyMatrix(final IMatrixGetterFloat matrix1, final IMatrixGetterFloat matrix2, final IMatrixSetterFloat output) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x2x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x2x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x2x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x2x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x3x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x3x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x3x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x3x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x4x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x4x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x4x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x4x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x5x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x5x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x5x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x5x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + default: return null; + } + } +} diff --git a/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsInt.java b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsInt.java new file mode 100644 index 00000000..a5d283ce --- /dev/null +++ b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsInt.java @@ -0,0 +1,3024 @@ +package ru.dbotthepony.kvector.matrix.generated; + +import ru.dbotthepony.kvector.api.*; +import ru.dbotthepony.kvector.narray.*; + +// Some metaprogramming +///////////////////////////////// +// THIS FILE IS AUTO GENERATED // +// DO NOT EDIT // +///////////////////////////////// + +public final class MultiplicationsInt { + private MultiplicationsInt() {} + + private static IMatrixSetterInt multiplyMatrix2x2x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x2x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x2x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x2x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x2x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x2x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x2x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x2x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x2x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x2x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x2x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x2x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x2x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x2x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x2x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x2x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x3x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x3x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x3x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x3x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x3x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x3x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x3x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x3x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x3x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x3x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x3x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x3x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x3x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x3x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x3x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x3x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x4x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x4x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x4x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x4x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x4x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x4x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x4x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x4x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x4x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x4x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x4x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x4x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x4x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x4x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x4x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x4x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x5x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x5x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x5x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + return output; + } + + private static IMatrixSetterInt multiplyMatrix2x5x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + final int s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x5x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x5x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x5x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + return output; + } + + private static IMatrixSetterInt multiplyMatrix3x5x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + final int s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x5x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x5x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x5x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + return output; + } + + private static IMatrixSetterInt multiplyMatrix4x5x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + final int s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x5x2(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int f_c44 = matrix1.get(4, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x5x3(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int f_c44 = matrix1.get(4, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x5x4(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int f_c44 = matrix1.get(4, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + return output; + } + + private static IMatrixSetterInt multiplyMatrix5x5x5(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final int f_c00 = matrix1.get(0, 0); + final int f_c10 = matrix1.get(1, 0); + final int f_c20 = matrix1.get(2, 0); + final int f_c30 = matrix1.get(3, 0); + final int f_c40 = matrix1.get(4, 0); + final int f_c01 = matrix1.get(0, 1); + final int f_c11 = matrix1.get(1, 1); + final int f_c21 = matrix1.get(2, 1); + final int f_c31 = matrix1.get(3, 1); + final int f_c41 = matrix1.get(4, 1); + final int f_c02 = matrix1.get(0, 2); + final int f_c12 = matrix1.get(1, 2); + final int f_c22 = matrix1.get(2, 2); + final int f_c32 = matrix1.get(3, 2); + final int f_c42 = matrix1.get(4, 2); + final int f_c03 = matrix1.get(0, 3); + final int f_c13 = matrix1.get(1, 3); + final int f_c23 = matrix1.get(2, 3); + final int f_c33 = matrix1.get(3, 3); + final int f_c43 = matrix1.get(4, 3); + final int f_c04 = matrix1.get(0, 4); + final int f_c14 = matrix1.get(1, 4); + final int f_c24 = matrix1.get(2, 4); + final int f_c34 = matrix1.get(3, 4); + final int f_c44 = matrix1.get(4, 4); + final int s_c00 = matrix2.get(0, 0); + final int s_c10 = matrix2.get(1, 0); + final int s_c20 = matrix2.get(2, 0); + final int s_c30 = matrix2.get(3, 0); + final int s_c40 = matrix2.get(4, 0); + final int s_c01 = matrix2.get(0, 1); + final int s_c11 = matrix2.get(1, 1); + final int s_c21 = matrix2.get(2, 1); + final int s_c31 = matrix2.get(3, 1); + final int s_c41 = matrix2.get(4, 1); + final int s_c02 = matrix2.get(0, 2); + final int s_c12 = matrix2.get(1, 2); + final int s_c22 = matrix2.get(2, 2); + final int s_c32 = matrix2.get(3, 2); + final int s_c42 = matrix2.get(4, 2); + final int s_c03 = matrix2.get(0, 3); + final int s_c13 = matrix2.get(1, 3); + final int s_c23 = matrix2.get(2, 3); + final int s_c33 = matrix2.get(3, 3); + final int s_c43 = matrix2.get(4, 3); + final int s_c04 = matrix2.get(0, 4); + final int s_c14 = matrix2.get(1, 4); + final int s_c24 = matrix2.get(2, 4); + final int s_c34 = matrix2.get(3, 4); + final int s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43 + f_c44*s_c44); + return output; + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * + * @return new Int2Dimensional + */ + @org.jetbrains.annotations.Nullable + public static Int2Dimensional multiplyMatrix(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix2x2x2(matrix1, matrix2, new Int2Dimensional(2, 2)); + case 3: return (Int2Dimensional) multiplyMatrix2x2x3(matrix1, matrix2, new Int2Dimensional(3, 2)); + case 4: return (Int2Dimensional) multiplyMatrix2x2x4(matrix1, matrix2, new Int2Dimensional(4, 2)); + case 5: return (Int2Dimensional) multiplyMatrix2x2x5(matrix1, matrix2, new Int2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix3x2x2(matrix1, matrix2, new Int2Dimensional(2, 3)); + case 3: return (Int2Dimensional) multiplyMatrix3x2x3(matrix1, matrix2, new Int2Dimensional(3, 3)); + case 4: return (Int2Dimensional) multiplyMatrix3x2x4(matrix1, matrix2, new Int2Dimensional(4, 3)); + case 5: return (Int2Dimensional) multiplyMatrix3x2x5(matrix1, matrix2, new Int2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix4x2x2(matrix1, matrix2, new Int2Dimensional(2, 4)); + case 3: return (Int2Dimensional) multiplyMatrix4x2x3(matrix1, matrix2, new Int2Dimensional(3, 4)); + case 4: return (Int2Dimensional) multiplyMatrix4x2x4(matrix1, matrix2, new Int2Dimensional(4, 4)); + case 5: return (Int2Dimensional) multiplyMatrix4x2x5(matrix1, matrix2, new Int2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix5x2x2(matrix1, matrix2, new Int2Dimensional(2, 5)); + case 3: return (Int2Dimensional) multiplyMatrix5x2x3(matrix1, matrix2, new Int2Dimensional(3, 5)); + case 4: return (Int2Dimensional) multiplyMatrix5x2x4(matrix1, matrix2, new Int2Dimensional(4, 5)); + case 5: return (Int2Dimensional) multiplyMatrix5x2x5(matrix1, matrix2, new Int2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix2x3x2(matrix1, matrix2, new Int2Dimensional(2, 2)); + case 3: return (Int2Dimensional) multiplyMatrix2x3x3(matrix1, matrix2, new Int2Dimensional(3, 2)); + case 4: return (Int2Dimensional) multiplyMatrix2x3x4(matrix1, matrix2, new Int2Dimensional(4, 2)); + case 5: return (Int2Dimensional) multiplyMatrix2x3x5(matrix1, matrix2, new Int2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix3x3x2(matrix1, matrix2, new Int2Dimensional(2, 3)); + case 3: return (Int2Dimensional) multiplyMatrix3x3x3(matrix1, matrix2, new Int2Dimensional(3, 3)); + case 4: return (Int2Dimensional) multiplyMatrix3x3x4(matrix1, matrix2, new Int2Dimensional(4, 3)); + case 5: return (Int2Dimensional) multiplyMatrix3x3x5(matrix1, matrix2, new Int2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix4x3x2(matrix1, matrix2, new Int2Dimensional(2, 4)); + case 3: return (Int2Dimensional) multiplyMatrix4x3x3(matrix1, matrix2, new Int2Dimensional(3, 4)); + case 4: return (Int2Dimensional) multiplyMatrix4x3x4(matrix1, matrix2, new Int2Dimensional(4, 4)); + case 5: return (Int2Dimensional) multiplyMatrix4x3x5(matrix1, matrix2, new Int2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix5x3x2(matrix1, matrix2, new Int2Dimensional(2, 5)); + case 3: return (Int2Dimensional) multiplyMatrix5x3x3(matrix1, matrix2, new Int2Dimensional(3, 5)); + case 4: return (Int2Dimensional) multiplyMatrix5x3x4(matrix1, matrix2, new Int2Dimensional(4, 5)); + case 5: return (Int2Dimensional) multiplyMatrix5x3x5(matrix1, matrix2, new Int2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix2x4x2(matrix1, matrix2, new Int2Dimensional(2, 2)); + case 3: return (Int2Dimensional) multiplyMatrix2x4x3(matrix1, matrix2, new Int2Dimensional(3, 2)); + case 4: return (Int2Dimensional) multiplyMatrix2x4x4(matrix1, matrix2, new Int2Dimensional(4, 2)); + case 5: return (Int2Dimensional) multiplyMatrix2x4x5(matrix1, matrix2, new Int2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix3x4x2(matrix1, matrix2, new Int2Dimensional(2, 3)); + case 3: return (Int2Dimensional) multiplyMatrix3x4x3(matrix1, matrix2, new Int2Dimensional(3, 3)); + case 4: return (Int2Dimensional) multiplyMatrix3x4x4(matrix1, matrix2, new Int2Dimensional(4, 3)); + case 5: return (Int2Dimensional) multiplyMatrix3x4x5(matrix1, matrix2, new Int2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix4x4x2(matrix1, matrix2, new Int2Dimensional(2, 4)); + case 3: return (Int2Dimensional) multiplyMatrix4x4x3(matrix1, matrix2, new Int2Dimensional(3, 4)); + case 4: return (Int2Dimensional) multiplyMatrix4x4x4(matrix1, matrix2, new Int2Dimensional(4, 4)); + case 5: return (Int2Dimensional) multiplyMatrix4x4x5(matrix1, matrix2, new Int2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix5x4x2(matrix1, matrix2, new Int2Dimensional(2, 5)); + case 3: return (Int2Dimensional) multiplyMatrix5x4x3(matrix1, matrix2, new Int2Dimensional(3, 5)); + case 4: return (Int2Dimensional) multiplyMatrix5x4x4(matrix1, matrix2, new Int2Dimensional(4, 5)); + case 5: return (Int2Dimensional) multiplyMatrix5x4x5(matrix1, matrix2, new Int2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix2x5x2(matrix1, matrix2, new Int2Dimensional(2, 2)); + case 3: return (Int2Dimensional) multiplyMatrix2x5x3(matrix1, matrix2, new Int2Dimensional(3, 2)); + case 4: return (Int2Dimensional) multiplyMatrix2x5x4(matrix1, matrix2, new Int2Dimensional(4, 2)); + case 5: return (Int2Dimensional) multiplyMatrix2x5x5(matrix1, matrix2, new Int2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix3x5x2(matrix1, matrix2, new Int2Dimensional(2, 3)); + case 3: return (Int2Dimensional) multiplyMatrix3x5x3(matrix1, matrix2, new Int2Dimensional(3, 3)); + case 4: return (Int2Dimensional) multiplyMatrix3x5x4(matrix1, matrix2, new Int2Dimensional(4, 3)); + case 5: return (Int2Dimensional) multiplyMatrix3x5x5(matrix1, matrix2, new Int2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix4x5x2(matrix1, matrix2, new Int2Dimensional(2, 4)); + case 3: return (Int2Dimensional) multiplyMatrix4x5x3(matrix1, matrix2, new Int2Dimensional(3, 4)); + case 4: return (Int2Dimensional) multiplyMatrix4x5x4(matrix1, matrix2, new Int2Dimensional(4, 4)); + case 5: return (Int2Dimensional) multiplyMatrix4x5x5(matrix1, matrix2, new Int2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Int2Dimensional) multiplyMatrix5x5x2(matrix1, matrix2, new Int2Dimensional(2, 5)); + case 3: return (Int2Dimensional) multiplyMatrix5x5x3(matrix1, matrix2, new Int2Dimensional(3, 5)); + case 4: return (Int2Dimensional) multiplyMatrix5x5x4(matrix1, matrix2, new Int2Dimensional(4, 5)); + case 5: return (Int2Dimensional) multiplyMatrix5x5x5(matrix1, matrix2, new Int2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + default: return null; + } + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * This method writes the result to specified [output] + * @return provided IMatrixSetterInt if mapping exists and computed, or null if mapping does not exist + */ + @org.jetbrains.annotations.Nullable + public static IMatrixSetterInt multiplyMatrix(final IMatrixGetterInt matrix1, final IMatrixGetterInt matrix2, final IMatrixSetterInt output) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x2x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x2x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x2x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x2x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x3x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x3x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x3x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x3x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x4x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x4x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x4x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x4x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x5x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x5x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x5x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x5x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + default: return null; + } + } +} diff --git a/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsLong.java b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsLong.java new file mode 100644 index 00000000..0e35364c --- /dev/null +++ b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsLong.java @@ -0,0 +1,3024 @@ +package ru.dbotthepony.kvector.matrix.generated; + +import ru.dbotthepony.kvector.api.*; +import ru.dbotthepony.kvector.narray.*; + +// Some metaprogramming +///////////////////////////////// +// THIS FILE IS AUTO GENERATED // +// DO NOT EDIT // +///////////////////////////////// + +public final class MultiplicationsLong { + private MultiplicationsLong() {} + + private static IMatrixSetterLong multiplyMatrix2x2x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x2x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x2x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x2x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x2x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x2x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x2x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x2x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x2x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x2x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x2x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x2x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x2x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x2x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x2x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x2x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x3x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x3x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x3x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x3x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x3x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x3x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x3x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x3x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x3x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x3x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x3x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x3x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x3x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x3x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x3x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x3x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x4x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x4x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x4x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x4x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x4x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x4x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x4x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x4x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x4x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x4x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x4x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x4x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x4x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x4x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x4x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x4x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x5x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x5x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x5x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + return output; + } + + private static IMatrixSetterLong multiplyMatrix2x5x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + final long s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x5x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x5x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x5x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + return output; + } + + private static IMatrixSetterLong multiplyMatrix3x5x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + final long s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x5x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x5x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x5x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + return output; + } + + private static IMatrixSetterLong multiplyMatrix4x5x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + final long s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x5x2(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long f_c44 = matrix1.get(4, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x5x3(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long f_c44 = matrix1.get(4, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x5x4(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long f_c44 = matrix1.get(4, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + return output; + } + + private static IMatrixSetterLong multiplyMatrix5x5x5(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final long f_c00 = matrix1.get(0, 0); + final long f_c10 = matrix1.get(1, 0); + final long f_c20 = matrix1.get(2, 0); + final long f_c30 = matrix1.get(3, 0); + final long f_c40 = matrix1.get(4, 0); + final long f_c01 = matrix1.get(0, 1); + final long f_c11 = matrix1.get(1, 1); + final long f_c21 = matrix1.get(2, 1); + final long f_c31 = matrix1.get(3, 1); + final long f_c41 = matrix1.get(4, 1); + final long f_c02 = matrix1.get(0, 2); + final long f_c12 = matrix1.get(1, 2); + final long f_c22 = matrix1.get(2, 2); + final long f_c32 = matrix1.get(3, 2); + final long f_c42 = matrix1.get(4, 2); + final long f_c03 = matrix1.get(0, 3); + final long f_c13 = matrix1.get(1, 3); + final long f_c23 = matrix1.get(2, 3); + final long f_c33 = matrix1.get(3, 3); + final long f_c43 = matrix1.get(4, 3); + final long f_c04 = matrix1.get(0, 4); + final long f_c14 = matrix1.get(1, 4); + final long f_c24 = matrix1.get(2, 4); + final long f_c34 = matrix1.get(3, 4); + final long f_c44 = matrix1.get(4, 4); + final long s_c00 = matrix2.get(0, 0); + final long s_c10 = matrix2.get(1, 0); + final long s_c20 = matrix2.get(2, 0); + final long s_c30 = matrix2.get(3, 0); + final long s_c40 = matrix2.get(4, 0); + final long s_c01 = matrix2.get(0, 1); + final long s_c11 = matrix2.get(1, 1); + final long s_c21 = matrix2.get(2, 1); + final long s_c31 = matrix2.get(3, 1); + final long s_c41 = matrix2.get(4, 1); + final long s_c02 = matrix2.get(0, 2); + final long s_c12 = matrix2.get(1, 2); + final long s_c22 = matrix2.get(2, 2); + final long s_c32 = matrix2.get(3, 2); + final long s_c42 = matrix2.get(4, 2); + final long s_c03 = matrix2.get(0, 3); + final long s_c13 = matrix2.get(1, 3); + final long s_c23 = matrix2.get(2, 3); + final long s_c33 = matrix2.get(3, 3); + final long s_c43 = matrix2.get(4, 3); + final long s_c04 = matrix2.get(0, 4); + final long s_c14 = matrix2.get(1, 4); + final long s_c24 = matrix2.get(2, 4); + final long s_c34 = matrix2.get(3, 4); + final long s_c44 = matrix2.get(4, 4); + output.set(0, 0, f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04); + output.set(0, 1, f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04); + output.set(0, 2, f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04); + output.set(0, 3, f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04); + output.set(0, 4, f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04); + output.set(1, 0, f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14); + output.set(1, 1, f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14); + output.set(1, 2, f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14); + output.set(1, 3, f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14); + output.set(1, 4, f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14); + output.set(2, 0, f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24); + output.set(2, 1, f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24); + output.set(2, 2, f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24); + output.set(2, 3, f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24); + output.set(2, 4, f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24); + output.set(3, 0, f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34); + output.set(3, 1, f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34); + output.set(3, 2, f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34); + output.set(3, 3, f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34); + output.set(3, 4, f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34); + output.set(4, 0, f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44); + output.set(4, 1, f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44); + output.set(4, 2, f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44); + output.set(4, 3, f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44); + output.set(4, 4, f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43 + f_c44*s_c44); + return output; + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * + * @return new Long2Dimensional + */ + @org.jetbrains.annotations.Nullable + public static Long2Dimensional multiplyMatrix(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix2x2x2(matrix1, matrix2, new Long2Dimensional(2, 2)); + case 3: return (Long2Dimensional) multiplyMatrix2x2x3(matrix1, matrix2, new Long2Dimensional(3, 2)); + case 4: return (Long2Dimensional) multiplyMatrix2x2x4(matrix1, matrix2, new Long2Dimensional(4, 2)); + case 5: return (Long2Dimensional) multiplyMatrix2x2x5(matrix1, matrix2, new Long2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix3x2x2(matrix1, matrix2, new Long2Dimensional(2, 3)); + case 3: return (Long2Dimensional) multiplyMatrix3x2x3(matrix1, matrix2, new Long2Dimensional(3, 3)); + case 4: return (Long2Dimensional) multiplyMatrix3x2x4(matrix1, matrix2, new Long2Dimensional(4, 3)); + case 5: return (Long2Dimensional) multiplyMatrix3x2x5(matrix1, matrix2, new Long2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix4x2x2(matrix1, matrix2, new Long2Dimensional(2, 4)); + case 3: return (Long2Dimensional) multiplyMatrix4x2x3(matrix1, matrix2, new Long2Dimensional(3, 4)); + case 4: return (Long2Dimensional) multiplyMatrix4x2x4(matrix1, matrix2, new Long2Dimensional(4, 4)); + case 5: return (Long2Dimensional) multiplyMatrix4x2x5(matrix1, matrix2, new Long2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix5x2x2(matrix1, matrix2, new Long2Dimensional(2, 5)); + case 3: return (Long2Dimensional) multiplyMatrix5x2x3(matrix1, matrix2, new Long2Dimensional(3, 5)); + case 4: return (Long2Dimensional) multiplyMatrix5x2x4(matrix1, matrix2, new Long2Dimensional(4, 5)); + case 5: return (Long2Dimensional) multiplyMatrix5x2x5(matrix1, matrix2, new Long2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix2x3x2(matrix1, matrix2, new Long2Dimensional(2, 2)); + case 3: return (Long2Dimensional) multiplyMatrix2x3x3(matrix1, matrix2, new Long2Dimensional(3, 2)); + case 4: return (Long2Dimensional) multiplyMatrix2x3x4(matrix1, matrix2, new Long2Dimensional(4, 2)); + case 5: return (Long2Dimensional) multiplyMatrix2x3x5(matrix1, matrix2, new Long2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix3x3x2(matrix1, matrix2, new Long2Dimensional(2, 3)); + case 3: return (Long2Dimensional) multiplyMatrix3x3x3(matrix1, matrix2, new Long2Dimensional(3, 3)); + case 4: return (Long2Dimensional) multiplyMatrix3x3x4(matrix1, matrix2, new Long2Dimensional(4, 3)); + case 5: return (Long2Dimensional) multiplyMatrix3x3x5(matrix1, matrix2, new Long2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix4x3x2(matrix1, matrix2, new Long2Dimensional(2, 4)); + case 3: return (Long2Dimensional) multiplyMatrix4x3x3(matrix1, matrix2, new Long2Dimensional(3, 4)); + case 4: return (Long2Dimensional) multiplyMatrix4x3x4(matrix1, matrix2, new Long2Dimensional(4, 4)); + case 5: return (Long2Dimensional) multiplyMatrix4x3x5(matrix1, matrix2, new Long2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix5x3x2(matrix1, matrix2, new Long2Dimensional(2, 5)); + case 3: return (Long2Dimensional) multiplyMatrix5x3x3(matrix1, matrix2, new Long2Dimensional(3, 5)); + case 4: return (Long2Dimensional) multiplyMatrix5x3x4(matrix1, matrix2, new Long2Dimensional(4, 5)); + case 5: return (Long2Dimensional) multiplyMatrix5x3x5(matrix1, matrix2, new Long2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix2x4x2(matrix1, matrix2, new Long2Dimensional(2, 2)); + case 3: return (Long2Dimensional) multiplyMatrix2x4x3(matrix1, matrix2, new Long2Dimensional(3, 2)); + case 4: return (Long2Dimensional) multiplyMatrix2x4x4(matrix1, matrix2, new Long2Dimensional(4, 2)); + case 5: return (Long2Dimensional) multiplyMatrix2x4x5(matrix1, matrix2, new Long2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix3x4x2(matrix1, matrix2, new Long2Dimensional(2, 3)); + case 3: return (Long2Dimensional) multiplyMatrix3x4x3(matrix1, matrix2, new Long2Dimensional(3, 3)); + case 4: return (Long2Dimensional) multiplyMatrix3x4x4(matrix1, matrix2, new Long2Dimensional(4, 3)); + case 5: return (Long2Dimensional) multiplyMatrix3x4x5(matrix1, matrix2, new Long2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix4x4x2(matrix1, matrix2, new Long2Dimensional(2, 4)); + case 3: return (Long2Dimensional) multiplyMatrix4x4x3(matrix1, matrix2, new Long2Dimensional(3, 4)); + case 4: return (Long2Dimensional) multiplyMatrix4x4x4(matrix1, matrix2, new Long2Dimensional(4, 4)); + case 5: return (Long2Dimensional) multiplyMatrix4x4x5(matrix1, matrix2, new Long2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix5x4x2(matrix1, matrix2, new Long2Dimensional(2, 5)); + case 3: return (Long2Dimensional) multiplyMatrix5x4x3(matrix1, matrix2, new Long2Dimensional(3, 5)); + case 4: return (Long2Dimensional) multiplyMatrix5x4x4(matrix1, matrix2, new Long2Dimensional(4, 5)); + case 5: return (Long2Dimensional) multiplyMatrix5x4x5(matrix1, matrix2, new Long2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix2x5x2(matrix1, matrix2, new Long2Dimensional(2, 2)); + case 3: return (Long2Dimensional) multiplyMatrix2x5x3(matrix1, matrix2, new Long2Dimensional(3, 2)); + case 4: return (Long2Dimensional) multiplyMatrix2x5x4(matrix1, matrix2, new Long2Dimensional(4, 2)); + case 5: return (Long2Dimensional) multiplyMatrix2x5x5(matrix1, matrix2, new Long2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix3x5x2(matrix1, matrix2, new Long2Dimensional(2, 3)); + case 3: return (Long2Dimensional) multiplyMatrix3x5x3(matrix1, matrix2, new Long2Dimensional(3, 3)); + case 4: return (Long2Dimensional) multiplyMatrix3x5x4(matrix1, matrix2, new Long2Dimensional(4, 3)); + case 5: return (Long2Dimensional) multiplyMatrix3x5x5(matrix1, matrix2, new Long2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix4x5x2(matrix1, matrix2, new Long2Dimensional(2, 4)); + case 3: return (Long2Dimensional) multiplyMatrix4x5x3(matrix1, matrix2, new Long2Dimensional(3, 4)); + case 4: return (Long2Dimensional) multiplyMatrix4x5x4(matrix1, matrix2, new Long2Dimensional(4, 4)); + case 5: return (Long2Dimensional) multiplyMatrix4x5x5(matrix1, matrix2, new Long2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Long2Dimensional) multiplyMatrix5x5x2(matrix1, matrix2, new Long2Dimensional(2, 5)); + case 3: return (Long2Dimensional) multiplyMatrix5x5x3(matrix1, matrix2, new Long2Dimensional(3, 5)); + case 4: return (Long2Dimensional) multiplyMatrix5x5x4(matrix1, matrix2, new Long2Dimensional(4, 5)); + case 5: return (Long2Dimensional) multiplyMatrix5x5x5(matrix1, matrix2, new Long2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + default: return null; + } + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * This method writes the result to specified [output] + * @return provided IMatrixSetterLong if mapping exists and computed, or null if mapping does not exist + */ + @org.jetbrains.annotations.Nullable + public static IMatrixSetterLong multiplyMatrix(final IMatrixGetterLong matrix1, final IMatrixGetterLong matrix2, final IMatrixSetterLong output) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x2x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x2x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x2x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x2x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x3x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x3x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x3x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x3x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x4x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x4x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x4x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x4x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x5x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x5x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x5x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x5x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + default: return null; + } + } +} diff --git a/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsShort.java b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsShort.java new file mode 100644 index 00000000..88bb10d7 --- /dev/null +++ b/src/kvector/java/ru/dbotthepony/kvector/matrix/generated/MultiplicationsShort.java @@ -0,0 +1,3024 @@ +package ru.dbotthepony.kvector.matrix.generated; + +import ru.dbotthepony.kvector.api.*; +import ru.dbotthepony.kvector.narray.*; + +// Some metaprogramming +///////////////////////////////// +// THIS FILE IS AUTO GENERATED // +// DO NOT EDIT // +///////////////////////////////// + +public final class MultiplicationsShort { + private MultiplicationsShort() {} + + private static IMatrixSetterShort multiplyMatrix2x2x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x2x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x2x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x2x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x2x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x2x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x2x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x2x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x2x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x2x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x2x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x2x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x2x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x2x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x2x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x2x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41)); + output.set(4, 4, (short) (f_c04*s_c40 + f_c14*s_c41)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x3x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x3x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x3x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x3x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x3x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x3x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x3x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x3x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x3x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x3x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x3x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x3x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x3x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x3x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x3x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x3x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42)); + output.set(4, 4, (short) (f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x4x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x4x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x4x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x4x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x4x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x4x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x4x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x4x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x4x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x4x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x4x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x4x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x4x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x4x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x4x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x4x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43)); + output.set(4, 4, (short) (f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x5x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x5x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x5x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix2x5x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 2 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + final short s_c44 = matrix2.get(4, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x5x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x5x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x5x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix3x5x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 3 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + final short s_c44 = matrix2.get(4, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x5x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x5x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x5x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix4x5x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 4 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + final short s_c44 = matrix2.get(4, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x5x2(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 2) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 2 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short f_c44 = matrix1.get(4, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x5x3(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 3) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 3 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short f_c44 = matrix1.get(4, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x5x4(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 4) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 4 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short f_c44 = matrix1.get(4, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34)); + return output; + } + + private static IMatrixSetterShort multiplyMatrix5x5x5(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (output.getRows() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getRows() + " rows, but 5 required"); + if (output.getColumns() != 5) throw new IllegalArgumentException("Provided output matrix has " + output.getColumns() + " columns, but 5 required"); + final short f_c00 = matrix1.get(0, 0); + final short f_c10 = matrix1.get(1, 0); + final short f_c20 = matrix1.get(2, 0); + final short f_c30 = matrix1.get(3, 0); + final short f_c40 = matrix1.get(4, 0); + final short f_c01 = matrix1.get(0, 1); + final short f_c11 = matrix1.get(1, 1); + final short f_c21 = matrix1.get(2, 1); + final short f_c31 = matrix1.get(3, 1); + final short f_c41 = matrix1.get(4, 1); + final short f_c02 = matrix1.get(0, 2); + final short f_c12 = matrix1.get(1, 2); + final short f_c22 = matrix1.get(2, 2); + final short f_c32 = matrix1.get(3, 2); + final short f_c42 = matrix1.get(4, 2); + final short f_c03 = matrix1.get(0, 3); + final short f_c13 = matrix1.get(1, 3); + final short f_c23 = matrix1.get(2, 3); + final short f_c33 = matrix1.get(3, 3); + final short f_c43 = matrix1.get(4, 3); + final short f_c04 = matrix1.get(0, 4); + final short f_c14 = matrix1.get(1, 4); + final short f_c24 = matrix1.get(2, 4); + final short f_c34 = matrix1.get(3, 4); + final short f_c44 = matrix1.get(4, 4); + final short s_c00 = matrix2.get(0, 0); + final short s_c10 = matrix2.get(1, 0); + final short s_c20 = matrix2.get(2, 0); + final short s_c30 = matrix2.get(3, 0); + final short s_c40 = matrix2.get(4, 0); + final short s_c01 = matrix2.get(0, 1); + final short s_c11 = matrix2.get(1, 1); + final short s_c21 = matrix2.get(2, 1); + final short s_c31 = matrix2.get(3, 1); + final short s_c41 = matrix2.get(4, 1); + final short s_c02 = matrix2.get(0, 2); + final short s_c12 = matrix2.get(1, 2); + final short s_c22 = matrix2.get(2, 2); + final short s_c32 = matrix2.get(3, 2); + final short s_c42 = matrix2.get(4, 2); + final short s_c03 = matrix2.get(0, 3); + final short s_c13 = matrix2.get(1, 3); + final short s_c23 = matrix2.get(2, 3); + final short s_c33 = matrix2.get(3, 3); + final short s_c43 = matrix2.get(4, 3); + final short s_c04 = matrix2.get(0, 4); + final short s_c14 = matrix2.get(1, 4); + final short s_c24 = matrix2.get(2, 4); + final short s_c34 = matrix2.get(3, 4); + final short s_c44 = matrix2.get(4, 4); + output.set(0, 0, (short) (f_c00*s_c00 + f_c10*s_c01 + f_c20*s_c02 + f_c30*s_c03 + f_c40*s_c04)); + output.set(0, 1, (short) (f_c01*s_c00 + f_c11*s_c01 + f_c21*s_c02 + f_c31*s_c03 + f_c41*s_c04)); + output.set(0, 2, (short) (f_c02*s_c00 + f_c12*s_c01 + f_c22*s_c02 + f_c32*s_c03 + f_c42*s_c04)); + output.set(0, 3, (short) (f_c03*s_c00 + f_c13*s_c01 + f_c23*s_c02 + f_c33*s_c03 + f_c43*s_c04)); + output.set(0, 4, (short) (f_c04*s_c00 + f_c14*s_c01 + f_c24*s_c02 + f_c34*s_c03 + f_c44*s_c04)); + output.set(1, 0, (short) (f_c00*s_c10 + f_c10*s_c11 + f_c20*s_c12 + f_c30*s_c13 + f_c40*s_c14)); + output.set(1, 1, (short) (f_c01*s_c10 + f_c11*s_c11 + f_c21*s_c12 + f_c31*s_c13 + f_c41*s_c14)); + output.set(1, 2, (short) (f_c02*s_c10 + f_c12*s_c11 + f_c22*s_c12 + f_c32*s_c13 + f_c42*s_c14)); + output.set(1, 3, (short) (f_c03*s_c10 + f_c13*s_c11 + f_c23*s_c12 + f_c33*s_c13 + f_c43*s_c14)); + output.set(1, 4, (short) (f_c04*s_c10 + f_c14*s_c11 + f_c24*s_c12 + f_c34*s_c13 + f_c44*s_c14)); + output.set(2, 0, (short) (f_c00*s_c20 + f_c10*s_c21 + f_c20*s_c22 + f_c30*s_c23 + f_c40*s_c24)); + output.set(2, 1, (short) (f_c01*s_c20 + f_c11*s_c21 + f_c21*s_c22 + f_c31*s_c23 + f_c41*s_c24)); + output.set(2, 2, (short) (f_c02*s_c20 + f_c12*s_c21 + f_c22*s_c22 + f_c32*s_c23 + f_c42*s_c24)); + output.set(2, 3, (short) (f_c03*s_c20 + f_c13*s_c21 + f_c23*s_c22 + f_c33*s_c23 + f_c43*s_c24)); + output.set(2, 4, (short) (f_c04*s_c20 + f_c14*s_c21 + f_c24*s_c22 + f_c34*s_c23 + f_c44*s_c24)); + output.set(3, 0, (short) (f_c00*s_c30 + f_c10*s_c31 + f_c20*s_c32 + f_c30*s_c33 + f_c40*s_c34)); + output.set(3, 1, (short) (f_c01*s_c30 + f_c11*s_c31 + f_c21*s_c32 + f_c31*s_c33 + f_c41*s_c34)); + output.set(3, 2, (short) (f_c02*s_c30 + f_c12*s_c31 + f_c22*s_c32 + f_c32*s_c33 + f_c42*s_c34)); + output.set(3, 3, (short) (f_c03*s_c30 + f_c13*s_c31 + f_c23*s_c32 + f_c33*s_c33 + f_c43*s_c34)); + output.set(3, 4, (short) (f_c04*s_c30 + f_c14*s_c31 + f_c24*s_c32 + f_c34*s_c33 + f_c44*s_c34)); + output.set(4, 0, (short) (f_c00*s_c40 + f_c10*s_c41 + f_c20*s_c42 + f_c30*s_c43 + f_c40*s_c44)); + output.set(4, 1, (short) (f_c01*s_c40 + f_c11*s_c41 + f_c21*s_c42 + f_c31*s_c43 + f_c41*s_c44)); + output.set(4, 2, (short) (f_c02*s_c40 + f_c12*s_c41 + f_c22*s_c42 + f_c32*s_c43 + f_c42*s_c44)); + output.set(4, 3, (short) (f_c03*s_c40 + f_c13*s_c41 + f_c23*s_c42 + f_c33*s_c43 + f_c43*s_c44)); + output.set(4, 4, (short) (f_c04*s_c40 + f_c14*s_c41 + f_c24*s_c42 + f_c34*s_c43 + f_c44*s_c44)); + return output; + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * + * @return new Short2Dimensional + */ + @org.jetbrains.annotations.Nullable + public static Short2Dimensional multiplyMatrix(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix2x2x2(matrix1, matrix2, new Short2Dimensional(2, 2)); + case 3: return (Short2Dimensional) multiplyMatrix2x2x3(matrix1, matrix2, new Short2Dimensional(3, 2)); + case 4: return (Short2Dimensional) multiplyMatrix2x2x4(matrix1, matrix2, new Short2Dimensional(4, 2)); + case 5: return (Short2Dimensional) multiplyMatrix2x2x5(matrix1, matrix2, new Short2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix3x2x2(matrix1, matrix2, new Short2Dimensional(2, 3)); + case 3: return (Short2Dimensional) multiplyMatrix3x2x3(matrix1, matrix2, new Short2Dimensional(3, 3)); + case 4: return (Short2Dimensional) multiplyMatrix3x2x4(matrix1, matrix2, new Short2Dimensional(4, 3)); + case 5: return (Short2Dimensional) multiplyMatrix3x2x5(matrix1, matrix2, new Short2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix4x2x2(matrix1, matrix2, new Short2Dimensional(2, 4)); + case 3: return (Short2Dimensional) multiplyMatrix4x2x3(matrix1, matrix2, new Short2Dimensional(3, 4)); + case 4: return (Short2Dimensional) multiplyMatrix4x2x4(matrix1, matrix2, new Short2Dimensional(4, 4)); + case 5: return (Short2Dimensional) multiplyMatrix4x2x5(matrix1, matrix2, new Short2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix5x2x2(matrix1, matrix2, new Short2Dimensional(2, 5)); + case 3: return (Short2Dimensional) multiplyMatrix5x2x3(matrix1, matrix2, new Short2Dimensional(3, 5)); + case 4: return (Short2Dimensional) multiplyMatrix5x2x4(matrix1, matrix2, new Short2Dimensional(4, 5)); + case 5: return (Short2Dimensional) multiplyMatrix5x2x5(matrix1, matrix2, new Short2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix2x3x2(matrix1, matrix2, new Short2Dimensional(2, 2)); + case 3: return (Short2Dimensional) multiplyMatrix2x3x3(matrix1, matrix2, new Short2Dimensional(3, 2)); + case 4: return (Short2Dimensional) multiplyMatrix2x3x4(matrix1, matrix2, new Short2Dimensional(4, 2)); + case 5: return (Short2Dimensional) multiplyMatrix2x3x5(matrix1, matrix2, new Short2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix3x3x2(matrix1, matrix2, new Short2Dimensional(2, 3)); + case 3: return (Short2Dimensional) multiplyMatrix3x3x3(matrix1, matrix2, new Short2Dimensional(3, 3)); + case 4: return (Short2Dimensional) multiplyMatrix3x3x4(matrix1, matrix2, new Short2Dimensional(4, 3)); + case 5: return (Short2Dimensional) multiplyMatrix3x3x5(matrix1, matrix2, new Short2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix4x3x2(matrix1, matrix2, new Short2Dimensional(2, 4)); + case 3: return (Short2Dimensional) multiplyMatrix4x3x3(matrix1, matrix2, new Short2Dimensional(3, 4)); + case 4: return (Short2Dimensional) multiplyMatrix4x3x4(matrix1, matrix2, new Short2Dimensional(4, 4)); + case 5: return (Short2Dimensional) multiplyMatrix4x3x5(matrix1, matrix2, new Short2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix5x3x2(matrix1, matrix2, new Short2Dimensional(2, 5)); + case 3: return (Short2Dimensional) multiplyMatrix5x3x3(matrix1, matrix2, new Short2Dimensional(3, 5)); + case 4: return (Short2Dimensional) multiplyMatrix5x3x4(matrix1, matrix2, new Short2Dimensional(4, 5)); + case 5: return (Short2Dimensional) multiplyMatrix5x3x5(matrix1, matrix2, new Short2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix2x4x2(matrix1, matrix2, new Short2Dimensional(2, 2)); + case 3: return (Short2Dimensional) multiplyMatrix2x4x3(matrix1, matrix2, new Short2Dimensional(3, 2)); + case 4: return (Short2Dimensional) multiplyMatrix2x4x4(matrix1, matrix2, new Short2Dimensional(4, 2)); + case 5: return (Short2Dimensional) multiplyMatrix2x4x5(matrix1, matrix2, new Short2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix3x4x2(matrix1, matrix2, new Short2Dimensional(2, 3)); + case 3: return (Short2Dimensional) multiplyMatrix3x4x3(matrix1, matrix2, new Short2Dimensional(3, 3)); + case 4: return (Short2Dimensional) multiplyMatrix3x4x4(matrix1, matrix2, new Short2Dimensional(4, 3)); + case 5: return (Short2Dimensional) multiplyMatrix3x4x5(matrix1, matrix2, new Short2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix4x4x2(matrix1, matrix2, new Short2Dimensional(2, 4)); + case 3: return (Short2Dimensional) multiplyMatrix4x4x3(matrix1, matrix2, new Short2Dimensional(3, 4)); + case 4: return (Short2Dimensional) multiplyMatrix4x4x4(matrix1, matrix2, new Short2Dimensional(4, 4)); + case 5: return (Short2Dimensional) multiplyMatrix4x4x5(matrix1, matrix2, new Short2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix5x4x2(matrix1, matrix2, new Short2Dimensional(2, 5)); + case 3: return (Short2Dimensional) multiplyMatrix5x4x3(matrix1, matrix2, new Short2Dimensional(3, 5)); + case 4: return (Short2Dimensional) multiplyMatrix5x4x4(matrix1, matrix2, new Short2Dimensional(4, 5)); + case 5: return (Short2Dimensional) multiplyMatrix5x4x5(matrix1, matrix2, new Short2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix2x5x2(matrix1, matrix2, new Short2Dimensional(2, 2)); + case 3: return (Short2Dimensional) multiplyMatrix2x5x3(matrix1, matrix2, new Short2Dimensional(3, 2)); + case 4: return (Short2Dimensional) multiplyMatrix2x5x4(matrix1, matrix2, new Short2Dimensional(4, 2)); + case 5: return (Short2Dimensional) multiplyMatrix2x5x5(matrix1, matrix2, new Short2Dimensional(5, 2)); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix3x5x2(matrix1, matrix2, new Short2Dimensional(2, 3)); + case 3: return (Short2Dimensional) multiplyMatrix3x5x3(matrix1, matrix2, new Short2Dimensional(3, 3)); + case 4: return (Short2Dimensional) multiplyMatrix3x5x4(matrix1, matrix2, new Short2Dimensional(4, 3)); + case 5: return (Short2Dimensional) multiplyMatrix3x5x5(matrix1, matrix2, new Short2Dimensional(5, 3)); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix4x5x2(matrix1, matrix2, new Short2Dimensional(2, 4)); + case 3: return (Short2Dimensional) multiplyMatrix4x5x3(matrix1, matrix2, new Short2Dimensional(3, 4)); + case 4: return (Short2Dimensional) multiplyMatrix4x5x4(matrix1, matrix2, new Short2Dimensional(4, 4)); + case 5: return (Short2Dimensional) multiplyMatrix4x5x5(matrix1, matrix2, new Short2Dimensional(5, 4)); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return (Short2Dimensional) multiplyMatrix5x5x2(matrix1, matrix2, new Short2Dimensional(2, 5)); + case 3: return (Short2Dimensional) multiplyMatrix5x5x3(matrix1, matrix2, new Short2Dimensional(3, 5)); + case 4: return (Short2Dimensional) multiplyMatrix5x5x4(matrix1, matrix2, new Short2Dimensional(4, 5)); + case 5: return (Short2Dimensional) multiplyMatrix5x5x5(matrix1, matrix2, new Short2Dimensional(5, 5)); + default: return null; + } + default: return null; + } + default: return null; + } + } + + /** + * Automatically generated concrete matrix multiplication. If no mapping exist, this method returns null. + * This method writes the result to specified [output] + * @return provided IMatrixSetterShort if mapping exists and computed, or null if mapping does not exist + */ + @org.jetbrains.annotations.Nullable + public static IMatrixSetterShort multiplyMatrix(final IMatrixGetterShort matrix1, final IMatrixGetterShort matrix2, final IMatrixSetterShort output) { + if (matrix1.getColumns() != matrix2.getRows()) return null; + switch (matrix1.getColumns()) { + case 2: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x2x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x2x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x2x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x2x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x2x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x2x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x2x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 3: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x3x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x3x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x3x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x3x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x3x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x3x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x3x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 4: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x4x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x4x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x4x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x4x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x4x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x4x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x4x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + case 5: switch (matrix1.getRows()) { + case 2: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix2x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix2x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix2x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix2x5x5(matrix1, matrix2, output); + default: return null; + } + case 3: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix3x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix3x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix3x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix3x5x5(matrix1, matrix2, output); + default: return null; + } + case 4: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix4x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix4x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix4x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix4x5x5(matrix1, matrix2, output); + default: return null; + } + case 5: switch (matrix2.getColumns()) { + case 2: return multiplyMatrix5x5x2(matrix1, matrix2, output); + case 3: return multiplyMatrix5x5x3(matrix1, matrix2, output); + case 4: return multiplyMatrix5x5x4(matrix1, matrix2, output); + case 5: return multiplyMatrix5x5x5(matrix1, matrix2, output); + default: return null; + } + default: return null; + } + default: return null; + } + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/DoubleMatrix.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/DoubleMatrix.kt new file mode 100644 index 00000000..764071f1 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/DoubleMatrix.kt @@ -0,0 +1,111 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.api + +interface IMatrixGetterDouble : IMatrixLike { + /** + * @return component of this matrix, as double + */ + operator fun get(column: Int, row: Int): Double +} + +interface IMatrixSetterDouble : IMatrixLike { + /** + * Sets component of this matrix, as double + */ + operator fun set(column: Int, row: Int, value: Double) +} + +interface IDoubleMatrix> : IMatrixGetterDouble { + /** + * Multiplies all matrix components by [other], returning new matrix as result + * + * @return new matrix + */ + operator fun times(other: Double): T + + /** + * Divides all matrix components by [other], returning new matrix as result + * + * @return new matrix + */ + operator fun div(other: Double): T + + /** + * Multiplies this and [other] matrices by general matrix multiplication rules, + * if they are compatible in dimensions, and return new matrix. + * + * @throws IllegalArgumentException if matrices are not applicable for multiplication + * @return new matrix + */ + operator fun times(other: IMatrixGetterDouble): T + + /** + * Adds components of both matrices, returning new matrix as result + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return new matrix + */ + operator fun plus(other: IMatrixGetterDouble): T + + /** + * Subtracts components of both matrices, returning new matrix as result + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return new matrix + */ + operator fun minus(other: IMatrixGetterDouble): T + + /** + * This matrix trace. If matrix is not square matrix, null is returned. + */ + val trace: Double? + + /** + * This matrix determinant. If matrix is not square matrix, null is returned. + */ + val determinant: Double? +} + +interface IMutableDoubleMatrix> : IMatrixSetterDouble { + /** + * Multiplies all matrix components by [other], writing result into this matrix + * + * @return this matrix + */ + fun timesMut(other: Double): T + + /** + * Divides all matrix components by [other], writing result into this matrix + * + * @return this matrix + */ + fun divMut(other: Double): T + + /** + * Multiplies this and [other] matrices by general matrix multiplication rules, + * if they are compatible in dimensions, and write result into this matrix. + * + * @throws IllegalArgumentException if [other] is not a square matrix + * @throws IllegalStateException if this matrix is not a square matrix + * @return this matrix + */ + fun timesMut(other: IMatrixGetterDouble): T + + /** + * Adds components of both matrices, writing result into this matrix + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return this matrix + */ + fun plusMut(other: IMatrixGetterDouble): T + + /** + * Subtracts components of both matrices, writing result into this matrix + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return this matrix + */ + fun minusMut(other: IMatrixGetterDouble): T +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/FloatMatrix.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/FloatMatrix.kt new file mode 100644 index 00000000..383b7838 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/FloatMatrix.kt @@ -0,0 +1,111 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.api + +interface IMatrixGetterFloat : IMatrixLike { + /** + * @return component of this matrix, as float + */ + operator fun get(column: Int, row: Int): Float +} + +interface IMatrixSetterFloat : IMatrixLike { + /** + * Sets component of this matrix, as float + */ + operator fun set(column: Int, row: Int, value: Float) +} + +interface IFloatMatrix> : IMatrixGetterFloat { + /** + * Multiplies all matrix components by [other], returning new matrix as result + * + * @return new matrix + */ + operator fun times(other: Float): T + + /** + * Divides all matrix components by [other], returning new matrix as result + * + * @return new matrix + */ + operator fun div(other: Float): T + + /** + * Multiplies this and [other] matrices by general matrix multiplication rules, + * if they are compatible in dimensions, and return new matrix. + * + * @throws IllegalArgumentException if matrices are not applicable for multiplication + * @return new matrix + */ + operator fun times(other: IMatrixGetterFloat): T + + /** + * Adds components of both matrices, returning new matrix as result + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return new matrix + */ + operator fun plus(other: IMatrixGetterFloat): T + + /** + * Subtracts components of both matrices, returning new matrix as result + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return new matrix + */ + operator fun minus(other: IMatrixGetterFloat): T + + /** + * This matrix trace. If matrix is not square matrix, null is returned. + */ + val trace: Float? + + /** + * This matrix determinant. If matrix is not square matrix, null is returned. + */ + val determinant: Float? +} + +interface IMutableFloatMatrix> : IMatrixSetterFloat { + /** + * Multiplies all matrix components by [other], writing result into this matrix + * + * @return this matrix + */ + fun timesMut(other: Float): T + + /** + * Divides all matrix components by [other], writing result into this matrix + * + * @return this matrix + */ + fun divMut(other: Float): T + + /** + * Multiplies this and [other] matrices by general matrix multiplication rules, + * if they are compatible in dimensions, and write result into this matrix. + * + * @throws IllegalArgumentException if [other] is not a square matrix + * @throws IllegalStateException if this matrix is not a square matrix + * @return this matrix + */ + fun timesMut(other: IMatrixGetterFloat): T + + /** + * Adds components of both matrices, writing result into this matrix + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return this matrix + */ + fun plusMut(other: IMatrixGetterFloat): T + + /** + * Subtracts components of both matrices, writing result into this matrix + * + * @throws IllegalArgumentException if matrices are different in dimensions + * @return this matrix + */ + fun minusMut(other: IMatrixGetterFloat): T +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/Matrix.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/Matrix.kt new file mode 100644 index 00000000..50919551 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/Matrix.kt @@ -0,0 +1,437 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.api + +/** + * Classes implementing this interface can be manipulated like matrices + */ +interface IMatrixLike { + /** + * Rows this matrix has + */ + val rows: Int + + /** + * Columns this matrix has + */ + val columns: Int + + /** + * Whenever is this matrix a square matrix + */ + val isSquareMatrix: Boolean get() = rows == columns + + /** + * @return Whenever [other] has the same dimensions as this matrix + */ + fun sizeEquals(other: IMatrixLike): Boolean { + return rows == other.rows && columns == other.columns + } + + /** + * @throws IllegalArgumentException if [other] is not the same dimensions as this matrix + */ + fun requireSizeEquals(other: IMatrixLike) { + if (!sizeEquals(other)) { + throw IllegalArgumentException("Other matrix (${other.columns}x${other.rows}) is not the same dimensions as this matrix (${columns}x${rows})") + } + } + + /** + * @throws IllegalArgumentException if [other] is not the same dimensions as this matrix + */ + fun requireSizeEquals(other: IMatrixLike, lazy: () -> Any) { + if (!sizeEquals(other)) { + throw IllegalArgumentException(lazy.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if [other] is not the same dimensions as this matrix + */ + fun checkSizeEquals(other: IMatrixLike) { + if (!sizeEquals(other)) { + throw IllegalStateException("Other matrix (${other.columns}x${other.rows}) is not the same dimensions as this matrix (${columns}x${rows})") + } + } + + /** + * @throws IllegalStateException if [other] is not the same dimensions as this matrix + */ + fun checkSizeEquals(other: IMatrixLike, lazy: () -> Any) { + if (!sizeEquals(other)) { + throw IllegalStateException(lazy.invoke().toString()) + } + } + + /** + * @return Whenever [other] has the same amount of rows as this matrix + */ + fun rowsEquals(other: IMatrixLike): Boolean { + return rows == other.rows + } + + /** + * @throws IllegalArgumentException if [other] is not the same amount of rows as this matrix + */ + fun requireRowsEquals(other: IMatrixLike) { + if (!rowsEquals(other)) { + throw IllegalArgumentException("Other matrix (${other.rows}) has different amount of rows compared to this matrix (${rows})") + } + } + + /** + * @throws IllegalArgumentException if [other] is not the same amount of rows as this matrix + */ + fun requireRowsEquals(other: IMatrixLike, lazy: () -> Any) { + if (!rowsEquals(other)) { + throw IllegalArgumentException(lazy.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if [other] is not the same amount of rows as this matrix + */ + fun checkRowsEquals(other: IMatrixLike) { + if (!rowsEquals(other)) { + throw IllegalStateException("Other matrix (${other.rows}) has different amount of rows compared to this matrix (${rows})") + } + } + + /** + * @throws IllegalStateException if [other] is not the same amount of rows as this matrix + */ + fun checkRowsEquals(other: IMatrixLike, lazy: () -> Any) { + if (!rowsEquals(other)) { + throw IllegalStateException(lazy.invoke().toString()) + } + } + + /** + * @return Whenever [other] has the same amount of columns as this matrix + */ + fun columnsEquals(other: IMatrixLike): Boolean { + return columns == other.columns + } + + /** + * @throws IllegalArgumentException if [other] is not the same amount of columns as this matrix + */ + fun requireColumnsEquals(other: IMatrixLike) { + if (!rowsEquals(other)) { + throw IllegalArgumentException("Other matrix (${other.columns}) has different amount of columns compared to this matrix (${columns})") + } + } + + /** + * @throws IllegalArgumentException if [other] is not the same amount of columns as this matrix + */ + fun requireColumnsEquals(other: IMatrixLike, lazy: () -> Any) { + if (!rowsEquals(other)) { + throw IllegalArgumentException(lazy.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if [other] is not the same amount of columns as this matrix + */ + fun checkColumnsEquals(other: IMatrixLike) { + if (!rowsEquals(other)) { + throw IllegalStateException("Other matrix (${other.columns}) has different amount of columns compared to this matrix (${columns})") + } + } + + /** + * @throws IllegalStateException if [other] is not the same amount of columns as this matrix + */ + fun checkColumnsEquals(other: IMatrixLike, lazy: () -> Any) { + if (!rowsEquals(other)) { + throw IllegalStateException(lazy.invoke().toString()) + } + } +} + +interface IMatrixGetterInt : IMatrixLike { + /** + * @return component of this matrix, as int + */ + operator fun get(column: Int, row: Int): Int +} + +interface IMatrixGetterLong : IMatrixLike { + /** + * @return component of this matrix, as long + */ + operator fun get(column: Int, row: Int): Long +} + +interface IMatrixGetterShort : IMatrixLike { + /** + * @return component of this matrix, as short + */ + operator fun get(column: Int, row: Int): Short +} + +interface IMatrixGetterByte : IMatrixLike { + /** + * @return component of this matrix, as byte + */ + operator fun get(column: Int, row: Int): Byte +} + +interface IMatrixSetterInt : IMatrixLike { + /** + * Sets component of this matrix, as int + */ + operator fun set(column: Int, row: Int, value: Int) +} + +interface IMatrixSetterLong : IMatrixLike { + /** + * Sets component of this matrix, as long + */ + operator fun set(column: Int, row: Int, value: Long) +} + +interface IMatrixSetterShort : IMatrixLike { + /** + * Sets component of this matrix, as short + */ + operator fun set(column: Int, row: Int, value: Short) +} + +interface IMatrixSetterByte : IMatrixLike { + /** + * Sets component of this matrix, as byte + */ + operator fun set(column: Int, row: Int, value: Byte) +} + +/** + * Root inheritance tree of Matrix classes + */ +interface IMatrix> : IMatrixLike { + /** + * Whenever all components of this matrix are finite + */ + val isFinite: Boolean + + /** + * Whenever any of components of this matrix are NaN + */ + val isNaN: Boolean + + /** + * Whenever is this matrix valid (components are not NaN and are finite) + */ + val isValid: Boolean get() = isFinite && !isNaN + + /** + * @throws IllegalArgumentException if matrix is not finite + */ + fun requireIsFinite(lambda: () -> Any) { + if (!isFinite) { + throw IllegalArgumentException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalArgumentException if matrix is not finite + */ + fun requireIsFinite() { + if (!isFinite) { + throw IllegalArgumentException("Matrix is not finite") + } + } + + /** + * @throws IllegalStateException if matrix is not finite + */ + fun checkIsFinite(lambda: () -> Any) { + if (!isFinite) { + throw IllegalStateException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if matrix is not finite + */ + fun checkIsFinite() { + if (!isFinite) { + throw IllegalStateException("Matrix is not finite") + } + } + + /** + * @throws IllegalArgumentException if vector has NaN component + */ + fun requireNotNaN(lambda: () -> Any) { + if (isNaN) { + throw IllegalArgumentException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalArgumentException if matrix has NaN component + */ + fun requireNotNaN() { + if (isNaN) { + throw IllegalArgumentException("Matrix has NaN component") + } + } + + /** + * @throws IllegalStateException if matrix has NaN component + */ + fun checkNotNaN(lambda: () -> Any) { + if (!isFinite) { + throw IllegalStateException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if matrix has NaN component + */ + fun checkNotNaN() { + if (!isFinite) { + throw IllegalStateException("Matrix has NaN component") + } + } + + /** + * @throws IllegalArgumentException if matrix has NaN or infinite component + */ + fun requireIsValid() { + requireIsFinite() + requireNotNaN() + } + + /** + * @throws IllegalStateException if matrix has NaN or infinite component + */ + fun checkIsValid() { + requireIsFinite() + requireNotNaN() + } + + /** + * @throws IllegalArgumentException if matrix has NaN or infinite component + */ + fun requireIsValid(lambda: () -> Any) { + requireIsFinite(lambda) + requireNotNaN(lambda) + } + + /** + * @throws IllegalStateException if matrix has NaN or infinite component + */ + fun checkIsValid(lambda: () -> Any) { + requireIsFinite(lambda) + requireNotNaN(lambda) + } +} + + +/** + * Marks matrix for being transposable with result of T + */ +interface ITransposable { + /** + * New matrix, which is transposed variant of this matrix + * + * @return new matrix + */ + val transposed: T +} + +/** + * Marks matrix for being transposable in place + */ +interface IMutableTransposable { + /** + * Attempts to transpose this matrix, writing the transpose result into itself + * + * @throws IllegalStateException if this matrix is not a square matrix + * @return this matrix + */ + fun transpose(): T +} + +/** + * Getter for matrix complement + */ +interface IMatrixComplement { + /** + * Constructs a new matrix, representing complement of this matrix at [column] and [row] + * + * @throws IllegalStateException if this matrix is not applicable for complement operation + * @return new matrix, representing minor, with size - 1 of this matrix + */ + fun complement(column: Int, row: Int): T +} + +/** + * Defines common operations with concrete square matrices, such as [translation], [scale]ing, etc + */ +interface ISquareMatrix, V> { + /** + * Current translation of this matrix. + */ + val translation: V + + /** + * Does raw translation of this matrix by specified [vector], + * returning new matrix as result. + * + * If you scaled and/or rotated this matrix, and want to move it + * with scale and translation, use [translateWithMultiplication]. + * + * @return new matrix + */ + fun translate(vector: V): T + + /** + * Does translation of this matrix by specified [vector], + * with accounting of it's state, returning new matrix as result. + * + * @return new matrix + */ + fun translateWithMultiplication(vector: V): T + + /** + * Multiplies main diagonal of this matrix with [vector], + * returning new matrix as result. + * + * @return new matrix + */ + fun scale(vector: V): T +} + +/** + * Defines common mutable operations with concrete square matrices, such as [translation], [scale]ing, etc + */ +interface IMutableSquareMatrix, V> : ISquareMatrix { + /** + * Current translation of this matrix. + * + * Writing vector to this property will set raw matrix translation. + */ + override var translation: V + + /** + * Does translation of this matrix by specified [vector], + * with accounting of it's state, writing result into this matrix. + * + * @return this matrix + */ + fun translateWithMultiplicationMut(vector: V): T + + /** + * Multiplies main diagonal of this matrix with [vector], + * writing result into this matrix. + * + * @return this matrix + */ + fun scaleMut(vector: V): T +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/Struct.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/Struct.kt new file mode 100644 index 00000000..562e7df7 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/Struct.kt @@ -0,0 +1,82 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.api + +interface IStruct2f { + operator fun component1(): Float + operator fun component2(): Float +} + +interface IStruct3f : IStruct2f { + operator fun component3(): Float +} + +interface IStruct4f : IStruct3f { + operator fun component4(): Float +} + +interface IStruct2d { + operator fun component1(): Double + operator fun component2(): Double +} + +interface IStruct3d : IStruct2d { + operator fun component3(): Double +} + +interface IStruct4d : IStruct3d { + operator fun component4(): Double +} + +interface IStruct2i { + operator fun component1(): Int + operator fun component2(): Int +} + +interface IStruct3i : IStruct2i { + operator fun component3(): Int +} + +interface IStruct4i : IStruct3i { + operator fun component4(): Int +} + +interface IStruct2l { + operator fun component1(): Long + operator fun component2(): Long +} + +interface IStruct3l : IStruct2l { + operator fun component3(): Long +} + +interface IStruct4l : IStruct3l { + operator fun component4(): Long +} + +interface IStruct2s { + operator fun component1(): Short + operator fun component2(): Short +} + +interface IStruct3s : IStruct2s { + operator fun component3(): Short +} + +interface IStruct4s : IStruct3s { + operator fun component4(): Short +} + +interface IStruct2b { + operator fun component1(): Byte + operator fun component2(): Byte +} + +interface IStruct3b : IStruct2b { + operator fun component3(): Byte +} + +interface IStruct4b : IStruct3b { + operator fun component4(): Byte +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/Vector.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/Vector.kt new file mode 100644 index 00000000..de3f76cb --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/Vector.kt @@ -0,0 +1,433 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.api + +import kotlin.math.sqrt + +/** + * Root interface of vector inheritance tree, providing all relevant methods + * of operation on vectors of fixed length + */ +interface IVector> { + /** + * Length of this vector, as Double + */ + val length: Double get() = sqrt(lengthSquared) + + /** + * Squared length of this vector, as Double + */ + val lengthSquared: Double + + /** + * Whenever all components of vector are finite + * + * Keep in mind that in some situations infinite vectors are still making sense + * (e.g. creating [AABB] that cover entire game, or alike, world) + */ + val isFinite: Boolean + + /** + * Whenever at least one of components of vector are NaN + */ + val isNaN: Boolean + + /** + * Whenever is this vector valid (components are not NaN and are finite) + * + * Keep in mind that in some situations infinite vectors are still making sense + * (e.g. creating [AABB] that cover entire game, or alike, world) + */ + val isValid: Boolean get() = isFinite && !isNaN + + /** + * Adds components of both vectors, returning new vector as result + * + * @return new vector + */ + operator fun plus(other: T): T + + /** + * Subtracts components of both vectors, returning new vector as result + * + * @return new vector + */ + operator fun minus(other: T): T + + /** + * Multiplies components of both vectors, returning new vector as result + * + * @return new vector + */ + operator fun times(other: T): T + + /** + * Divides components of both vectors, returning new vector as result + * + * @throws ArithmeticException if vector work with whole numbers, and + * one of [other] components end up zero + * + * @return new vector + */ + operator fun div(other: T): T + + /** + * New vector, with every component being absolute + */ + val absoluteValue: T + + /** + * Takes all components of both vectors, and choose the smallest of each, + * and construct a new vector from them + * + * @return new vector + */ + fun coerceAtMost(maximal: T): T + + /** + * Takes all components of both vectors, and choose the biggest of each, + * and construct a new vector from them + * + * @return new vector + */ + fun coerceAtLeast(minimal: T): T + + /** + * Takes all components of this vector, and clamp them in between [minimal] and [maximal] corresponding + * components and construct a new vector from them + * + * @return new vector + */ + fun clamp(minimal: T, maximal: T): T + + /** + * Constructs a new vector with all components negated + * + * @return new vector + */ + operator fun unaryMinus(): T + + /** + * Returns square rooted distance bewteen this and [other] + * + * @return distance between vectors (as points) as [Double] + */ + fun distance(other: T): Double { + return sqrt(distanceSquared(other)) + } + + /** + * Returns squared distance between this and [other] + * + * @return distance between vectors (as points) as [Double] + */ + fun distanceSquared(other: T): Double +} + +/** + * Define all relatable methods on vectors which components are fractional + */ +interface IFractionalVector> { + /** + * New (directional) vector, with length of 1 + * + * If vector length is zero, a zero vector is returned + */ + val normalized: T +} + +/** + * Define all relatable mutating methods on vectors which components are fractional + */ +interface IMutableFractionalVector> { + /** + * Normalizes this vector (by setting all of its components) to have 1 unit length + * (turning it into directional or unit vector), + * returning old length as [Double] + * + * @return old length as [Double] + */ + fun normalize(): Double +} + +/** + * Define all relatable methods on vectors which components are whole numbers + */ +interface IWholeVector> { + /** + * Returns squared distance between this and [other], but as whole number + * + * @return distance between vectors (as points) as [Long] + */ + fun wholeDistanceSquared(other: T): Long +} + +/** + * Define all relatable mutating methods on vectors which components are whole numbers + */ +interface IMutableWholeVector> { + +} + +/** + * Define mutable vector x vector operations + */ +interface IMutableVector, V> { + /** + * Adds components of both vectors, setting result to this vector + * + * @return this vector + */ + fun plusMut(other: V): T + + /** + * Subtracts components of both vectors, setting result to this vector + * + * @return this vector + */ + fun minusMut(other: V): T + + /** + * Multiplies components of both vectors, setting result to this vector + * + * @return this vector + */ + fun timesMut(other: V): T + + /** + * Divides components of both vectors, setting result to this vector + * + * @throws ArithmeticException if vector work with whole numbers, and + * one of [other] components end up zero + * + * @return this vector + */ + fun divMut(other: V): T +} + +/** + * Define mutable scalar x vector operations using [Double]s + */ +interface IMutableDoubleVector> { + /** + * Multiplies components of vector by [other], setting result to this vector + * + * @return this vector + */ + fun timesMut(other: Double): T + + /** + * Divides components of vector by [other], setting result to this vector + * + * @return this vector + */ + fun divMut(other: Double): T +} + +/** + * Define scalar x vector operations using [Double]s + */ +interface IDoubleVector> { + /** + * Multiplies [other] by all components, returning new vector as result + * + * @return new vector + */ + operator fun times(other: Double): T + + /** + * Divides components by [other], returning new vector as result + * + * @return new vector + */ + operator fun div(other: Double): T +} + +/** + * Define mutable scalar x vector operations using [Float]s + */ +interface IMutableFloatVector> { + /** + * Multiplies components of vector by [other], setting result to this vector + * + * @return this vector + */ + fun timesMut(other: Float): T + + /** + * Divides components of vector by [other], setting result to this vector + * + * @return this vector + */ + fun divMut(other: Float): T +} + +/** + * Define scalar x vector operations using [Float]s + */ +interface IFloatVector> { + /** + * Multiplies [other] by all components, returning new vector as result + * + * @return new vector + */ + operator fun times(other: Float): T + + /** + * Divides components by [other], returning new vector as result + * + * @return new vector + */ + operator fun div(other: Float): T +} + +/** + * Define mutable scalar x vector operations using [Int]s + */ +interface IMutableIntVector> { + /** + * Multiplies components of vector by [other], setting result to this vector + * + * @return this vector + */ + fun timesMut(other: Int): T + + /** + * Divides components of vector by [other], setting result to this vector + * + * @return this vector + */ + fun divMut(other: Int): T +} + +/** + * Define scalar x vector operations using [Int]s + */ +interface IIntVector> { + /** + * Multiplies [other] by all components, returning new vector as result + * + * @return new vector + */ + operator fun times(other: Int): T + + /** + * Divides components by [other], returning new vector as result + * + * @return new vector + */ + operator fun div(other: Int): T +} + +/** + * Root class of vector inheritance tree, providing some concrete methods + * for vectors of fixed length + */ +abstract class AbstractVector> : IMatrixLike, IVector { + final override val columns: Int = 1 + + /** + * @throws IllegalArgumentException if vector is not finite + */ + inline fun requireIsFinite(lambda: () -> Any) { + if (!isFinite) { + throw IllegalArgumentException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalArgumentException if vector is not finite + */ + inline fun requireIsFinite() { + if (!isFinite) { + throw IllegalArgumentException("Vector is not finite") + } + } + + /** + * @throws IllegalStateException if vector is not finite + */ + inline fun checkIsFinite(lambda: () -> Any) { + if (!isFinite) { + throw IllegalStateException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if vector is not finite + */ + inline fun checkIsFinite() { + if (!isFinite) { + throw IllegalStateException("Vector is not finite") + } + } + + /** + * @throws IllegalArgumentException if vector has NaN component + */ + inline fun requireNotNaN(lambda: () -> Any) { + if (isNaN) { + throw IllegalArgumentException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalArgumentException if vector has NaN component + */ + inline fun requireNotNaN() { + if (isNaN) { + throw IllegalArgumentException("Vector has NaN component") + } + } + + /** + * @throws IllegalStateException if vector has NaN component + */ + inline fun checkNotNaN(lambda: () -> Any) { + if (!isFinite) { + throw IllegalStateException(lambda.invoke().toString()) + } + } + + /** + * @throws IllegalStateException if vector has NaN component + */ + inline fun checkNotNaN() { + if (!isFinite) { + throw IllegalStateException("Vector has NaN component") + } + } + + /** + * @throws IllegalArgumentException if vector has NaN or infinite component + */ + inline fun requireIsValid() { + requireIsFinite() + requireNotNaN() + } + + /** + * @throws IllegalStateException if vector has NaN or infinite component + */ + inline fun checkIsValid() { + requireIsFinite() + requireNotNaN() + } + + /** + * @throws IllegalArgumentException if vector has NaN or infinite component + */ + inline fun requireIsValid(lambda: () -> Any) { + requireIsFinite(lambda) + requireNotNaN(lambda) + } + + /** + * @throws IllegalStateException if vector has NaN or infinite component + */ + inline fun checkIsValid(lambda: () -> Any) { + requireIsFinite(lambda) + requireNotNaN(lambda) + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/DoubleMatrix.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/DoubleMatrix.kt new file mode 100644 index 00000000..2b466a8a --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/DoubleMatrix.kt @@ -0,0 +1,166 @@ +package ru.dbotthepony.kvector.api.concrete + +import ru.dbotthepony.kvector.api.IDoubleMatrix +import ru.dbotthepony.kvector.api.IMatrix +import ru.dbotthepony.kvector.api.ISquareMatrix +import ru.dbotthepony.kvector.api.ITransposable +import ru.dbotthepony.kvector.matrix.* +import ru.dbotthepony.kvector.vector.ndouble.Vector2d +import ru.dbotthepony.kvector.vector.ndouble.Vector3d +import ru.dbotthepony.kvector.vector.ndouble.Vector4d + +/** + * [Matrix2d] and [MutableMatrix2d] implement this + */ +interface IMatrix2d> : IMatrix, IDoubleMatrix, ITransposable { + val c00: Double + val c10: Double + val c01: Double + val c11: Double + val r00: Double + val r01: Double + val r10: Double + val r11: Double + val a11: Double + val a21: Double + val a12: Double + val a22: Double + val b11: Double + val b21: Double + val b12: Double + val b22: Double + val c0: Vector2d + val c1: Vector2d + val r0: Vector2d + val r1: Vector2d +} + +/** + * [Matrix3d] and [MutableMatrix3d] implement this + */ +interface IMatrix3d> : IMatrix, IDoubleMatrix, ITransposable, ISquareMatrix { + val c00: Double + val c10: Double + val c20: Double + val c01: Double + val c11: Double + val c21: Double + val c02: Double + val c12: Double + val c22: Double + val r00: Double + val r01: Double + val r02: Double + val r10: Double + val r11: Double + val r12: Double + val r20: Double + val r21: Double + val r22: Double + val a11: Double + val a21: Double + val a31: Double + val a12: Double + val a22: Double + val a32: Double + val a13: Double + val a23: Double + val a33: Double + val b11: Double + val b21: Double + val b31: Double + val b12: Double + val b22: Double + val b32: Double + val b13: Double + val b23: Double + val b33: Double + val c0: Vector3d + val c1: Vector3d + val c2: Vector3d + val r0: Vector3d + val r1: Vector3d + val r2: Vector3d + + override val translation: Vector2d get() = Vector2d(r02, r12) +} + +/** + * [Matrix4d] and [MutableMatrix4d] implement this + */ +interface IMatrix4d> : IMatrix, IDoubleMatrix, ITransposable, ISquareMatrix { + val c00: Double + val c10: Double + val c20: Double + val c30: Double + val c01: Double + val c11: Double + val c21: Double + val c31: Double + val c02: Double + val c12: Double + val c22: Double + val c32: Double + val c03: Double + val c13: Double + val c23: Double + val c33: Double + val r00: Double + val r01: Double + val r02: Double + val r03: Double + val r10: Double + val r11: Double + val r12: Double + val r13: Double + val r20: Double + val r21: Double + val r22: Double + val r23: Double + val r30: Double + val r31: Double + val r32: Double + val r33: Double + val a11: Double + val a21: Double + val a31: Double + val a41: Double + val a12: Double + val a22: Double + val a32: Double + val a42: Double + val a13: Double + val a23: Double + val a33: Double + val a43: Double + val a14: Double + val a24: Double + val a34: Double + val a44: Double + val b11: Double + val b21: Double + val b31: Double + val b41: Double + val b12: Double + val b22: Double + val b32: Double + val b42: Double + val b13: Double + val b23: Double + val b33: Double + val b43: Double + val b14: Double + val b24: Double + val b34: Double + val b44: Double + val c0: Vector4d + val c1: Vector4d + val c2: Vector4d + val c3: Vector4d + val r0: Vector4d + val r1: Vector4d + val r2: Vector4d + val r3: Vector4d + + override val translation: Vector3d get() = Vector3d(r03, r13, r23) +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/FloatMatrix.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/FloatMatrix.kt new file mode 100644 index 00000000..4539a1a2 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/api/concrete/FloatMatrix.kt @@ -0,0 +1,167 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.api.concrete + +import ru.dbotthepony.kvector.api.IFloatMatrix +import ru.dbotthepony.kvector.api.IMatrix +import ru.dbotthepony.kvector.api.ISquareMatrix +import ru.dbotthepony.kvector.api.ITransposable +import ru.dbotthepony.kvector.matrix.* +import ru.dbotthepony.kvector.vector.nfloat.* + +/** + * [Matrix2f] and [MutableMatrix2f] implement this + */ +interface IMatrix2f> : IMatrix, IFloatMatrix, ITransposable { + val c00: Float + val c10: Float + val c01: Float + val c11: Float + val r00: Float + val r01: Float + val r10: Float + val r11: Float + val a11: Float + val a21: Float + val a12: Float + val a22: Float + val b11: Float + val b21: Float + val b12: Float + val b22: Float + val c0: Vector2f + val c1: Vector2f + val r0: Vector2f + val r1: Vector2f +} + +/** + * [Matrix3f] and [MutableMatrix3f] implement this + */ +interface IMatrix3f> : IMatrix, IFloatMatrix, ITransposable, ISquareMatrix { + val c00: Float + val c10: Float + val c20: Float + val c01: Float + val c11: Float + val c21: Float + val c02: Float + val c12: Float + val c22: Float + val r00: Float + val r01: Float + val r02: Float + val r10: Float + val r11: Float + val r12: Float + val r20: Float + val r21: Float + val r22: Float + val a11: Float + val a21: Float + val a31: Float + val a12: Float + val a22: Float + val a32: Float + val a13: Float + val a23: Float + val a33: Float + val b11: Float + val b21: Float + val b31: Float + val b12: Float + val b22: Float + val b32: Float + val b13: Float + val b23: Float + val b33: Float + val c0: Vector3f + val c1: Vector3f + val c2: Vector3f + val r0: Vector3f + val r1: Vector3f + val r2: Vector3f + + override val translation: Vector2f get() = Vector2f(r02, r12) +} + +/** + * [Matrix4f] and [MutableMatrix4f] implement this + */ +interface IMatrix4f> : IMatrix, IFloatMatrix, ITransposable, ISquareMatrix { + val c00: Float + val c10: Float + val c20: Float + val c30: Float + val c01: Float + val c11: Float + val c21: Float + val c31: Float + val c02: Float + val c12: Float + val c22: Float + val c32: Float + val c03: Float + val c13: Float + val c23: Float + val c33: Float + val r00: Float + val r01: Float + val r02: Float + val r03: Float + val r10: Float + val r11: Float + val r12: Float + val r13: Float + val r20: Float + val r21: Float + val r22: Float + val r23: Float + val r30: Float + val r31: Float + val r32: Float + val r33: Float + val a11: Float + val a21: Float + val a31: Float + val a41: Float + val a12: Float + val a22: Float + val a32: Float + val a42: Float + val a13: Float + val a23: Float + val a33: Float + val a43: Float + val a14: Float + val a24: Float + val a34: Float + val a44: Float + val b11: Float + val b21: Float + val b31: Float + val b41: Float + val b12: Float + val b22: Float + val b32: Float + val b42: Float + val b13: Float + val b23: Float + val b33: Float + val b43: Float + val b14: Float + val b24: Float + val b34: Float + val b44: Float + val c0: Vector4f + val c1: Vector4f + val c2: Vector4f + val c3: Vector4f + val r0: Vector4f + val r1: Vector4f + val r2: Vector4f + val r3: Vector4f + + override val translation: Vector3f get() = Vector3f(r03, r13, r23) +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/functions.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/functions.kt new file mode 100644 index 00000000..1f970d58 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/functions.kt @@ -0,0 +1,521 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.matrix.generated.* +import ru.dbotthepony.kvector.matrix.generated.matrixConcreteDeterminant +import ru.dbotthepony.kvector.narray.* +import kotlin.math.pow + +/** + * Multiplies matrices as long as they are compatible, of any size. + * Attempts to use concrete implementation first. + * + * @throws IllegalArgumentException if matrices are incompatible + * + * @return new [Double2Dimensional] buffer with multiplication result + */ +fun multiplyMatrix(matrix1: IMatrixGetterDouble, matrix2: IMatrixGetterDouble): Double2Dimensional { + require(matrix1.columns == matrix2.rows) { "Matrices are incompatible for multiplication (Matrix 1 has ${matrix1.columns} columns, Matrix 2 has ${matrix2.rows} rows)" } + + val multiplied = MultiplicationsDouble.multiplyMatrix(matrix1, matrix2) + + if (multiplied != null) { + return multiplied + } + + val resultRows = matrix1.rows + val resultColumns = matrix2.columns + val vectorized = matrix1.columns + + val output = Double2Dimensional(resultColumns, resultRows) + + for (row in 0 until resultRows) { + for (column in 0 until resultColumns) { + var sum = 0.0 + + for (rowColumn in 0 until vectorized) { + sum += matrix1[row, rowColumn] * matrix2[rowColumn, column] + } + + output[row, column] = sum + } + } + + return output +} + +/** + * Multiplies matrices as long as they are compatible, of any size. + * Attempts to use concrete implementation first. + * + * @throws IllegalArgumentException if matrices are incompatible + * + * @return new [Float2Dimensional] buffer with multiplication result + */ +fun multiplyMatrix(matrix1: IMatrixGetterFloat, matrix2: IMatrixGetterFloat): Float2Dimensional { + require(matrix1.columns == matrix2.rows) { "Matrices are incompatible for multiplication (Matrix 1 has ${matrix1.columns} columns, Matrix 2 has ${matrix2.rows} rows)" } + + val multiplied = MultiplicationsFloat.multiplyMatrix(matrix1, matrix2) + + if (multiplied != null) { + return multiplied + } + + val resultRows = matrix1.rows + val resultColumns = matrix2.columns + val vectorized = matrix1.columns + + val output = Float2Dimensional(resultColumns, resultRows) + + for (row in 0 until resultRows) { + for (column in 0 until resultColumns) { + var sum = 0f + + for (rowColumn in 0 until vectorized) { + sum += matrix1[row, rowColumn] * matrix2[rowColumn, column] + } + + output[row, column] = sum + } + } + + return output +} + +/** + * Multiplies matrices as long as they are compatible, of any size. + * Attempts to use concrete implementation first. + * + * @throws IllegalArgumentException if matrices are incompatible + * + * @return new [Int2Dimensional] buffer with multiplication result + */ +fun multiplyMatrix(matrix1: IMatrixGetterInt, matrix2: IMatrixGetterInt): Int2Dimensional { + require(matrix1.columns == matrix2.rows) { "Matrices are incompatible for multiplication (Matrix 1 has ${matrix1.columns} columns, Matrix 2 has ${matrix2.rows} rows)" } + + val multiplied = MultiplicationsInt.multiplyMatrix(matrix1, matrix2) + + if (multiplied != null) { + return multiplied + } + + val resultRows = matrix1.rows + val resultColumns = matrix2.columns + val vectorized = matrix1.columns + + val output = Int2Dimensional(resultColumns, resultRows) + + for (row in 0 until resultRows) { + for (column in 0 until resultColumns) { + var sum = 0 + + for (rowColumn in 0 until vectorized) { + sum += matrix1[row, rowColumn] * matrix2[rowColumn, column] + } + + output[row, column] = sum + } + } + + return output +} + +/** + * Multiplies matrices as long as they are compatible, of any size. + * Attempts to use concrete implementation first. + * + * @throws IllegalArgumentException if matrices are incompatible + * + * @return new [Long2Dimensional] buffer with multiplication result + */ +fun multiplyMatrix(matrix1: IMatrixGetterLong, matrix2: IMatrixGetterLong): Long2Dimensional { + require(matrix1.columns == matrix2.rows) { "Matrices are incompatible for multiplication (Matrix 1 has ${matrix1.columns} columns, Matrix 2 has ${matrix2.rows} rows)" } + + val multiplied = MultiplicationsLong.multiplyMatrix(matrix1, matrix2) + + if (multiplied != null) { + return multiplied + } + + val resultRows = matrix1.rows + val resultColumns = matrix2.columns + val vectorized = matrix1.columns + + val output = Long2Dimensional(resultColumns, resultRows) + + for (row in 0 until resultRows) { + for (column in 0 until resultColumns) { + var sum = 0L + + for (rowColumn in 0 until vectorized) { + sum += matrix1[row, rowColumn] * matrix2[rowColumn, column] + } + + output[row, column] = sum + } + } + + return output +} + +/** + * Multiplies matrices as long as they are compatible, of any size. + * Attempts to use concrete implementation first. + * + * @throws IllegalArgumentException if matrices are incompatible + * + * @return new [Short2Dimensional] buffer with multiplication result + */ +fun multiplyMatrix(matrix1: IMatrixGetterShort, matrix2: IMatrixGetterShort): Short2Dimensional { + require(matrix1.columns == matrix2.rows) { "Matrices are incompatible for multiplication (Matrix 1 has ${matrix1.columns} columns, Matrix 2 has ${matrix2.rows} rows)" } + + val multiplied = MultiplicationsShort.multiplyMatrix(matrix1, matrix2) + + if (multiplied != null) { + return multiplied + } + + val resultRows = matrix1.rows + val resultColumns = matrix2.columns + val vectorized = matrix1.columns + + val output = Short2Dimensional(resultColumns, resultRows) + + for (row in 0 until resultRows) { + for (column in 0 until resultColumns) { + var sum = 0 + + for (rowColumn in 0 until vectorized) { + sum += matrix1[row, rowColumn] * matrix2[rowColumn, column] + } + + output[row, column] = sum.toShort() + } + } + + return output +} + +/** + * Multiplies matrices as long as they are compatible, of any size. + * Attempts to use concrete implementation first. + * + * @throws IllegalArgumentException if matrices are incompatible + * + * @return new [Byte2Dimensional] buffer with multiplication result + */ +fun multiplyMatrix(matrix1: IMatrixGetterByte, matrix2: IMatrixGetterByte): Byte2Dimensional { + require(matrix1.columns == matrix2.rows) { "Matrices are incompatible for multiplication (Matrix 1 has ${matrix1.columns} columns, Matrix 2 has ${matrix2.rows} rows)" } + + val multiplied = MultiplicationsByte.multiplyMatrix(matrix1, matrix2) + + if (multiplied != null) { + return multiplied + } + + val resultRows = matrix1.rows + val resultColumns = matrix2.columns + val vectorized = matrix1.columns + + val output = Byte2Dimensional(resultColumns, resultRows) + + for (row in 0 until resultRows) { + for (column in 0 until resultColumns) { + var sum = 0L + + for (rowColumn in 0 until vectorized) { + sum += matrix1[row, rowColumn] * matrix2[rowColumn, column] + } + + output[row, column] = sum.toByte() + } + } + + return output +} + +/** + * Transposes structure representing matrix of any size. + */ +fun transposeMatrix(matrix: IMatrixGetterDouble): Double2Dimensional { + val output = Double2Dimensional(matrix.rows, matrix.columns) + + for (column in 0 until matrix.columns) { + for (row in 0 until matrix.rows) { + output[row, column] = matrix[column, row] + } + } + + return output +} + +/** + * Transposes structure representing matrix of any size. + */ +fun transposeMatrix(matrix: IMatrixGetterFloat): Float2Dimensional { + val output = Float2Dimensional(matrix.rows, matrix.columns) + + for (column in 0 until matrix.columns) { + for (row in 0 until matrix.rows) { + output[row, column] = matrix[column, row] + } + } + + return output +} + +private fun load(matrix: IMatrixGetterDouble, buffers: Array): Double2Dimensional { + val buffer = buffers[matrix.columns - 1] + + for (column in 0 until matrix.columns) { + for (row in 0 until matrix.rows) { + buffer[column, row] = matrix[column, row] + } + } + + return buffer +} + +private fun load(matrix: IMatrixGetterFloat, buffers: Array): Float2Dimensional { + val buffer = buffers[matrix.columns - 1] + + for (column in 0 until matrix.columns) { + for (row in 0 until matrix.rows) { + buffer[column, row] = matrix[column, row] + } + } + + return buffer +} + +private fun load(matrix: IMatrixGetterInt, buffers: Array): Int2Dimensional { + val buffer = buffers[matrix.columns - 1] + + for (column in 0 until matrix.columns) { + for (row in 0 until matrix.rows) { + buffer[column, row] = matrix[column, row] + } + } + + return buffer +} + +private fun load(matrix: IMatrixGetterLong, buffers: Array): Long2Dimensional { + val buffer = buffers[matrix.columns - 1] + + for (column in 0 until matrix.columns) { + for (row in 0 until matrix.rows) { + buffer[column, row] = matrix[column, row] + } + } + + return buffer +} + +/** + * Constructs new complement matrix from [input] representing square matrix, by taking out [column] and [row], and load result into [buffer]. + * + * @throws IllegalArgumentException if [column] or [row] is out of bounds, or if [input] does not represent a square matrix + * + * @return [buffer] + */ +fun complementMatrix(input: IMatrixGetterDouble, column: Int, row: Int, buffer: Double2Dimensional): Double2Dimensional { + require(input.rows == input.columns) { "Provided matrix is not square matrix (${input.rows} rows, ${input.columns} columns)" } + require(column < input.columns) { "$column < ${input.columns}" } + require(row < input.rows) { "$row < ${input.rows}" } + + var iRow = 0 + var iColumn = 0 + + for (gColumn in 0 until input.columns) { + if (gColumn == column) + continue + + for (gRow in 0 until input.rows) { + if (gRow == row) + continue + + buffer[iColumn, iRow++] = input[gColumn, gRow] + } + + iColumn++ + iRow = 0 + } + + return buffer +} + +/** + * Constructs new complement matrix from [input] representing square matrix, by taking out [column] and [row], and load result into [buffer]. + * + * @throws IllegalArgumentException if [column] or [row] is out of bounds, or if [input] does not represent a square matrix + * + * @return [buffer] + */ +fun complementMatrix(input: IMatrixGetterFloat, column: Int, row: Int, buffer: Float2Dimensional): Float2Dimensional { + require(input.rows == input.columns) { "Provided matrix is not square matrix (${input.rows} rows, ${input.columns} columns)" } + require(column < input.columns) { "$column < ${input.columns}" } + require(row < input.rows) { "$row < ${input.rows}" } + + var iRow = 0 + var iColumn = 0 + + for (gColumn in 0 until input.columns) { + if (gColumn == column) + continue + + for (gRow in 0 until input.rows) { + if (gRow == row) + continue + + buffer[iColumn, iRow++] = input[gColumn, gRow] + } + + iColumn++ + iRow = 0 + } + + return buffer +} + +/** + * Constructs new complement matrix from [input] representing square matrix, by taking out [column] and [row], and load result into [buffer]. + * + * @throws IllegalArgumentException if [column] or [row] is out of bounds, or if [input] does not represent a square matrix + * + * @return [buffer] + */ +fun complementMatrix(input: IMatrixGetterInt, column: Int, row: Int, buffer: Int2Dimensional): Int2Dimensional { + require(input.rows == input.columns) { "Provided matrix is not square matrix (${input.rows} rows, ${input.columns} columns)" } + require(column < input.columns) { "$column < ${input.columns}" } + require(row < input.rows) { "$row < ${input.rows}" } + + var iRow = 0 + var iColumn = 0 + + for (gColumn in 0 until input.columns) { + if (gColumn == column) + continue + + for (gRow in 0 until input.rows) { + if (gRow == row) + continue + + buffer[iColumn, iRow++] = input[gColumn, gRow] + } + + iColumn++ + iRow = 0 + } + + return buffer +} + +/** + * Constructs new complement matrix from [input] representing square matrix, by taking out [column] and [row], and load result into [buffer]. + * + * @throws IllegalArgumentException if [column] or [row] is out of bounds, or if [input] does not represent a square matrix + * + * @return [buffer] + */ +fun complementMatrix(input: IMatrixGetterLong, column: Int, row: Int, buffer: Long2Dimensional): Long2Dimensional { + require(input.rows == input.columns) { "Provided matrix is not square matrix (${input.rows} rows, ${input.columns} columns)" } + require(column < input.columns) { "$column < ${input.columns}" } + require(row < input.rows) { "$row < ${input.rows}" } + + var iRow = 0 + var iColumn = 0 + + for (gColumn in 0 until input.columns) { + if (gColumn == column) + continue + + for (gRow in 0 until input.rows) { + if (gRow == row) + continue + + buffer[iColumn, iRow++] = input[gColumn, gRow] + } + + iColumn++ + iRow = 0 + } + + return buffer +} + +private fun matrixDeterminant(input: Double2Dimensional, size: Int, buffers: Array): Double { + val concrete = matrixConcreteDeterminant(input) + + if (concrete != null) { + return concrete + } + + var result = 0.0 + + for (column in 0 until size) { + val minor = matrixDeterminant(complementMatrix(input, column, 0, buffers[input.columns - 2]), size - 1, buffers) + val cofactor = (-1.0).pow(2 + column) * minor + result += input[column, 0] * cofactor + } + + return result +} + +/** + * Recursive determinant finder of specified structure representing square matrix. + * + * @throws IllegalArgumentException if [matrix] structure is not square matrix + */ +fun matrixDeterminant(matrix: IMatrixGetterDouble): Double { + require(matrix.rows == matrix.columns) { "Provided matrix is not square matrix (${matrix.rows} rows, ${matrix.columns} columns)" } + + val concrete = matrixConcreteDeterminant(matrix) + + if (concrete != null) { + return concrete + } + + val buffers = Array(matrix.rows) { Double2Dimensional(it + 1, it + 1) } + return matrixDeterminant(load(matrix, buffers), matrix.columns, buffers) +} + +private fun matrixDeterminant(input: Float2Dimensional, size: Int, buffers: Array): Float { + val concrete = matrixConcreteDeterminant(input) + + if (concrete != null) { + return concrete + } + + var result = 0f + + for (column in 0 until size) { + val minor = matrixDeterminant(complementMatrix(input, column, 0, buffers[input.columns - 2]), size - 1, buffers) + val cofactor = (-1f).pow(2 + column) * minor + result += input[column, 0] * cofactor + } + + return result +} + +/** + * Recursive determinant finder of specified structure representing square matrix. + * + * @throws IllegalArgumentException if [matrix] structure is not square matrix + */ +fun matrixDeterminant(matrix: IMatrixGetterFloat): Float { + require(matrix.rows == matrix.columns) { "Provided matrix is not square matrix (${matrix.rows} rows, ${matrix.columns} columns)" } + + val concrete = matrixConcreteDeterminant(matrix) + + if (concrete != null) { + return concrete + } + + val buffers = Array(matrix.rows) { Float2Dimensional(it + 1, it + 1) } + return matrixDeterminant(load(matrix, buffers), matrix.columns, buffers).toFloat() +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsByte.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsByte.kt new file mode 100644 index 00000000..7bac3f86 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsByte.kt @@ -0,0 +1,94 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix.generated + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.narray.* + +// Some metaprogramming + +private fun determinant2(matrix: IMatrixGetterByte): Byte { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + return (c00*c11 - c01*c10).toByte() +} + +private fun determinant3(matrix: IMatrixGetterByte): Byte { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + return (c00*c11*c22 - c00*c12*c21 - c01*c10*c22 + c01*c12*c20 + c02*c10*c21 - c02*c11*c20).toByte() +} + +private fun determinant4(matrix: IMatrixGetterByte): Byte { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + return (c00*c11*c22*c33 - c00*c11*c23*c32 - c00*c12*c21*c33 + c00*c12*c23*c31 + c00*c13*c21*c32 - c00*c13*c22*c31 - c01*c10*c22*c33 + c01*c10*c23*c32 + c01*c12*c20*c33 - c01*c12*c23*c30 - c01*c13*c20*c32 + c01*c13*c22*c30 + c02*c10*c21*c33 - c02*c10*c23*c31 - c02*c11*c20*c33 + c02*c11*c23*c30 + c02*c13*c20*c31 - c02*c13*c21*c30 - c03*c10*c21*c32 + c03*c10*c22*c31 + c03*c11*c20*c32 - c03*c11*c22*c30 - c03*c12*c20*c31 + c03*c12*c21*c30).toByte() +} + +private fun determinant5(matrix: IMatrixGetterByte): Byte { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c40 = matrix[4, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c41 = matrix[4, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c42 = matrix[4, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + val c43 = matrix[4, 3] + val c04 = matrix[0, 4] + val c14 = matrix[1, 4] + val c24 = matrix[2, 4] + val c34 = matrix[3, 4] + val c44 = matrix[4, 4] + return (c00*c11*c22*c33*c44 - c00*c11*c22*c34*c43 - c00*c11*c23*c32*c44 + c00*c11*c23*c34*c42 + c00*c11*c24*c32*c43 - c00*c11*c24*c33*c42 - c00*c12*c21*c33*c44 + c00*c12*c21*c34*c43 + c00*c12*c23*c31*c44 - c00*c12*c23*c34*c41 - c00*c12*c24*c31*c43 + c00*c12*c24*c33*c41 + c00*c13*c21*c32*c44 - c00*c13*c21*c34*c42 - c00*c13*c22*c31*c44 + c00*c13*c22*c34*c41 + c00*c13*c24*c31*c42 - c00*c13*c24*c32*c41 - c00*c14*c21*c32*c43 + c00*c14*c21*c33*c42 + c00*c14*c22*c31*c43 - c00*c14*c22*c33*c41 - c00*c14*c23*c31*c42 + c00*c14*c23*c32*c41 - c01*c10*c22*c33*c44 + c01*c10*c22*c34*c43 + c01*c10*c23*c32*c44 - c01*c10*c23*c34*c42 - c01*c10*c24*c32*c43 + c01*c10*c24*c33*c42 + c01*c12*c20*c33*c44 - c01*c12*c20*c34*c43 - c01*c12*c23*c30*c44 + c01*c12*c23*c34*c40 + c01*c12*c24*c30*c43 - c01*c12*c24*c33*c40 - c01*c13*c20*c32*c44 + c01*c13*c20*c34*c42 + c01*c13*c22*c30*c44 - c01*c13*c22*c34*c40 - c01*c13*c24*c30*c42 + c01*c13*c24*c32*c40 + c01*c14*c20*c32*c43 - c01*c14*c20*c33*c42 - c01*c14*c22*c30*c43 + c01*c14*c22*c33*c40 + c01*c14*c23*c30*c42 - c01*c14*c23*c32*c40 + c02*c10*c21*c33*c44 - c02*c10*c21*c34*c43 - c02*c10*c23*c31*c44 + c02*c10*c23*c34*c41 + c02*c10*c24*c31*c43 - c02*c10*c24*c33*c41 - c02*c11*c20*c33*c44 + c02*c11*c20*c34*c43 + c02*c11*c23*c30*c44 - c02*c11*c23*c34*c40 - c02*c11*c24*c30*c43 + c02*c11*c24*c33*c40 + c02*c13*c20*c31*c44 - c02*c13*c20*c34*c41 - c02*c13*c21*c30*c44 + c02*c13*c21*c34*c40 + c02*c13*c24*c30*c41 - c02*c13*c24*c31*c40 - c02*c14*c20*c31*c43 + c02*c14*c20*c33*c41 + c02*c14*c21*c30*c43 - c02*c14*c21*c33*c40 - c02*c14*c23*c30*c41 + c02*c14*c23*c31*c40 - c03*c10*c21*c32*c44 + c03*c10*c21*c34*c42 + c03*c10*c22*c31*c44 - c03*c10*c22*c34*c41 - c03*c10*c24*c31*c42 + c03*c10*c24*c32*c41 + c03*c11*c20*c32*c44 - c03*c11*c20*c34*c42 - c03*c11*c22*c30*c44 + c03*c11*c22*c34*c40 + c03*c11*c24*c30*c42 - c03*c11*c24*c32*c40 - c03*c12*c20*c31*c44 + c03*c12*c20*c34*c41 + c03*c12*c21*c30*c44 - c03*c12*c21*c34*c40 - c03*c12*c24*c30*c41 + c03*c12*c24*c31*c40 + c03*c14*c20*c31*c42 - c03*c14*c20*c32*c41 - c03*c14*c21*c30*c42 + c03*c14*c21*c32*c40 + c03*c14*c22*c30*c41 - c03*c14*c22*c31*c40 + c04*c10*c21*c32*c43 - c04*c10*c21*c33*c42 - c04*c10*c22*c31*c43 + c04*c10*c22*c33*c41 + c04*c10*c23*c31*c42 - c04*c10*c23*c32*c41 - c04*c11*c20*c32*c43 + c04*c11*c20*c33*c42 + c04*c11*c22*c30*c43 - c04*c11*c22*c33*c40 - c04*c11*c23*c30*c42 + c04*c11*c23*c32*c40 + c04*c12*c20*c31*c43 - c04*c12*c20*c33*c41 - c04*c12*c21*c30*c43 + c04*c12*c21*c33*c40 + c04*c12*c23*c30*c41 - c04*c12*c23*c31*c40 - c04*c13*c20*c31*c42 + c04*c13*c20*c32*c41 + c04*c13*c21*c30*c42 - c04*c13*c21*c32*c40 - c04*c13*c22*c30*c41 + c04*c13*c22*c31*c40).toByte() +} + +/** + * Automatically generated concrete matrix determinant finder. If no mapping exist, this function returns null + */ +fun matrixConcreteDeterminant(matrix: IMatrixGetterByte): Byte? { + require(matrix.columns == matrix.rows) { "Provided matrix (${matrix.columns}x${matrix.rows}) is not a square matrix" } + return when (matrix.columns) { + 2 -> determinant2(matrix) + 3 -> determinant3(matrix) + 4 -> determinant4(matrix) + 5 -> determinant5(matrix) + else -> null + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsDouble.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsDouble.kt new file mode 100644 index 00000000..397a9c46 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsDouble.kt @@ -0,0 +1,94 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix.generated + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.narray.* + +// Some metaprogramming + +private fun determinant2(matrix: IMatrixGetterDouble): Double { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + return c00*c11 - c01*c10 +} + +private fun determinant3(matrix: IMatrixGetterDouble): Double { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + return c00*c11*c22 - c00*c12*c21 - c01*c10*c22 + c01*c12*c20 + c02*c10*c21 - c02*c11*c20 +} + +private fun determinant4(matrix: IMatrixGetterDouble): Double { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + return c00*c11*c22*c33 - c00*c11*c23*c32 - c00*c12*c21*c33 + c00*c12*c23*c31 + c00*c13*c21*c32 - c00*c13*c22*c31 - c01*c10*c22*c33 + c01*c10*c23*c32 + c01*c12*c20*c33 - c01*c12*c23*c30 - c01*c13*c20*c32 + c01*c13*c22*c30 + c02*c10*c21*c33 - c02*c10*c23*c31 - c02*c11*c20*c33 + c02*c11*c23*c30 + c02*c13*c20*c31 - c02*c13*c21*c30 - c03*c10*c21*c32 + c03*c10*c22*c31 + c03*c11*c20*c32 - c03*c11*c22*c30 - c03*c12*c20*c31 + c03*c12*c21*c30 +} + +private fun determinant5(matrix: IMatrixGetterDouble): Double { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c40 = matrix[4, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c41 = matrix[4, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c42 = matrix[4, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + val c43 = matrix[4, 3] + val c04 = matrix[0, 4] + val c14 = matrix[1, 4] + val c24 = matrix[2, 4] + val c34 = matrix[3, 4] + val c44 = matrix[4, 4] + return c00*c11*c22*c33*c44 - c00*c11*c22*c34*c43 - c00*c11*c23*c32*c44 + c00*c11*c23*c34*c42 + c00*c11*c24*c32*c43 - c00*c11*c24*c33*c42 - c00*c12*c21*c33*c44 + c00*c12*c21*c34*c43 + c00*c12*c23*c31*c44 - c00*c12*c23*c34*c41 - c00*c12*c24*c31*c43 + c00*c12*c24*c33*c41 + c00*c13*c21*c32*c44 - c00*c13*c21*c34*c42 - c00*c13*c22*c31*c44 + c00*c13*c22*c34*c41 + c00*c13*c24*c31*c42 - c00*c13*c24*c32*c41 - c00*c14*c21*c32*c43 + c00*c14*c21*c33*c42 + c00*c14*c22*c31*c43 - c00*c14*c22*c33*c41 - c00*c14*c23*c31*c42 + c00*c14*c23*c32*c41 - c01*c10*c22*c33*c44 + c01*c10*c22*c34*c43 + c01*c10*c23*c32*c44 - c01*c10*c23*c34*c42 - c01*c10*c24*c32*c43 + c01*c10*c24*c33*c42 + c01*c12*c20*c33*c44 - c01*c12*c20*c34*c43 - c01*c12*c23*c30*c44 + c01*c12*c23*c34*c40 + c01*c12*c24*c30*c43 - c01*c12*c24*c33*c40 - c01*c13*c20*c32*c44 + c01*c13*c20*c34*c42 + c01*c13*c22*c30*c44 - c01*c13*c22*c34*c40 - c01*c13*c24*c30*c42 + c01*c13*c24*c32*c40 + c01*c14*c20*c32*c43 - c01*c14*c20*c33*c42 - c01*c14*c22*c30*c43 + c01*c14*c22*c33*c40 + c01*c14*c23*c30*c42 - c01*c14*c23*c32*c40 + c02*c10*c21*c33*c44 - c02*c10*c21*c34*c43 - c02*c10*c23*c31*c44 + c02*c10*c23*c34*c41 + c02*c10*c24*c31*c43 - c02*c10*c24*c33*c41 - c02*c11*c20*c33*c44 + c02*c11*c20*c34*c43 + c02*c11*c23*c30*c44 - c02*c11*c23*c34*c40 - c02*c11*c24*c30*c43 + c02*c11*c24*c33*c40 + c02*c13*c20*c31*c44 - c02*c13*c20*c34*c41 - c02*c13*c21*c30*c44 + c02*c13*c21*c34*c40 + c02*c13*c24*c30*c41 - c02*c13*c24*c31*c40 - c02*c14*c20*c31*c43 + c02*c14*c20*c33*c41 + c02*c14*c21*c30*c43 - c02*c14*c21*c33*c40 - c02*c14*c23*c30*c41 + c02*c14*c23*c31*c40 - c03*c10*c21*c32*c44 + c03*c10*c21*c34*c42 + c03*c10*c22*c31*c44 - c03*c10*c22*c34*c41 - c03*c10*c24*c31*c42 + c03*c10*c24*c32*c41 + c03*c11*c20*c32*c44 - c03*c11*c20*c34*c42 - c03*c11*c22*c30*c44 + c03*c11*c22*c34*c40 + c03*c11*c24*c30*c42 - c03*c11*c24*c32*c40 - c03*c12*c20*c31*c44 + c03*c12*c20*c34*c41 + c03*c12*c21*c30*c44 - c03*c12*c21*c34*c40 - c03*c12*c24*c30*c41 + c03*c12*c24*c31*c40 + c03*c14*c20*c31*c42 - c03*c14*c20*c32*c41 - c03*c14*c21*c30*c42 + c03*c14*c21*c32*c40 + c03*c14*c22*c30*c41 - c03*c14*c22*c31*c40 + c04*c10*c21*c32*c43 - c04*c10*c21*c33*c42 - c04*c10*c22*c31*c43 + c04*c10*c22*c33*c41 + c04*c10*c23*c31*c42 - c04*c10*c23*c32*c41 - c04*c11*c20*c32*c43 + c04*c11*c20*c33*c42 + c04*c11*c22*c30*c43 - c04*c11*c22*c33*c40 - c04*c11*c23*c30*c42 + c04*c11*c23*c32*c40 + c04*c12*c20*c31*c43 - c04*c12*c20*c33*c41 - c04*c12*c21*c30*c43 + c04*c12*c21*c33*c40 + c04*c12*c23*c30*c41 - c04*c12*c23*c31*c40 - c04*c13*c20*c31*c42 + c04*c13*c20*c32*c41 + c04*c13*c21*c30*c42 - c04*c13*c21*c32*c40 - c04*c13*c22*c30*c41 + c04*c13*c22*c31*c40 +} + +/** + * Automatically generated concrete matrix determinant finder. If no mapping exist, this function returns null + */ +fun matrixConcreteDeterminant(matrix: IMatrixGetterDouble): Double? { + require(matrix.columns == matrix.rows) { "Provided matrix (${matrix.columns}x${matrix.rows}) is not a square matrix" } + return when (matrix.columns) { + 2 -> determinant2(matrix) + 3 -> determinant3(matrix) + 4 -> determinant4(matrix) + 5 -> determinant5(matrix) + else -> null + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsFloat.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsFloat.kt new file mode 100644 index 00000000..97b0460b --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsFloat.kt @@ -0,0 +1,94 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix.generated + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.narray.* + +// Some metaprogramming + +private fun determinant2(matrix: IMatrixGetterFloat): Float { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + return c00*c11 - c01*c10 +} + +private fun determinant3(matrix: IMatrixGetterFloat): Float { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + return c00*c11*c22 - c00*c12*c21 - c01*c10*c22 + c01*c12*c20 + c02*c10*c21 - c02*c11*c20 +} + +private fun determinant4(matrix: IMatrixGetterFloat): Float { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + return c00*c11*c22*c33 - c00*c11*c23*c32 - c00*c12*c21*c33 + c00*c12*c23*c31 + c00*c13*c21*c32 - c00*c13*c22*c31 - c01*c10*c22*c33 + c01*c10*c23*c32 + c01*c12*c20*c33 - c01*c12*c23*c30 - c01*c13*c20*c32 + c01*c13*c22*c30 + c02*c10*c21*c33 - c02*c10*c23*c31 - c02*c11*c20*c33 + c02*c11*c23*c30 + c02*c13*c20*c31 - c02*c13*c21*c30 - c03*c10*c21*c32 + c03*c10*c22*c31 + c03*c11*c20*c32 - c03*c11*c22*c30 - c03*c12*c20*c31 + c03*c12*c21*c30 +} + +private fun determinant5(matrix: IMatrixGetterFloat): Float { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c40 = matrix[4, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c41 = matrix[4, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c42 = matrix[4, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + val c43 = matrix[4, 3] + val c04 = matrix[0, 4] + val c14 = matrix[1, 4] + val c24 = matrix[2, 4] + val c34 = matrix[3, 4] + val c44 = matrix[4, 4] + return c00*c11*c22*c33*c44 - c00*c11*c22*c34*c43 - c00*c11*c23*c32*c44 + c00*c11*c23*c34*c42 + c00*c11*c24*c32*c43 - c00*c11*c24*c33*c42 - c00*c12*c21*c33*c44 + c00*c12*c21*c34*c43 + c00*c12*c23*c31*c44 - c00*c12*c23*c34*c41 - c00*c12*c24*c31*c43 + c00*c12*c24*c33*c41 + c00*c13*c21*c32*c44 - c00*c13*c21*c34*c42 - c00*c13*c22*c31*c44 + c00*c13*c22*c34*c41 + c00*c13*c24*c31*c42 - c00*c13*c24*c32*c41 - c00*c14*c21*c32*c43 + c00*c14*c21*c33*c42 + c00*c14*c22*c31*c43 - c00*c14*c22*c33*c41 - c00*c14*c23*c31*c42 + c00*c14*c23*c32*c41 - c01*c10*c22*c33*c44 + c01*c10*c22*c34*c43 + c01*c10*c23*c32*c44 - c01*c10*c23*c34*c42 - c01*c10*c24*c32*c43 + c01*c10*c24*c33*c42 + c01*c12*c20*c33*c44 - c01*c12*c20*c34*c43 - c01*c12*c23*c30*c44 + c01*c12*c23*c34*c40 + c01*c12*c24*c30*c43 - c01*c12*c24*c33*c40 - c01*c13*c20*c32*c44 + c01*c13*c20*c34*c42 + c01*c13*c22*c30*c44 - c01*c13*c22*c34*c40 - c01*c13*c24*c30*c42 + c01*c13*c24*c32*c40 + c01*c14*c20*c32*c43 - c01*c14*c20*c33*c42 - c01*c14*c22*c30*c43 + c01*c14*c22*c33*c40 + c01*c14*c23*c30*c42 - c01*c14*c23*c32*c40 + c02*c10*c21*c33*c44 - c02*c10*c21*c34*c43 - c02*c10*c23*c31*c44 + c02*c10*c23*c34*c41 + c02*c10*c24*c31*c43 - c02*c10*c24*c33*c41 - c02*c11*c20*c33*c44 + c02*c11*c20*c34*c43 + c02*c11*c23*c30*c44 - c02*c11*c23*c34*c40 - c02*c11*c24*c30*c43 + c02*c11*c24*c33*c40 + c02*c13*c20*c31*c44 - c02*c13*c20*c34*c41 - c02*c13*c21*c30*c44 + c02*c13*c21*c34*c40 + c02*c13*c24*c30*c41 - c02*c13*c24*c31*c40 - c02*c14*c20*c31*c43 + c02*c14*c20*c33*c41 + c02*c14*c21*c30*c43 - c02*c14*c21*c33*c40 - c02*c14*c23*c30*c41 + c02*c14*c23*c31*c40 - c03*c10*c21*c32*c44 + c03*c10*c21*c34*c42 + c03*c10*c22*c31*c44 - c03*c10*c22*c34*c41 - c03*c10*c24*c31*c42 + c03*c10*c24*c32*c41 + c03*c11*c20*c32*c44 - c03*c11*c20*c34*c42 - c03*c11*c22*c30*c44 + c03*c11*c22*c34*c40 + c03*c11*c24*c30*c42 - c03*c11*c24*c32*c40 - c03*c12*c20*c31*c44 + c03*c12*c20*c34*c41 + c03*c12*c21*c30*c44 - c03*c12*c21*c34*c40 - c03*c12*c24*c30*c41 + c03*c12*c24*c31*c40 + c03*c14*c20*c31*c42 - c03*c14*c20*c32*c41 - c03*c14*c21*c30*c42 + c03*c14*c21*c32*c40 + c03*c14*c22*c30*c41 - c03*c14*c22*c31*c40 + c04*c10*c21*c32*c43 - c04*c10*c21*c33*c42 - c04*c10*c22*c31*c43 + c04*c10*c22*c33*c41 + c04*c10*c23*c31*c42 - c04*c10*c23*c32*c41 - c04*c11*c20*c32*c43 + c04*c11*c20*c33*c42 + c04*c11*c22*c30*c43 - c04*c11*c22*c33*c40 - c04*c11*c23*c30*c42 + c04*c11*c23*c32*c40 + c04*c12*c20*c31*c43 - c04*c12*c20*c33*c41 - c04*c12*c21*c30*c43 + c04*c12*c21*c33*c40 + c04*c12*c23*c30*c41 - c04*c12*c23*c31*c40 - c04*c13*c20*c31*c42 + c04*c13*c20*c32*c41 + c04*c13*c21*c30*c42 - c04*c13*c21*c32*c40 - c04*c13*c22*c30*c41 + c04*c13*c22*c31*c40 +} + +/** + * Automatically generated concrete matrix determinant finder. If no mapping exist, this function returns null + */ +fun matrixConcreteDeterminant(matrix: IMatrixGetterFloat): Float? { + require(matrix.columns == matrix.rows) { "Provided matrix (${matrix.columns}x${matrix.rows}) is not a square matrix" } + return when (matrix.columns) { + 2 -> determinant2(matrix) + 3 -> determinant3(matrix) + 4 -> determinant4(matrix) + 5 -> determinant5(matrix) + else -> null + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsInt.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsInt.kt new file mode 100644 index 00000000..21fc4de6 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsInt.kt @@ -0,0 +1,94 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix.generated + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.narray.* + +// Some metaprogramming + +private fun determinant2(matrix: IMatrixGetterInt): Int { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + return c00*c11 - c01*c10 +} + +private fun determinant3(matrix: IMatrixGetterInt): Int { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + return c00*c11*c22 - c00*c12*c21 - c01*c10*c22 + c01*c12*c20 + c02*c10*c21 - c02*c11*c20 +} + +private fun determinant4(matrix: IMatrixGetterInt): Int { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + return c00*c11*c22*c33 - c00*c11*c23*c32 - c00*c12*c21*c33 + c00*c12*c23*c31 + c00*c13*c21*c32 - c00*c13*c22*c31 - c01*c10*c22*c33 + c01*c10*c23*c32 + c01*c12*c20*c33 - c01*c12*c23*c30 - c01*c13*c20*c32 + c01*c13*c22*c30 + c02*c10*c21*c33 - c02*c10*c23*c31 - c02*c11*c20*c33 + c02*c11*c23*c30 + c02*c13*c20*c31 - c02*c13*c21*c30 - c03*c10*c21*c32 + c03*c10*c22*c31 + c03*c11*c20*c32 - c03*c11*c22*c30 - c03*c12*c20*c31 + c03*c12*c21*c30 +} + +private fun determinant5(matrix: IMatrixGetterInt): Int { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c40 = matrix[4, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c41 = matrix[4, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c42 = matrix[4, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + val c43 = matrix[4, 3] + val c04 = matrix[0, 4] + val c14 = matrix[1, 4] + val c24 = matrix[2, 4] + val c34 = matrix[3, 4] + val c44 = matrix[4, 4] + return c00*c11*c22*c33*c44 - c00*c11*c22*c34*c43 - c00*c11*c23*c32*c44 + c00*c11*c23*c34*c42 + c00*c11*c24*c32*c43 - c00*c11*c24*c33*c42 - c00*c12*c21*c33*c44 + c00*c12*c21*c34*c43 + c00*c12*c23*c31*c44 - c00*c12*c23*c34*c41 - c00*c12*c24*c31*c43 + c00*c12*c24*c33*c41 + c00*c13*c21*c32*c44 - c00*c13*c21*c34*c42 - c00*c13*c22*c31*c44 + c00*c13*c22*c34*c41 + c00*c13*c24*c31*c42 - c00*c13*c24*c32*c41 - c00*c14*c21*c32*c43 + c00*c14*c21*c33*c42 + c00*c14*c22*c31*c43 - c00*c14*c22*c33*c41 - c00*c14*c23*c31*c42 + c00*c14*c23*c32*c41 - c01*c10*c22*c33*c44 + c01*c10*c22*c34*c43 + c01*c10*c23*c32*c44 - c01*c10*c23*c34*c42 - c01*c10*c24*c32*c43 + c01*c10*c24*c33*c42 + c01*c12*c20*c33*c44 - c01*c12*c20*c34*c43 - c01*c12*c23*c30*c44 + c01*c12*c23*c34*c40 + c01*c12*c24*c30*c43 - c01*c12*c24*c33*c40 - c01*c13*c20*c32*c44 + c01*c13*c20*c34*c42 + c01*c13*c22*c30*c44 - c01*c13*c22*c34*c40 - c01*c13*c24*c30*c42 + c01*c13*c24*c32*c40 + c01*c14*c20*c32*c43 - c01*c14*c20*c33*c42 - c01*c14*c22*c30*c43 + c01*c14*c22*c33*c40 + c01*c14*c23*c30*c42 - c01*c14*c23*c32*c40 + c02*c10*c21*c33*c44 - c02*c10*c21*c34*c43 - c02*c10*c23*c31*c44 + c02*c10*c23*c34*c41 + c02*c10*c24*c31*c43 - c02*c10*c24*c33*c41 - c02*c11*c20*c33*c44 + c02*c11*c20*c34*c43 + c02*c11*c23*c30*c44 - c02*c11*c23*c34*c40 - c02*c11*c24*c30*c43 + c02*c11*c24*c33*c40 + c02*c13*c20*c31*c44 - c02*c13*c20*c34*c41 - c02*c13*c21*c30*c44 + c02*c13*c21*c34*c40 + c02*c13*c24*c30*c41 - c02*c13*c24*c31*c40 - c02*c14*c20*c31*c43 + c02*c14*c20*c33*c41 + c02*c14*c21*c30*c43 - c02*c14*c21*c33*c40 - c02*c14*c23*c30*c41 + c02*c14*c23*c31*c40 - c03*c10*c21*c32*c44 + c03*c10*c21*c34*c42 + c03*c10*c22*c31*c44 - c03*c10*c22*c34*c41 - c03*c10*c24*c31*c42 + c03*c10*c24*c32*c41 + c03*c11*c20*c32*c44 - c03*c11*c20*c34*c42 - c03*c11*c22*c30*c44 + c03*c11*c22*c34*c40 + c03*c11*c24*c30*c42 - c03*c11*c24*c32*c40 - c03*c12*c20*c31*c44 + c03*c12*c20*c34*c41 + c03*c12*c21*c30*c44 - c03*c12*c21*c34*c40 - c03*c12*c24*c30*c41 + c03*c12*c24*c31*c40 + c03*c14*c20*c31*c42 - c03*c14*c20*c32*c41 - c03*c14*c21*c30*c42 + c03*c14*c21*c32*c40 + c03*c14*c22*c30*c41 - c03*c14*c22*c31*c40 + c04*c10*c21*c32*c43 - c04*c10*c21*c33*c42 - c04*c10*c22*c31*c43 + c04*c10*c22*c33*c41 + c04*c10*c23*c31*c42 - c04*c10*c23*c32*c41 - c04*c11*c20*c32*c43 + c04*c11*c20*c33*c42 + c04*c11*c22*c30*c43 - c04*c11*c22*c33*c40 - c04*c11*c23*c30*c42 + c04*c11*c23*c32*c40 + c04*c12*c20*c31*c43 - c04*c12*c20*c33*c41 - c04*c12*c21*c30*c43 + c04*c12*c21*c33*c40 + c04*c12*c23*c30*c41 - c04*c12*c23*c31*c40 - c04*c13*c20*c31*c42 + c04*c13*c20*c32*c41 + c04*c13*c21*c30*c42 - c04*c13*c21*c32*c40 - c04*c13*c22*c30*c41 + c04*c13*c22*c31*c40 +} + +/** + * Automatically generated concrete matrix determinant finder. If no mapping exist, this function returns null + */ +fun matrixConcreteDeterminant(matrix: IMatrixGetterInt): Int? { + require(matrix.columns == matrix.rows) { "Provided matrix (${matrix.columns}x${matrix.rows}) is not a square matrix" } + return when (matrix.columns) { + 2 -> determinant2(matrix) + 3 -> determinant3(matrix) + 4 -> determinant4(matrix) + 5 -> determinant5(matrix) + else -> null + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsLong.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsLong.kt new file mode 100644 index 00000000..ee51de16 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsLong.kt @@ -0,0 +1,94 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix.generated + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.narray.* + +// Some metaprogramming + +private fun determinant2(matrix: IMatrixGetterLong): Long { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + return c00*c11 - c01*c10 +} + +private fun determinant3(matrix: IMatrixGetterLong): Long { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + return c00*c11*c22 - c00*c12*c21 - c01*c10*c22 + c01*c12*c20 + c02*c10*c21 - c02*c11*c20 +} + +private fun determinant4(matrix: IMatrixGetterLong): Long { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + return c00*c11*c22*c33 - c00*c11*c23*c32 - c00*c12*c21*c33 + c00*c12*c23*c31 + c00*c13*c21*c32 - c00*c13*c22*c31 - c01*c10*c22*c33 + c01*c10*c23*c32 + c01*c12*c20*c33 - c01*c12*c23*c30 - c01*c13*c20*c32 + c01*c13*c22*c30 + c02*c10*c21*c33 - c02*c10*c23*c31 - c02*c11*c20*c33 + c02*c11*c23*c30 + c02*c13*c20*c31 - c02*c13*c21*c30 - c03*c10*c21*c32 + c03*c10*c22*c31 + c03*c11*c20*c32 - c03*c11*c22*c30 - c03*c12*c20*c31 + c03*c12*c21*c30 +} + +private fun determinant5(matrix: IMatrixGetterLong): Long { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c40 = matrix[4, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c41 = matrix[4, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c42 = matrix[4, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + val c43 = matrix[4, 3] + val c04 = matrix[0, 4] + val c14 = matrix[1, 4] + val c24 = matrix[2, 4] + val c34 = matrix[3, 4] + val c44 = matrix[4, 4] + return c00*c11*c22*c33*c44 - c00*c11*c22*c34*c43 - c00*c11*c23*c32*c44 + c00*c11*c23*c34*c42 + c00*c11*c24*c32*c43 - c00*c11*c24*c33*c42 - c00*c12*c21*c33*c44 + c00*c12*c21*c34*c43 + c00*c12*c23*c31*c44 - c00*c12*c23*c34*c41 - c00*c12*c24*c31*c43 + c00*c12*c24*c33*c41 + c00*c13*c21*c32*c44 - c00*c13*c21*c34*c42 - c00*c13*c22*c31*c44 + c00*c13*c22*c34*c41 + c00*c13*c24*c31*c42 - c00*c13*c24*c32*c41 - c00*c14*c21*c32*c43 + c00*c14*c21*c33*c42 + c00*c14*c22*c31*c43 - c00*c14*c22*c33*c41 - c00*c14*c23*c31*c42 + c00*c14*c23*c32*c41 - c01*c10*c22*c33*c44 + c01*c10*c22*c34*c43 + c01*c10*c23*c32*c44 - c01*c10*c23*c34*c42 - c01*c10*c24*c32*c43 + c01*c10*c24*c33*c42 + c01*c12*c20*c33*c44 - c01*c12*c20*c34*c43 - c01*c12*c23*c30*c44 + c01*c12*c23*c34*c40 + c01*c12*c24*c30*c43 - c01*c12*c24*c33*c40 - c01*c13*c20*c32*c44 + c01*c13*c20*c34*c42 + c01*c13*c22*c30*c44 - c01*c13*c22*c34*c40 - c01*c13*c24*c30*c42 + c01*c13*c24*c32*c40 + c01*c14*c20*c32*c43 - c01*c14*c20*c33*c42 - c01*c14*c22*c30*c43 + c01*c14*c22*c33*c40 + c01*c14*c23*c30*c42 - c01*c14*c23*c32*c40 + c02*c10*c21*c33*c44 - c02*c10*c21*c34*c43 - c02*c10*c23*c31*c44 + c02*c10*c23*c34*c41 + c02*c10*c24*c31*c43 - c02*c10*c24*c33*c41 - c02*c11*c20*c33*c44 + c02*c11*c20*c34*c43 + c02*c11*c23*c30*c44 - c02*c11*c23*c34*c40 - c02*c11*c24*c30*c43 + c02*c11*c24*c33*c40 + c02*c13*c20*c31*c44 - c02*c13*c20*c34*c41 - c02*c13*c21*c30*c44 + c02*c13*c21*c34*c40 + c02*c13*c24*c30*c41 - c02*c13*c24*c31*c40 - c02*c14*c20*c31*c43 + c02*c14*c20*c33*c41 + c02*c14*c21*c30*c43 - c02*c14*c21*c33*c40 - c02*c14*c23*c30*c41 + c02*c14*c23*c31*c40 - c03*c10*c21*c32*c44 + c03*c10*c21*c34*c42 + c03*c10*c22*c31*c44 - c03*c10*c22*c34*c41 - c03*c10*c24*c31*c42 + c03*c10*c24*c32*c41 + c03*c11*c20*c32*c44 - c03*c11*c20*c34*c42 - c03*c11*c22*c30*c44 + c03*c11*c22*c34*c40 + c03*c11*c24*c30*c42 - c03*c11*c24*c32*c40 - c03*c12*c20*c31*c44 + c03*c12*c20*c34*c41 + c03*c12*c21*c30*c44 - c03*c12*c21*c34*c40 - c03*c12*c24*c30*c41 + c03*c12*c24*c31*c40 + c03*c14*c20*c31*c42 - c03*c14*c20*c32*c41 - c03*c14*c21*c30*c42 + c03*c14*c21*c32*c40 + c03*c14*c22*c30*c41 - c03*c14*c22*c31*c40 + c04*c10*c21*c32*c43 - c04*c10*c21*c33*c42 - c04*c10*c22*c31*c43 + c04*c10*c22*c33*c41 + c04*c10*c23*c31*c42 - c04*c10*c23*c32*c41 - c04*c11*c20*c32*c43 + c04*c11*c20*c33*c42 + c04*c11*c22*c30*c43 - c04*c11*c22*c33*c40 - c04*c11*c23*c30*c42 + c04*c11*c23*c32*c40 + c04*c12*c20*c31*c43 - c04*c12*c20*c33*c41 - c04*c12*c21*c30*c43 + c04*c12*c21*c33*c40 + c04*c12*c23*c30*c41 - c04*c12*c23*c31*c40 - c04*c13*c20*c31*c42 + c04*c13*c20*c32*c41 + c04*c13*c21*c30*c42 - c04*c13*c21*c32*c40 - c04*c13*c22*c30*c41 + c04*c13*c22*c31*c40 +} + +/** + * Automatically generated concrete matrix determinant finder. If no mapping exist, this function returns null + */ +fun matrixConcreteDeterminant(matrix: IMatrixGetterLong): Long? { + require(matrix.columns == matrix.rows) { "Provided matrix (${matrix.columns}x${matrix.rows}) is not a square matrix" } + return when (matrix.columns) { + 2 -> determinant2(matrix) + 3 -> determinant3(matrix) + 4 -> determinant4(matrix) + 5 -> determinant5(matrix) + else -> null + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsShort.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsShort.kt new file mode 100644 index 00000000..fa0c27f9 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/generated/DeterminantsShort.kt @@ -0,0 +1,94 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.matrix.generated + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.narray.* + +// Some metaprogramming + +private fun determinant2(matrix: IMatrixGetterShort): Short { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + return (c00*c11 - c01*c10).toShort() +} + +private fun determinant3(matrix: IMatrixGetterShort): Short { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + return (c00*c11*c22 - c00*c12*c21 - c01*c10*c22 + c01*c12*c20 + c02*c10*c21 - c02*c11*c20).toShort() +} + +private fun determinant4(matrix: IMatrixGetterShort): Short { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + return (c00*c11*c22*c33 - c00*c11*c23*c32 - c00*c12*c21*c33 + c00*c12*c23*c31 + c00*c13*c21*c32 - c00*c13*c22*c31 - c01*c10*c22*c33 + c01*c10*c23*c32 + c01*c12*c20*c33 - c01*c12*c23*c30 - c01*c13*c20*c32 + c01*c13*c22*c30 + c02*c10*c21*c33 - c02*c10*c23*c31 - c02*c11*c20*c33 + c02*c11*c23*c30 + c02*c13*c20*c31 - c02*c13*c21*c30 - c03*c10*c21*c32 + c03*c10*c22*c31 + c03*c11*c20*c32 - c03*c11*c22*c30 - c03*c12*c20*c31 + c03*c12*c21*c30).toShort() +} + +private fun determinant5(matrix: IMatrixGetterShort): Short { + val c00 = matrix[0, 0] + val c10 = matrix[1, 0] + val c20 = matrix[2, 0] + val c30 = matrix[3, 0] + val c40 = matrix[4, 0] + val c01 = matrix[0, 1] + val c11 = matrix[1, 1] + val c21 = matrix[2, 1] + val c31 = matrix[3, 1] + val c41 = matrix[4, 1] + val c02 = matrix[0, 2] + val c12 = matrix[1, 2] + val c22 = matrix[2, 2] + val c32 = matrix[3, 2] + val c42 = matrix[4, 2] + val c03 = matrix[0, 3] + val c13 = matrix[1, 3] + val c23 = matrix[2, 3] + val c33 = matrix[3, 3] + val c43 = matrix[4, 3] + val c04 = matrix[0, 4] + val c14 = matrix[1, 4] + val c24 = matrix[2, 4] + val c34 = matrix[3, 4] + val c44 = matrix[4, 4] + return (c00*c11*c22*c33*c44 - c00*c11*c22*c34*c43 - c00*c11*c23*c32*c44 + c00*c11*c23*c34*c42 + c00*c11*c24*c32*c43 - c00*c11*c24*c33*c42 - c00*c12*c21*c33*c44 + c00*c12*c21*c34*c43 + c00*c12*c23*c31*c44 - c00*c12*c23*c34*c41 - c00*c12*c24*c31*c43 + c00*c12*c24*c33*c41 + c00*c13*c21*c32*c44 - c00*c13*c21*c34*c42 - c00*c13*c22*c31*c44 + c00*c13*c22*c34*c41 + c00*c13*c24*c31*c42 - c00*c13*c24*c32*c41 - c00*c14*c21*c32*c43 + c00*c14*c21*c33*c42 + c00*c14*c22*c31*c43 - c00*c14*c22*c33*c41 - c00*c14*c23*c31*c42 + c00*c14*c23*c32*c41 - c01*c10*c22*c33*c44 + c01*c10*c22*c34*c43 + c01*c10*c23*c32*c44 - c01*c10*c23*c34*c42 - c01*c10*c24*c32*c43 + c01*c10*c24*c33*c42 + c01*c12*c20*c33*c44 - c01*c12*c20*c34*c43 - c01*c12*c23*c30*c44 + c01*c12*c23*c34*c40 + c01*c12*c24*c30*c43 - c01*c12*c24*c33*c40 - c01*c13*c20*c32*c44 + c01*c13*c20*c34*c42 + c01*c13*c22*c30*c44 - c01*c13*c22*c34*c40 - c01*c13*c24*c30*c42 + c01*c13*c24*c32*c40 + c01*c14*c20*c32*c43 - c01*c14*c20*c33*c42 - c01*c14*c22*c30*c43 + c01*c14*c22*c33*c40 + c01*c14*c23*c30*c42 - c01*c14*c23*c32*c40 + c02*c10*c21*c33*c44 - c02*c10*c21*c34*c43 - c02*c10*c23*c31*c44 + c02*c10*c23*c34*c41 + c02*c10*c24*c31*c43 - c02*c10*c24*c33*c41 - c02*c11*c20*c33*c44 + c02*c11*c20*c34*c43 + c02*c11*c23*c30*c44 - c02*c11*c23*c34*c40 - c02*c11*c24*c30*c43 + c02*c11*c24*c33*c40 + c02*c13*c20*c31*c44 - c02*c13*c20*c34*c41 - c02*c13*c21*c30*c44 + c02*c13*c21*c34*c40 + c02*c13*c24*c30*c41 - c02*c13*c24*c31*c40 - c02*c14*c20*c31*c43 + c02*c14*c20*c33*c41 + c02*c14*c21*c30*c43 - c02*c14*c21*c33*c40 - c02*c14*c23*c30*c41 + c02*c14*c23*c31*c40 - c03*c10*c21*c32*c44 + c03*c10*c21*c34*c42 + c03*c10*c22*c31*c44 - c03*c10*c22*c34*c41 - c03*c10*c24*c31*c42 + c03*c10*c24*c32*c41 + c03*c11*c20*c32*c44 - c03*c11*c20*c34*c42 - c03*c11*c22*c30*c44 + c03*c11*c22*c34*c40 + c03*c11*c24*c30*c42 - c03*c11*c24*c32*c40 - c03*c12*c20*c31*c44 + c03*c12*c20*c34*c41 + c03*c12*c21*c30*c44 - c03*c12*c21*c34*c40 - c03*c12*c24*c30*c41 + c03*c12*c24*c31*c40 + c03*c14*c20*c31*c42 - c03*c14*c20*c32*c41 - c03*c14*c21*c30*c42 + c03*c14*c21*c32*c40 + c03*c14*c22*c30*c41 - c03*c14*c22*c31*c40 + c04*c10*c21*c32*c43 - c04*c10*c21*c33*c42 - c04*c10*c22*c31*c43 + c04*c10*c22*c33*c41 + c04*c10*c23*c31*c42 - c04*c10*c23*c32*c41 - c04*c11*c20*c32*c43 + c04*c11*c20*c33*c42 + c04*c11*c22*c30*c43 - c04*c11*c22*c33*c40 - c04*c11*c23*c30*c42 + c04*c11*c23*c32*c40 + c04*c12*c20*c31*c43 - c04*c12*c20*c33*c41 - c04*c12*c21*c30*c43 + c04*c12*c21*c33*c40 + c04*c12*c23*c30*c41 - c04*c12*c23*c31*c40 - c04*c13*c20*c31*c42 + c04*c13*c20*c32*c41 + c04*c13*c21*c30*c42 - c04*c13*c21*c32*c40 - c04*c13*c22*c30*c41 + c04*c13*c22*c31*c40).toShort() +} + +/** + * Automatically generated concrete matrix determinant finder. If no mapping exist, this function returns null + */ +fun matrixConcreteDeterminant(matrix: IMatrixGetterShort): Short? { + require(matrix.columns == matrix.rows) { "Provided matrix (${matrix.columns}x${matrix.rows}) is not a square matrix" } + return when (matrix.columns) { + 2 -> determinant2(matrix) + 3 -> determinant3(matrix) + 4 -> determinant4(matrix) + 5 -> determinant5(matrix) + else -> null + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix2d.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix2d.kt new file mode 100644 index 00000000..ba3b8ac4 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix2d.kt @@ -0,0 +1,228 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.matrix.ndouble + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.api.concrete.IMatrix2d +import ru.dbotthepony.kvector.narray.Double2Dimensional +import ru.dbotthepony.kvector.vector.ndouble.MutableVector2d +import ru.dbotthepony.kvector.vector.ndouble.Vector2d + +/** + * Represents immutable concrete matrix with 2x2 dimensions, storing values as [Double]s. + * + * See [Matrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [Vector2d], generic interface is represented by [IMatrix2d]. + * + * It does *not* implement [ISquareMatrix] since it doesn't make much sense. + */ +class Matrix2d : AbstractMatrixVd, IMatrix2d { + constructor( + c00: Double = 1.0, c01: Double = 0.0, + c10: Double = 0.0, c11: Double = 1.0, + ) : super(2, 2, Double2Dimensional(2, 2).also { + it[0, 0] = c00 + it[1, 0] = c10 + + it[0, 1] = c01 + it[1, 1] = c11 + }) + + private constructor(memory: Double2Dimensional) : super(2, 2, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Double2Dimensional): Matrix2d { + requireSizeEquals(memory) + return Matrix2d(memory) + } + + override val c00: Double get() = memory[0, 0] + override val c10: Double get() = memory[1, 0] + override val c01: Double get() = memory[0, 1] + override val c11: Double get() = memory[1, 1] + + override val r00 by this::c00 + override val r01 by this::c10 + override val r10 by this::c01 + override val r11 by this::c11 + + override val a11 by this::c00 + override val a21 by this::c01 + override val a12 by this::c10 + override val a22 by this::c11 + + override val b11 by this::c00 + override val b21 by this::c10 + override val b12 by this::c01 + override val b22 by this::c11 + + override val c0: Vector2d get() = Vector2d(c00, c01) + override val c1: Vector2d get() = Vector2d(c10, c11) + + override val r0: Vector2d get() = Vector2d(r00, r01) + override val r1: Vector2d get() = Vector2d(r10, r11) + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Double = 1.0, r01: Double = 0.0, + r10: Double = 0.0, r11: Double = 1.0, + ): Matrix2d { + return Matrix2d( + c00 = r00, c10 = r01, + c01 = r10, c11 = r11, + ) + } + + /** + * Initializes new zero matrix. + * + * Since [Matrix2d] is immutable, it is encouraged you use [ZERO] property instead. + */ + fun zero(): Matrix2d { + return Matrix2d( + c00 = 0.0, c10 = 0.0, + c01 = 0.0, c11 = 0.0, + ) + } + + /** + * All values of this matrix are zero + */ + @JvmField val ZERO = zero() + + /** + * Main diagonal of this matrix is 1s + */ + @JvmField val IDENTITY = Matrix2d() + } +} + +/** + * Represents mutable concrete matrix with 2x2 dimensions, storing values as [Double]s. + * + * See [MutableMatrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [MutableVector2d], generic interface is represented by [IMatrix2d]. + * + * It does *not* implement [ISquareMatrix] since it doesn't make much sense. + */ +class MutableMatrix2d : AbstractMutableMatrixVd, IMatrix2d { + constructor( + c00: Double = 1.0, c01: Double = 0.0, + c10: Double = 0.0, c11: Double = 1.0, + ) : super(2, 2, Double2Dimensional(2, 2).also { + it[0, 0] = c00 + it[1, 0] = c10 + + it[0, 1] = c01 + it[1, 1] = c11 + }) + + private constructor(memory: Double2Dimensional) : super(2, 2, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Double2Dimensional): MutableMatrix2d { + requireSizeEquals(memory) + return MutableMatrix2d(memory) + } + + override var c00: Double + get() = memory[0, 0] + set(value) { memory[0, 0] = value } + override var c10: Double + get() = memory[1, 0] + set(value) { memory[1, 0] = value } + override var c01: Double + get() = memory[0, 1] + set(value) { memory[0, 1] = value } + override var c11: Double + get() = memory[1, 1] + set(value) { memory[1, 1] = value } + + override var r00 by this::c00 + override var r01 by this::c10 + override var r10 by this::c01 + override var r11 by this::c11 + + override var a11 by this::c00 + override var a21 by this::c01 + override var a12 by this::c10 + override var a22 by this::c11 + + override var b11 by this::c00 + override var b21 by this::c10 + override var b12 by this::c01 + override var b22 by this::c11 + + override var c0: Vector2d + get() = object : MutableVector2d(c00, c01) { + override var x by this@MutableMatrix2d::c00 + override var y by this@MutableMatrix2d::c01 + } + set(value) { + c00 = value.x + c01 = value.y + } + override var c1: Vector2d + get() = object : MutableVector2d(c10, c11) { + override var x by this@MutableMatrix2d::c10 + override var y by this@MutableMatrix2d::c11 + } + set(value) { + c10 = value.x + c11 = value.y + } + + override var r0: Vector2d + get() = object : MutableVector2d(r00, r01) { + override var x by this@MutableMatrix2d::r00 + override var y by this@MutableMatrix2d::r01 + } + set(value) { + r00 = value.x + r01 = value.y + } + override var r1: Vector2d + get() = object : MutableVector2d(r10, r11) { + override var x by this@MutableMatrix2d::r10 + override var y by this@MutableMatrix2d::r11 + } + set(value) { + r10 = value.x + r11 = value.y + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Double = 1.0, r01: Double = 0.0, + r10: Double = 0.0, r11: Double = 1.0, + ): MutableMatrix2d { + return MutableMatrix2d( + c00 = r00, c10 = r01, + c01 = r10, c11 = r11, + ) + } + + /** + * Initializes new zero matrix. + */ + fun zero(): MutableMatrix2d { + return MutableMatrix2d( + c00 = 0.0, c10 = 0.0, + c01 = 0.0, c11 = 0.0, + ) + } + } +} \ No newline at end of file diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix3d.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix3d.kt new file mode 100644 index 00000000..e42ef346 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix3d.kt @@ -0,0 +1,393 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.matrix.ndouble + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.api.concrete.IMatrix3d +import ru.dbotthepony.kvector.narray.Double2Dimensional +import ru.dbotthepony.kvector.vector.ndouble.* + +/** + * Represents immutable concrete matrix with 3x3 dimensions, storing values as [Double]s. + * + * See [Matrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [Vector3d], generic interface is represented by [IMatrix3d]. + */ +class Matrix3d : AbstractMatrixVd, IMatrix3d { + constructor( + c00: Double = 1.0, c01: Double = 0.0, c02: Double = 0.0, + c10: Double = 0.0, c11: Double = 1.0, c12: Double = 0.0, + c20: Double = 0.0, c21: Double = 0.0, c22: Double = 1.0, + ) : super(3, 3, Double2Dimensional(3, 3).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + }) + + private constructor(memory: Double2Dimensional) : super(3, 3, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Double2Dimensional): Matrix3d { + requireSizeEquals(memory) + return Matrix3d(memory) + } + + override val c00: Double get() = memory[0, 0] + override val c10: Double get() = memory[1, 0] + override val c20: Double get() = memory[2, 0] + override val c01: Double get() = memory[0, 1] + override val c11: Double get() = memory[1, 1] + override val c21: Double get() = memory[2, 1] + override val c02: Double get() = memory[0, 2] + override val c12: Double get() = memory[1, 2] + override val c22: Double get() = memory[2, 2] + + override val r00 by this::c00 + override val r01 by this::c10 + override val r02 by this::c20 + override val r10 by this::c01 + override val r11 by this::c11 + override val r12 by this::c21 + override val r20 by this::c02 + override val r21 by this::c12 + override val r22 by this::c22 + + override val a11 by this::c00 + override val a21 by this::c01 + override val a31 by this::c02 + override val a12 by this::c10 + override val a22 by this::c11 + override val a32 by this::c12 + override val a13 by this::c20 + override val a23 by this::c21 + override val a33 by this::c22 + + override val b11 by this::c00 + override val b21 by this::c10 + override val b31 by this::c20 + override val b12 by this::c01 + override val b22 by this::c11 + override val b32 by this::c21 + override val b13 by this::c02 + override val b23 by this::c12 + override val b33 by this::c22 + + override val c0: Vector3d get() = Vector3d(c00, c01, c02) + override val c1: Vector3d get() = Vector3d(c10, c11, c12) + override val c2: Vector3d get() = Vector3d(c20, c21, c22) + + override val r0: Vector3d get() = Vector3d(r00, r01, r02) + override val r1: Vector3d get() = Vector3d(r10, r11, r12) + override val r2: Vector3d get() = Vector3d(r20, r21, r22) + + override fun translate(vector: Vector2d): Matrix3d { + return rm( + r00, r01, r02 + vector.x, + r10, r11, r12 + vector.y, + r20, r21, r22, + ) + } + + override fun translateWithMultiplication(vector: Vector2d): Matrix3d { + return rm( + r00, r01, r02 + vector.x * r00 + vector.y * r01, + r10, r11, r12 + vector.x * r10 + vector.y * r11, + r20, r21, r22, + ) + } + + override fun scale(vector: Vector2d): Matrix3d { + return rm( + r00 * vector.x, r01, r02, + r10, r11 * vector.y, r12, + r20, r21, r22 + ) + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Double = 1.0, r01: Double = 0.0, r02: Double = 0.0, + r10: Double = 0.0, r11: Double = 1.0, r12: Double = 0.0, + r20: Double = 0.0, r21: Double = 0.0, r22: Double = 1.0, + ): Matrix3d { + return Matrix3d( + c00 = r00, c10 = r01, c20 = r02, + c01 = r10, c11 = r11, c21 = r12, + c02 = r20, c12 = r21, c22 = r22, + ) + } + + /** + * Initializes new zero matrix. + * + * Since [Matrix3d] is immutable, it is encouraged you use [ZERO] property instead. + */ + fun zero(): Matrix3d { + return Matrix3d( + c00 = 0.0, c10 = 0.0, c20 = 0.0, + c01 = 0.0, c11 = 0.0, c21 = 0.0, + c02 = 0.0, c12 = 0.0, c22 = 0.0, + ) + } + + /** + * All values of this matrix are zero + */ + @JvmField val ZERO = zero() + + /** + * Main diagonal of this matrix is 1s + */ + @JvmField val IDENTITY = Matrix3d() + } +} + +/** + * Represents mutable concrete matrix with 3x3 dimensions, storing values as [Double]s. + * + * See [MutableMatrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [MutableVector3d], generic interface is represented by [IMatrix3d]. + */ +class MutableMatrix3d : AbstractMutableMatrixVd, IMatrix3d, IMutableSquareMatrix { + constructor( + c00: Double = 1.0, c01: Double = 0.0, c02: Double = 0.0, + c10: Double = 0.0, c11: Double = 1.0, c12: Double = 0.0, + c20: Double = 0.0, c21: Double = 0.0, c22: Double = 1.0, + ) : super(3, 3, Double2Dimensional(3, 3).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + }) + + private constructor(memory: Double2Dimensional) : super(3, 3, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Double2Dimensional): MutableMatrix3d { + requireSizeEquals(memory) + return MutableMatrix3d(memory) + } + + override fun translateWithMultiplicationMut(vector: Vector2d): MutableMatrix3d { + r02 += vector.x * r00 + vector.y * r01 + r12 += vector.x * r10 + vector.y * r11 + return this + } + + override fun scaleMut(vector: Vector2d): MutableMatrix3d { + r00 *= vector.x + r11 *= vector.y + return this + } + + override var c00: Double + get() = memory[0, 0] + set(value) { memory[0, 0] = value } + override var c10: Double + get() = memory[1, 0] + set(value) { memory[1, 0] = value } + override var c20: Double + get() = memory[2, 0] + set(value) { memory[2, 0] = value } + override var c01: Double + get() = memory[0, 1] + set(value) { memory[0, 1] = value } + override var c11: Double + get() = memory[1, 1] + set(value) { memory[1, 1] = value } + override var c21: Double + get() = memory[2, 1] + set(value) { memory[2, 1] = value } + override var c02: Double + get() = memory[0, 2] + set(value) { memory[0, 2] = value } + override var c12: Double + get() = memory[1, 2] + set(value) { memory[1, 2] = value } + override var c22: Double + get() = memory[2, 2] + set(value) { memory[2, 2] = value } + + override var r00 by this::c00 + override var r01 by this::c10 + override var r02 by this::c20 + override var r10 by this::c01 + override var r11 by this::c11 + override var r12 by this::c21 + override var r20 by this::c02 + override var r21 by this::c12 + override var r22 by this::c22 + + override var a11 by this::c00 + override var a21 by this::c01 + override var a31 by this::c02 + override var a12 by this::c10 + override var a22 by this::c11 + override var a32 by this::c12 + override var a13 by this::c20 + override var a23 by this::c21 + override var a33 by this::c22 + + override var b11 by this::c00 + override var b21 by this::c10 + override var b31 by this::c20 + override var b12 by this::c01 + override var b22 by this::c11 + override var b32 by this::c21 + override var b13 by this::c02 + override var b23 by this::c12 + override var b33 by this::c22 + + override var translation: Vector2d + get() = super.translation + set(value) { + r02 = value.x + r12 = value.y + } + + override var c0: Vector3d + get() = object : MutableVector3d(c00, c01, c02) { + override var x by this@MutableMatrix3d::c00 + override var y by this@MutableMatrix3d::c01 + override var z by this@MutableMatrix3d::c02 + } + set(value) { + c00 = value.x + c01 = value.y + c02 = value.z + } + override var c1: Vector3d + get() = object : MutableVector3d(c10, c11, c12) { + override var x by this@MutableMatrix3d::c10 + override var y by this@MutableMatrix3d::c11 + override var z by this@MutableMatrix3d::c12 + } + set(value) { + c10 = value.x + c11 = value.y + c12 = value.z + } + override var c2: Vector3d + get() = object : MutableVector3d(c20, c21, c22) { + override var x by this@MutableMatrix3d::c20 + override var y by this@MutableMatrix3d::c21 + override var z by this@MutableMatrix3d::c22 + } + set(value) { + c20 = value.x + c21 = value.y + c22 = value.z + } + + override var r0: Vector3d + get() = object : MutableVector3d(r00, r01, r02) { + override var x by this@MutableMatrix3d::r00 + override var y by this@MutableMatrix3d::r01 + override var z by this@MutableMatrix3d::r02 + } + set(value) { + r00 = value.x + r01 = value.y + r02 = value.z + } + override var r1: Vector3d + get() = object : MutableVector3d(r10, r11, r12) { + override var x by this@MutableMatrix3d::r10 + override var y by this@MutableMatrix3d::r11 + override var z by this@MutableMatrix3d::r12 + } + set(value) { + r10 = value.x + r11 = value.y + r12 = value.z + } + override var r2: Vector3d + get() = object : MutableVector3d(r20, r21, r22) { + override var x by this@MutableMatrix3d::r20 + override var y by this@MutableMatrix3d::r21 + override var z by this@MutableMatrix3d::r22 + } + set(value) { + r20 = value.x + r21 = value.y + r22 = value.z + } + + override fun translate(vector: Vector2d): MutableMatrix3d { + return rm( + r00, r01, r02 + vector.x, + r10, r11, r12 + vector.y, + r20, r21, r22, + ) + } + + override fun translateWithMultiplication(vector: Vector2d): MutableMatrix3d { + return rm( + r00, r01, r02 + vector.x * r00 + vector.y * r01, + r10, r11, r12 + vector.x * r10 + vector.y * r11, + r20, r21, r22, + ) + } + + override fun scale(vector: Vector2d): MutableMatrix3d { + return rm( + r00 * vector.x, r01, r02, + r10, r11 * vector.y, r12, + r20, r21, r22 + ) + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Double = 1.0, r01: Double = 0.0, r02: Double = 0.0, + r10: Double = 0.0, r11: Double = 1.0, r12: Double = 0.0, + r20: Double = 0.0, r21: Double = 0.0, r22: Double = 1.0, + ): MutableMatrix3d { + return MutableMatrix3d( + c00 = r00, c10 = r01, c20 = r02, + c01 = r10, c11 = r11, c21 = r12, + c02 = r20, c12 = r21, c22 = r22, + ) + } + + /** + * Initializes new zero matrix. + */ + fun zero(): MutableMatrix3d { + return MutableMatrix3d( + c00 = 0.0, c10 = 0.0, c20 = 0.0, + c01 = 0.0, c11 = 0.0, c21 = 0.0, + c02 = 0.0, c12 = 0.0, c22 = 0.0, + ) + } + } +} + diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix4d.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix4d.kt new file mode 100644 index 00000000..70fba7ad --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/Matrix4d.kt @@ -0,0 +1,569 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.matrix.ndouble + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.api.concrete.IMatrix4d +import ru.dbotthepony.kvector.matrix.ndouble.Matrix4d.Companion.ZERO +import ru.dbotthepony.kvector.matrix.ndouble.Matrix4d.Companion.rm +import ru.dbotthepony.kvector.matrix.ndouble.MutableMatrix4d.Companion.rm +import ru.dbotthepony.kvector.narray.Double2Dimensional +import ru.dbotthepony.kvector.vector.ndouble.MutableVector4d +import ru.dbotthepony.kvector.vector.ndouble.Vector3d +import ru.dbotthepony.kvector.vector.ndouble.Vector4d + +/** + * Represents immutable concrete matrix with 4x4 dimensions, storing values as [Double]s. + * + * Primary constructor accept values in *Column-Major* order, that is, first row of values + * is first column in matrix. For *Row-Major* constructor, you should use [rm] + * companion object method. + * + * By default, primary constructor initialize identity matrix, e.g. main diagonal set to 1s. + * + * Matrices have multiple sets of properties to access values stored, for convenience of use: + * - rXY - access row X and column Y + * - cXY - access column X and row Y + * - aXY - access row X and column Y, but indices start from 1 + * - bXY - access column X and row Y, but indices start from 1 + * - cX - access column X as [Vector4d] + * - rX - access row X as [Vector4d] + * + * **If you don't care about mutability of matrix your method want to accept, use [IMatrix4d]**, + * because [MutableMatrix4d] is not a subtype of [Matrix4d], but they both are subtype of [IMatrix4d]. + */ +class Matrix4d : AbstractMatrixVd, IMatrix4d { + constructor( + c00: Double = 1.0, c01: Double = 0.0, c02: Double = 0.0, c03: Double = 0.0, + c10: Double = 0.0, c11: Double = 1.0, c12: Double = 0.0, c13: Double = 0.0, + c20: Double = 0.0, c21: Double = 0.0, c22: Double = 1.0, c23: Double = 0.0, + c30: Double = 0.0, c31: Double = 0.0, c32: Double = 0.0, c33: Double = 1.0, + ) : super(4, 4, Double2Dimensional(4, 4).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + it[3, 0] = c30 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + it[3, 1] = c31 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + it[3, 2] = c32 + + it[0, 3] = c03 + it[1, 3] = c13 + it[2, 3] = c23 + it[3, 3] = c33 + }) + + private constructor(memory: Double2Dimensional) : super(4, 4, memory) + override val flexible: Boolean = false + + override val c00: Double get() = memory[0, 0] + override val c10: Double get() = memory[1, 0] + override val c20: Double get() = memory[2, 0] + override val c30: Double get() = memory[3, 0] + override val c01: Double get() = memory[0, 1] + override val c11: Double get() = memory[1, 1] + override val c21: Double get() = memory[2, 1] + override val c31: Double get() = memory[3, 1] + override val c02: Double get() = memory[0, 2] + override val c12: Double get() = memory[1, 2] + override val c22: Double get() = memory[2, 2] + override val c32: Double get() = memory[3, 2] + override val c03: Double get() = memory[0, 3] + override val c13: Double get() = memory[1, 3] + override val c23: Double get() = memory[2, 3] + override val c33: Double get() = memory[3, 3] + + override val r00 by this::c00 + override val r01 by this::c10 + override val r02 by this::c20 + override val r03 by this::c30 + override val r10 by this::c01 + override val r11 by this::c11 + override val r12 by this::c21 + override val r13 by this::c31 + override val r20 by this::c02 + override val r21 by this::c12 + override val r22 by this::c22 + override val r23 by this::c32 + override val r30 by this::c03 + override val r31 by this::c13 + override val r32 by this::c23 + override val r33 by this::c33 + + override val a11 by this::c00 + override val a21 by this::c01 + override val a31 by this::c02 + override val a41 by this::c03 + override val a12 by this::c10 + override val a22 by this::c11 + override val a32 by this::c12 + override val a42 by this::c13 + override val a13 by this::c20 + override val a23 by this::c21 + override val a33 by this::c22 + override val a43 by this::c23 + override val a14 by this::c30 + override val a24 by this::c31 + override val a34 by this::c32 + override val a44 by this::c33 + + override val b11 by this::c00 + override val b21 by this::c10 + override val b31 by this::c20 + override val b41 by this::c30 + override val b12 by this::c01 + override val b22 by this::c11 + override val b32 by this::c21 + override val b42 by this::c31 + override val b13 by this::c02 + override val b23 by this::c12 + override val b33 by this::c22 + override val b43 by this::c32 + override val b14 by this::c03 + override val b24 by this::c13 + override val b34 by this::c23 + override val b44 by this::c33 + + override val c0: Vector4d get() = Vector4d(c00, c01, c02, c03) + override val c1: Vector4d get() = Vector4d(c10, c11, c12, c13) + override val c2: Vector4d get() = Vector4d(c20, c21, c22, c23) + override val c3: Vector4d get() = Vector4d(c30, c31, c32, c33) + + override val r0: Vector4d get() = Vector4d(r00, r01, r02, r03) + override val r1: Vector4d get() = Vector4d(r10, r11, r12, r13) + override val r2: Vector4d get() = Vector4d(r20, r21, r22, r23) + override val r3: Vector4d get() = Vector4d(r30, r31, r32, r33) + + override fun factorize(memory: Double2Dimensional): Matrix4d { + requireSizeEquals(memory) + return Matrix4d(memory) + } + + override fun translate(vector: Vector3d): Matrix4d { + return rm( + r00, r01, r02, r03 + vector.x, + r10, r11, r12, r13 + vector.y, + r20, r21, r22, r23 + vector.z, + r30, r31, r32, r33, + ) + } + + override fun translateWithMultiplication(vector: Vector3d): Matrix4d { + return rm( + r00, r01, r02, r03 + vector.x * r00 + vector.y * r01 + vector.z * r02, + r10, r11, r12, r13 + vector.x * r10 + vector.y * r11 + vector.z * r12, + r20, r21, r22, r23 + vector.x * r20 + vector.y * r21 + vector.z * r22, + r30, r31, r32, r33, + ) + } + + override fun scale(vector: Vector3d): Matrix4d { + return rm( + r00 * vector.x, r01, r02, r03, + r10, r11 * vector.y, r12, r13, + r20, r21, r22 * vector.z, r23, + r30, r31, r32, r33, + ) + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Double = 1.0, r01: Double = 0.0, r02: Double = 0.0, r03: Double = 0.0, + r10: Double = 0.0, r11: Double = 1.0, r12: Double = 0.0, r13: Double = 0.0, + r20: Double = 0.0, r21: Double = 0.0, r22: Double = 1.0, r23: Double = 0.0, + r30: Double = 0.0, r31: Double = 0.0, r32: Double = 0.0, r33: Double = 1.0, + ): Matrix4d { + return Matrix4d( + c00 = r00, c10 = r01, c20 = r02, c30 = r03, + c01 = r10, c11 = r11, c21 = r12, c31 = r13, + c02 = r20, c12 = r21, c22 = r22, c32 = r23, + c03 = r30, c13 = r31, c23 = r32, c33 = r33, + ) + } + + /** + * Initializes new zero matrix. + * + * Since [Matrix4d] is immutable, it is encouraged you use [ZERO] property instead. + */ + fun zero(): Matrix4d { + return Matrix4d( + c00 = 0.0, c10 = 0.0, c20 = 0.0, c30 = 0.0, + c01 = 0.0, c11 = 0.0, c21 = 0.0, c31 = 0.0, + c02 = 0.0, c12 = 0.0, c22 = 0.0, c32 = 0.0, + c03 = 0.0, c13 = 0.0, c23 = 0.0, c33 = 0.0, + ) + } + + /** + * All values of this matrix are zero + */ + @JvmField val ZERO = zero() + + /** + * Main diagonal of this matrix is 1s + */ + @JvmField val IDENTITY = Matrix4d() + } +} + +/** + * Represents mutable concrete matrix with 4x4 dimensions, storing values as [Double]s + * + * Primary constructor accept values in *Column-Major* order, that is, first row of values + * is first column in matrix. For *Row-Major* constructor, you should use [rm] + * companion object method. + * + * Same notes about properties of [Matrix4d] apply. + * + * **This class is not a subclass of [Matrix4d]**, but a subclass of [IMatrix4d]. + * + * Differences: + * - All properties are mutable + * - Vectorized access return [MutableVector4d], which actually reflect columns/rows of this matrix. + * That is, any changes done to matrix will be instantly reflected by vector, and any changes to vector + * will be reflected in matrix. + * - Vectorized access has setter, and when writing [Vector4d] to it, it will update associated column/row values + * + */ +class MutableMatrix4d : AbstractMutableMatrixVd, IMatrix4d, IMutableSquareMatrix { + constructor( + c00: Double = 1.0, c01: Double = 0.0, c02: Double = 0.0, c03: Double = 0.0, + c10: Double = 0.0, c11: Double = 1.0, c12: Double = 0.0, c13: Double = 0.0, + c20: Double = 0.0, c21: Double = 0.0, c22: Double = 1.0, c23: Double = 0.0, + c30: Double = 0.0, c31: Double = 0.0, c32: Double = 0.0, c33: Double = 1.0, + ) : super(4, 4, Double2Dimensional(4, 4).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + it[3, 0] = c30 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + it[3, 1] = c31 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + it[3, 2] = c32 + + it[0, 3] = c03 + it[1, 3] = c13 + it[2, 3] = c23 + it[3, 3] = c33 + }) + + private constructor(memory: Double2Dimensional) : super(4, 4, memory) + override val flexible: Boolean = false + + override fun factorize(memory: Double2Dimensional): MutableMatrix4d { + requireSizeEquals(memory) + return MutableMatrix4d(memory) + } + + override fun translate(vector: Vector3d): MutableMatrix4d { + return rm( + r00, r01, r02, r03 + vector.x, + r10, r11, r12, r13 + vector.y, + r20, r21, r22, r23 + vector.z, + r30, r31, r32, r33, + ) + } + + override fun translateWithMultiplication(vector: Vector3d): MutableMatrix4d { + return rm( + r00, r01, r02, r03 + vector.x * r00 + vector.y * r01 + vector.z * r02, + r10, r11, r12, r13 + vector.x * r10 + vector.y * r11 + vector.z * r12, + r20, r21, r22, r23 + vector.x * r20 + vector.y * r21 + vector.z * r22, + r30, r31, r32, r33, + ) + } + + override fun scale(vector: Vector3d): MutableMatrix4d { + return rm( + r00 * vector.x, r01, r02, r03, + r10, r11 * vector.y, r12, r13, + r20, r21, r22 * vector.z, r23, + r30, r31, r32, r33, + ) + } + + override fun translateWithMultiplicationMut(vector: Vector3d): MutableMatrix4d { + r03 += vector.x * r00 + vector.y * r01 + vector.z * r02 + r13 += vector.x * r10 + vector.y * r11 + vector.z * r12 + r23 += vector.x * r20 + vector.y * r21 + vector.z * r22 + return this + } + + override fun scaleMut(vector: Vector3d): MutableMatrix4d { + c00 *= vector.x + c11 *= vector.y + c22 *= vector.z + return this + } + + override var translation: Vector3d + get() = super.translation + set(value) { + r03 = value.x + r13 = value.y + r23 = value.z + } + + override var c00: Double + get() = memory[0, 0] + set(value) { memory[0, 0] = value } + override var c10: Double + get() = memory[1, 0] + set(value) { memory[1, 0] = value } + override var c20: Double + get() = memory[2, 0] + set(value) { memory[2, 0] = value } + override var c30: Double + get() = memory[3, 0] + set(value) { memory[3, 0] = value } + override var c01: Double + get() = memory[0, 1] + set(value) { memory[0, 1] = value } + override var c11: Double + get() = memory[1, 1] + set(value) { memory[1, 1] = value } + override var c21: Double + get() = memory[2, 1] + set(value) { memory[2, 1] = value } + override var c31: Double + get() = memory[3, 1] + set(value) { memory[3, 1] = value } + override var c02: Double + get() = memory[0, 2] + set(value) { memory[0, 2] = value } + override var c12: Double + get() = memory[1, 2] + set(value) { memory[1, 2] = value } + override var c22: Double + get() = memory[2, 2] + set(value) { memory[2, 2] = value } + override var c32: Double + get() = memory[3, 2] + set(value) { memory[3, 2] = value } + override var c03: Double + get() = memory[0, 3] + set(value) { memory[0, 3] = value } + override var c13: Double + get() = memory[1, 3] + set(value) { memory[1, 3] = value } + override var c23: Double + get() = memory[2, 3] + set(value) { memory[2, 3] = value } + override var c33: Double + get() = memory[3, 3] + set(value) { memory[3, 3] = value } + + override var r00 by this::c00 + override var r01 by this::c10 + override var r02 by this::c20 + override var r03 by this::c30 + override var r10 by this::c01 + override var r11 by this::c11 + override var r12 by this::c21 + override var r13 by this::c31 + override var r20 by this::c02 + override var r21 by this::c12 + override var r22 by this::c22 + override var r23 by this::c32 + override var r30 by this::c03 + override var r31 by this::c13 + override var r32 by this::c23 + override var r33 by this::c33 + + override var a11 by this::c00 + override var a21 by this::c01 + override var a31 by this::c02 + override var a41 by this::c03 + override var a12 by this::c10 + override var a22 by this::c11 + override var a32 by this::c12 + override var a42 by this::c13 + override var a13 by this::c20 + override var a23 by this::c21 + override var a33 by this::c22 + override var a43 by this::c23 + override var a14 by this::c30 + override var a24 by this::c31 + override var a34 by this::c32 + override var a44 by this::c33 + + override var b11 by this::c00 + override var b21 by this::c01 + override var b31 by this::c02 + override var b41 by this::c03 + override var b12 by this::c10 + override var b22 by this::c11 + override var b32 by this::c12 + override var b42 by this::c13 + override var b13 by this::c20 + override var b23 by this::c21 + override var b33 by this::c22 + override var b43 by this::c23 + override var b14 by this::c30 + override var b24 by this::c31 + override var b34 by this::c32 + override var b44 by this::c33 + + override var c0: Vector4d + get() = object : MutableVector4d(c00, c01, c02, c03) { + override var x by this@MutableMatrix4d::c00 + override var y by this@MutableMatrix4d::c01 + override var z by this@MutableMatrix4d::c02 + override var w by this@MutableMatrix4d::c03 + } + set(value) { + c00 = value.x + c01 = value.y + c02 = value.z + c03 = value.w + } + + override var c1: Vector4d + get() = object : MutableVector4d(c10, c11, c12, c13) { + override var x by this@MutableMatrix4d::c10 + override var y by this@MutableMatrix4d::c11 + override var z by this@MutableMatrix4d::c12 + override var w by this@MutableMatrix4d::c13 + } + set(value) { + c10 = value.x + c11 = value.y + c12 = value.z + c13 = value.w + } + + override var c2: Vector4d + get() = object : MutableVector4d(c20, c21, c22, c23) { + override var x by this@MutableMatrix4d::c20 + override var y by this@MutableMatrix4d::c21 + override var z by this@MutableMatrix4d::c22 + override var w by this@MutableMatrix4d::c23 + } + set(value) { + c20 = value.x + c21 = value.y + c22 = value.z + c23 = value.w + } + + override var c3: Vector4d + get() = object : MutableVector4d(c30, c31, c32, c33) { + override var x by this@MutableMatrix4d::c30 + override var y by this@MutableMatrix4d::c31 + override var z by this@MutableMatrix4d::c32 + override var w by this@MutableMatrix4d::c33 + } + set(value) { + c30 = value.x + c31 = value.y + c32 = value.z + c33 = value.w + } + + override var r0: Vector4d + get() = object : MutableVector4d(r00, r01, r02, r03) { + override var x by this@MutableMatrix4d::r00 + override var y by this@MutableMatrix4d::r01 + override var z by this@MutableMatrix4d::r02 + override var w by this@MutableMatrix4d::r03 + } + set(value) { + r00 = value.x + r01 = value.y + r02 = value.z + r03 = value.w + } + + override var r1: Vector4d + get() = object : MutableVector4d(r10, r11, r12, r13) { + override var x by this@MutableMatrix4d::r10 + override var y by this@MutableMatrix4d::r11 + override var z by this@MutableMatrix4d::r12 + override var w by this@MutableMatrix4d::r13 + } + set(value) { + r10 = value.x + r11 = value.y + r12 = value.z + r13 = value.w + } + + override var r2: Vector4d + get() = object : MutableVector4d(r20, r21, r22, r23) { + override var x by this@MutableMatrix4d::r20 + override var y by this@MutableMatrix4d::r21 + override var z by this@MutableMatrix4d::r22 + override var w by this@MutableMatrix4d::r23 + } + set(value) { + r20 = value.x + r21 = value.y + r22 = value.z + r23 = value.w + } + + override var r3: Vector4d + get() = object : MutableVector4d(r30, r31, r32, r33) { + override var x by this@MutableMatrix4d::r30 + override var y by this@MutableMatrix4d::r31 + override var z by this@MutableMatrix4d::r32 + override var w by this@MutableMatrix4d::r33 + } + set(value) { + r30 = value.x + r31 = value.y + r32 = value.z + r33 = value.w + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Double = 1.0, r01: Double = 0.0, r02: Double = 0.0, r03: Double = 0.0, + r10: Double = 0.0, r11: Double = 1.0, r12: Double = 0.0, r13: Double = 0.0, + r20: Double = 0.0, r21: Double = 0.0, r22: Double = 1.0, r23: Double = 0.0, + r30: Double = 0.0, r31: Double = 0.0, r32: Double = 0.0, r33: Double = 1.0, + ): MutableMatrix4d { + return MutableMatrix4d( + c00 = r00, c10 = r01, c20 = r02, c30 = r03, + c01 = r10, c11 = r11, c21 = r12, c31 = r13, + c02 = r20, c12 = r21, c22 = r22, c32 = r23, + c03 = r30, c13 = r31, c23 = r32, c33 = r33, + ) + } + + /** + * Initializes new mutable zero matrix. + */ + fun zero(): MutableMatrix4d { + return MutableMatrix4d( + c00 = 0.0, c10 = 0.0, c20 = 0.0, c30 = 0.0, + c01 = 0.0, c11 = 0.0, c21 = 0.0, c31 = 0.0, + c02 = 0.0, c12 = 0.0, c22 = 0.0, c32 = 0.0, + c03 = 0.0, c13 = 0.0, c23 = 0.0, c33 = 0.0, + ) + } + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/MatrixVd.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/MatrixVd.kt new file mode 100644 index 00000000..18986bf0 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/ndouble/MatrixVd.kt @@ -0,0 +1,316 @@ + +@file:Suppress("unchecked_cast", "unused") + +package ru.dbotthepony.kvector.matrix.ndouble + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.matrix.generated.MultiplicationsDouble +import ru.dbotthepony.kvector.matrix.matrixDeterminant +import ru.dbotthepony.kvector.matrix.multiplyMatrix +import ru.dbotthepony.kvector.matrix.transposeMatrix +import ru.dbotthepony.kvector.narray.Double2Dimensional + +private fun checkRows(value: Int): Int { + require(value > 0) { "Invalid amount of rows $value" } + return value +} + +private fun checkColumns(value: Int): Int { + require(value > 0) { "Invalid amount of columns $value" } + return value +} + +/** + * Abstract class with only one protected abstract method: [factorize]. + * + * This class is meant to be only internally overridden (to implement interfaces), but if you really need to, you can + * extend this class. + */ +abstract class AbstractMatrixVd> protected constructor( + final override val columns: Int, + final override val rows: Int, + @JvmField protected val memory: Double2Dimensional +) : IMatrix, IDoubleMatrix, ITransposable { + /** + * To avoid middle-object creation when deriving from [AbstractMatrixVd] ([MatrixVd]), this method + * allows to factory produce new instances of final class + */ + protected abstract fun factorize(memory: Double2Dimensional): T + protected open val flexible = true + + final override fun get(column: Int, row: Int): Double { + return memory[column, row] + } + + override fun plus(other: IMatrixGetterDouble): T { + requireSizeEquals(other) + + val result = Double2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] + other[column, row] + } + } + + return factorize(result) + } + + override fun minus(other: IMatrixGetterDouble): T { + requireSizeEquals(other) + + val result = Double2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] - other[column, row] + } + } + + return factorize(result) + } + + override fun times(other: IMatrixGetterDouble): T { + require(flexible || sizeEquals(other)) { "${this::class.qualifiedName} is not a flexible" } + val result = multiplyMatrix(this, other) + return factorize(result) + } + + override fun times(other: Double): T { + val result = Double2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] * other + } + } + + return factorize(result) + } + + override fun div(other: Double): T { + val result = Double2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] / other + } + } + + return factorize(result) + } + + override val transposed: T + get() { + val result = transposeMatrix(this) + return factorize(result) + } + + override val trace: Double? + get() { + if (!isSquareMatrix) + return null + + var calc = 0.0 + + for (i in 0 until rows) { + calc += memory[columns, rows] + } + + return calc + } + + override val determinant: Double? + get() { + if (!isSquareMatrix) + return null + + return matrixDeterminant(this) + } + + override val isFinite: Boolean + get() { + for (column in 0 until columns) { + for (row in 0 until rows) { + if (!memory[column, row].isFinite()) { + return false + } + } + } + + return true + } + + override val isNaN: Boolean + get() { + for (column in 0 until columns) { + for (row in 0 until rows) { + if (memory[column, row].isNaN()) { + return true + } + } + } + + return false + } +} + +/** + * Abstract class inheriting [AbstractMatrixVd], implementing mutating methods. + * + * This class is meant to be only internally overridden (to implement interfaces), but if you really need to, you can + * extend this class. + */ +abstract class AbstractMutableMatrixVd> protected constructor( + columns: Int, + rows: Int, + memory: Double2Dimensional +) : AbstractMatrixVd(columns, rows, memory), IMutableDoubleMatrix, IMutableTransposable { + final override fun set(column: Int, row: Int, value: Double) { + memory[column, row] = value + } + + override fun timesMut(other: Double): T { + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] *= other + } + } + + return this as T + } + + override fun divMut(other: Double): T { + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] /= other + } + } + + return this as T + } + + override fun timesMut(other: IMatrixGetterDouble): T { + requireSizeEquals(other) + + if (MultiplicationsDouble.multiplyMatrix(this, other, this) == null) { + val result = multiplyMatrix(this, other) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] = result[column, row] + } + } + } + + return this as T + } + + override fun plusMut(other: IMatrixGetterDouble): T { + requireSizeEquals(other) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] += other[column, row] + } + } + + return this as T + } + + override fun minusMut(other: IMatrixGetterDouble): T { + requireSizeEquals(other) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] -= other[column, row] + } + } + + return this as T + } + + override fun transpose(): T { + check(isSquareMatrix) { "This matrix is not a square matrix (${columns}x${rows})" } + + val result = transposeMatrix(this) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] = result[column, row] + } + } + + return this as T + } +} + +/** + * Represents immutable matrix with arbitrary dimensions, storing values as [Double]s, + * backed by [Double2Dimensional]. + * + * Matrix is initialized to zeros upon creation. + */ +open class MatrixVd protected constructor( + columns: Int, + rows: Int, + memory: Double2Dimensional +) : AbstractMatrixVd(columns, rows, memory) { + constructor(columns: Int, rows: Int) : this(checkColumns(columns), checkRows(rows), Double2Dimensional(checkColumns(columns), checkRows(rows))) + + override fun factorize(memory: Double2Dimensional): MatrixVd { + return MatrixVd(memory.columns, memory.rows, memory) + } + + companion object { + /** + * Copies specified matrix into new [MatrixVd] + */ + fun copy(input: IMatrixGetterDouble): MatrixVd { + val memory = Double2Dimensional(input.columns, input.rows) + + for (column in 0 until input.columns) { + for (row in 0 until input.rows) { + memory[column, row] = input[column, row] + } + } + + return MatrixVd(input.columns, input.rows, memory) + } + } +} + +/** + * Represents mutable matrix with arbitrary dimensions, storing values as [Double]s, + * backed by [Double2Dimensional]. + * + * Matrix is initialized to zeros upon creation. + */ +open class MutableMatrixVd protected constructor( + columns: Int, + rows: Int, + memory: Double2Dimensional +) : AbstractMutableMatrixVd(columns, rows, memory) { + constructor(columns: Int, rows: Int) : this(checkColumns(columns), checkRows(rows), Double2Dimensional(checkColumns(columns), checkRows(rows))) + + override fun factorize(memory: Double2Dimensional): MutableMatrixVd { + return MutableMatrixVd(memory.columns, memory.rows, memory) + } + + companion object { + /** + * Copies specified matrix into new [MutableMatrixVd] + */ + fun copy(input: IMatrixGetterDouble): MutableMatrixVd { + val memory = Double2Dimensional(input.columns, input.rows) + + for (column in 0 until input.columns) { + for (row in 0 until input.rows) { + memory[column, row] = input[column, row] + } + } + + return MutableMatrixVd(input.columns, input.rows, memory) + } + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix2f.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix2f.kt new file mode 100644 index 00000000..64263a40 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix2f.kt @@ -0,0 +1,226 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.matrix.nfloat + +import ru.dbotthepony.kvector.api.concrete.IMatrix2f +import ru.dbotthepony.kvector.narray.Float2Dimensional +import ru.dbotthepony.kvector.vector.nfloat.Vector2f +import ru.dbotthepony.kvector.matrix.ndouble.Matrix4d +import ru.dbotthepony.kvector.matrix.ndouble.MutableMatrix4d +import ru.dbotthepony.kvector.vector.nfloat.MutableVector2f + +/** + * Represents immutable concrete matrix with 2x2 dimensions, storing values as [Float]s. + * + * See [Matrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [Vector2f], generic interface is represented by [IMatrix2f]. + */ +class Matrix2f : AbstractMatrixVf, IMatrix2f { + constructor( + c00: Float = 1f, c01: Float = 0f, + c10: Float = 0f, c11: Float = 1f, + ) : super(2, 2, Float2Dimensional(2, 2).also { + it[0, 0] = c00 + it[1, 0] = c10 + + it[0, 1] = c01 + it[1, 1] = c11 + }) + + private constructor(memory: Float2Dimensional) : super(2, 2, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Float2Dimensional): Matrix2f { + requireSizeEquals(memory) + return Matrix2f(memory) + } + + override val c00: Float get() = memory[0, 0] + override val c10: Float get() = memory[1, 0] + override val c01: Float get() = memory[0, 1] + override val c11: Float get() = memory[1, 1] + + override val r00 by this::c00 + override val r01 by this::c10 + override val r10 by this::c01 + override val r11 by this::c11 + + override val a11 by this::c00 + override val a21 by this::c01 + override val a12 by this::c10 + override val a22 by this::c11 + + override val b11 by this::c00 + override val b21 by this::c10 + override val b12 by this::c01 + override val b22 by this::c11 + + override val c0: Vector2f get() = Vector2f(c00, c01) + override val c1: Vector2f get() = Vector2f(c10, c11) + + override val r0: Vector2f get() = Vector2f(r00, r01) + override val r1: Vector2f get() = Vector2f(r10, r11) + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Float = 1f, r01: Float = 0f, + r10: Float = 0f, r11: Float = 1f, + ): Matrix2f { + return Matrix2f( + c00 = r00, c10 = r01, + c01 = r10, c11 = r11, + ) + } + + /** + * Initializes new zero matrix. + * + * Since [Matrix2f] is immutable, it is encouraged you use [ZERO] property instead. + */ + fun zero(): Matrix2f { + return Matrix2f( + c00 = 0f, c10 = 0f, + c01 = 0f, c11 = 0f, + ) + } + + /** + * All values of this matrix are zero + */ + @JvmField val ZERO = zero() + + /** + * Main diagonal of this matrix is 1s + */ + @JvmField val IDENTITY = Matrix2f() + } +} + +/** + * Represents mutable concrete matrix with 2x2 dimensions, storing values as [Double]s. + * + * See [MutableMatrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [MutableVector2f], generic interface is represented by [IMatrix2f]. + */ +class MutableMatrix2f : AbstractMutableMatrixVf, IMatrix2f { + constructor( + c00: Float = 1f, c01: Float = 0f, + c10: Float = 0f, c11: Float = 1f, + ) : super(2, 2, Float2Dimensional(2, 2).also { + it[0, 0] = c00 + it[1, 0] = c10 + + it[0, 1] = c01 + it[1, 1] = c11 + }) + + private constructor(memory: Float2Dimensional) : super(2, 2, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Float2Dimensional): MutableMatrix2f { + requireSizeEquals(memory) + return MutableMatrix2f(memory) + } + + + override var c00: Float + get() = memory[0, 0] + set(value) { memory[0, 0] = value } + override var c10: Float + get() = memory[1, 0] + set(value) { memory[1, 0] = value } + override var c01: Float + get() = memory[0, 1] + set(value) { memory[0, 1] = value } + override var c11: Float + get() = memory[1, 1] + set(value) { memory[1, 1] = value } + + override var r00 by this::c00 + override var r01 by this::c10 + override var r10 by this::c01 + override var r11 by this::c11 + + override var a11 by this::c00 + override var a21 by this::c01 + override var a12 by this::c10 + override var a22 by this::c11 + + override var b11 by this::c00 + override var b21 by this::c10 + override var b12 by this::c01 + override var b22 by this::c11 + + override var c0: Vector2f + get() = object : MutableVector2f(c00, c01) { + override var x by this@MutableMatrix2f::c00 + override var y by this@MutableMatrix2f::c01 + } + set(value) { + c00 = value.x + c01 = value.y + } + override var c1: Vector2f + get() = object : MutableVector2f(c10, c11) { + override var x by this@MutableMatrix2f::c10 + override var y by this@MutableMatrix2f::c11 + } + set(value) { + c10 = value.x + c11 = value.y + } + + override var r0: Vector2f + get() = object : MutableVector2f(r00, r01) { + override var x by this@MutableMatrix2f::r00 + override var y by this@MutableMatrix2f::r01 + } + set(value) { + r00 = value.x + r01 = value.y + } + override var r1: Vector2f + get() = object : MutableVector2f(r10, r11) { + override var x by this@MutableMatrix2f::r10 + override var y by this@MutableMatrix2f::r11 + } + set(value) { + r10 = value.x + r11 = value.y + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Float = 1f, r01: Float = 0f, + r10: Float = 0f, r11: Float = 1f, + ): MutableMatrix2f { + return MutableMatrix2f( + c00 = r00, c10 = r01, + c01 = r10, c11 = r11, + ) + } + + /** + * Initializes new zero matrix. + */ + fun zero(): MutableMatrix2f { + return MutableMatrix2f( + c00 = 0f, c10 = 0f, + c01 = 0f, c11 = 0f, + ) + } + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix3f.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix3f.kt new file mode 100644 index 00000000..3b39c746 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix3f.kt @@ -0,0 +1,394 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.matrix.nfloat + +import ru.dbotthepony.kvector.api.IMutableSquareMatrix +import ru.dbotthepony.kvector.api.concrete.IMatrix3f +import ru.dbotthepony.kvector.matrix.ndouble.Matrix4d +import ru.dbotthepony.kvector.matrix.ndouble.MutableMatrix4d +import ru.dbotthepony.kvector.narray.Float2Dimensional +import ru.dbotthepony.kvector.vector.nfloat.* + +/** + * Represents immutable concrete matrix with 3x3 dimensions, storing values as [Float]s. + * + * See [Matrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [Vector3f], generic interface is represented by [IMatrix3f]. + */ +class Matrix3f : AbstractMatrixVf, IMatrix3f { + constructor( + c00: Float = 1f, c01: Float = 0f, c02: Float = 0f, + c10: Float = 0f, c11: Float = 1f, c12: Float = 0f, + c20: Float = 0f, c21: Float = 0f, c22: Float = 1f, + ) : super(3, 3, Float2Dimensional(3, 3).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + }) + + private constructor(memory: Float2Dimensional) : super(3, 3, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Float2Dimensional): Matrix3f { + requireSizeEquals(memory) + return Matrix3f(memory) + } + + override val c00: Float get() = memory[0, 0] + override val c10: Float get() = memory[1, 0] + override val c20: Float get() = memory[2, 0] + override val c01: Float get() = memory[0, 1] + override val c11: Float get() = memory[1, 1] + override val c21: Float get() = memory[2, 1] + override val c02: Float get() = memory[0, 2] + override val c12: Float get() = memory[1, 2] + override val c22: Float get() = memory[2, 2] + + override val r00 by this::c00 + override val r01 by this::c10 + override val r02 by this::c20 + override val r10 by this::c01 + override val r11 by this::c11 + override val r12 by this::c21 + override val r20 by this::c02 + override val r21 by this::c12 + override val r22 by this::c22 + + override val a11 by this::c00 + override val a21 by this::c01 + override val a31 by this::c02 + override val a12 by this::c10 + override val a22 by this::c11 + override val a32 by this::c12 + override val a13 by this::c20 + override val a23 by this::c21 + override val a33 by this::c22 + + override val b11 by this::c00 + override val b21 by this::c10 + override val b31 by this::c20 + override val b12 by this::c01 + override val b22 by this::c11 + override val b32 by this::c21 + override val b13 by this::c02 + override val b23 by this::c12 + override val b33 by this::c22 + + override val c0: Vector3f get() = Vector3f(c00, c01, c02) + override val c1: Vector3f get() = Vector3f(c10, c11, c12) + override val c2: Vector3f get() = Vector3f(c20, c21, c22) + + override val r0: Vector3f get() = Vector3f(r00, r01, r02) + override val r1: Vector3f get() = Vector3f(r10, r11, r12) + override val r2: Vector3f get() = Vector3f(r20, r21, r22) + + override fun translate(vector: Vector2f): Matrix3f { + return rm( + r00, r01, r02 + vector.x, + r10, r11, r12 + vector.y, + r20, r21, r22, + ) + } + + override fun translateWithMultiplication(vector: Vector2f): Matrix3f { + return rm( + r00, r01, r02 + vector.x * r00 + vector.y * r01, + r10, r11, r12 + vector.x * r10 + vector.y * r11, + r20, r21, r22, + ) + } + + override fun scale(vector: Vector2f): Matrix3f { + return rm( + r00 * vector.x, r01, r02, + r10, r11 * vector.y, r12, + r20, r21, r22 + ) + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Float = 1f, r01: Float = 0f, r02: Float = 0f, + r10: Float = 0f, r11: Float = 1f, r12: Float = 0f, + r20: Float = 0f, r21: Float = 0f, r22: Float = 1f, + ): Matrix3f { + return Matrix3f( + c00 = r00, c10 = r01, c20 = r02, + c01 = r10, c11 = r11, c21 = r12, + c02 = r20, c12 = r21, c22 = r22, + ) + } + + /** + * Initializes new zero matrix. + * + * Since [Matrix3f] is immutable, it is encouraged you use [ZERO] property instead. + */ + fun zero(): Matrix3f { + return Matrix3f( + c00 = 0f, c10 = 0f, c20 = 0f, + c01 = 0f, c11 = 0f, c21 = 0f, + c02 = 0f, c12 = 0f, c22 = 0f, + ) + } + + /** + * All values of this matrix are zero + */ + @JvmField val ZERO = zero() + + /** + * Main diagonal of this matrix is 1s + */ + @JvmField val IDENTITY = Matrix3f() + } +} + +/** + * Represents mutable concrete matrix with 3x3 dimensions, storing values as [Float]s. + * + * See [MutableMatrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [MutableVector3f], generic interface is represented by [IMatrix3f]. + */ +class MutableMatrix3f : AbstractMutableMatrixVf, IMutableSquareMatrix, IMatrix3f { + constructor( + c00: Float = 1f, c01: Float = 0f, c02: Float = 0f, + c10: Float = 0f, c11: Float = 1f, c12: Float = 0f, + c20: Float = 0f, c21: Float = 0f, c22: Float = 1f, + ) : super(3, 3, Float2Dimensional(3, 3).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + }) + + private constructor(memory: Float2Dimensional) : super(3, 3, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Float2Dimensional): MutableMatrix3f { + requireSizeEquals(memory) + return MutableMatrix3f(memory) + } + + override fun translateWithMultiplicationMut(vector: Vector2f): MutableMatrix3f { + r02 += vector.x * r00 + vector.y * r01 + r12 += vector.x * r10 + vector.y * r11 + return this + } + + override fun scaleMut(vector: Vector2f): MutableMatrix3f { + r00 *= vector.x + r11 *= vector.y + return this + } + + override var c00: Float + get() = memory[0, 0] + set(value) { memory[0, 0] = value } + override var c10: Float + get() = memory[1, 0] + set(value) { memory[1, 0] = value } + override var c20: Float + get() = memory[2, 0] + set(value) { memory[2, 0] = value } + override var c01: Float + get() = memory[0, 1] + set(value) { memory[0, 1] = value } + override var c11: Float + get() = memory[1, 1] + set(value) { memory[1, 1] = value } + override var c21: Float + get() = memory[2, 1] + set(value) { memory[2, 1] = value } + override var c02: Float + get() = memory[0, 2] + set(value) { memory[0, 2] = value } + override var c12: Float + get() = memory[1, 2] + set(value) { memory[1, 2] = value } + override var c22: Float + get() = memory[2, 2] + set(value) { memory[2, 2] = value } + + override var r00 by this::c00 + override var r01 by this::c10 + override var r02 by this::c20 + override var r10 by this::c01 + override var r11 by this::c11 + override var r12 by this::c21 + override var r20 by this::c02 + override var r21 by this::c12 + override var r22 by this::c22 + + override var a11 by this::c00 + override var a21 by this::c01 + override var a31 by this::c02 + override var a12 by this::c10 + override var a22 by this::c11 + override var a32 by this::c12 + override var a13 by this::c20 + override var a23 by this::c21 + override var a33 by this::c22 + + override var b11 by this::c00 + override var b21 by this::c10 + override var b31 by this::c20 + override var b12 by this::c01 + override var b22 by this::c11 + override var b32 by this::c21 + override var b13 by this::c02 + override var b23 by this::c12 + override var b33 by this::c22 + + override var translation: Vector2f + get() = super.translation + set(value) { + r02 = value.x + r12 = value.y + } + + override var c0: Vector3f + get() = object : MutableVector3f(c00, c01, c02) { + override var x by this@MutableMatrix3f::c00 + override var y by this@MutableMatrix3f::c01 + override var z by this@MutableMatrix3f::c02 + } + set(value) { + c00 = value.x + c01 = value.y + c02 = value.z + } + override var c1: Vector3f + get() = object : MutableVector3f(c10, c11, c12) { + override var x by this@MutableMatrix3f::c10 + override var y by this@MutableMatrix3f::c11 + override var z by this@MutableMatrix3f::c12 + } + set(value) { + c10 = value.x + c11 = value.y + c12 = value.z + } + override var c2: Vector3f + get() = object : MutableVector3f(c20, c21, c22) { + override var x by this@MutableMatrix3f::c20 + override var y by this@MutableMatrix3f::c21 + override var z by this@MutableMatrix3f::c22 + } + set(value) { + c20 = value.x + c21 = value.y + c22 = value.z + } + + override var r0: Vector3f + get() = object : MutableVector3f(r00, r01, r02) { + override var x by this@MutableMatrix3f::r00 + override var y by this@MutableMatrix3f::r01 + override var z by this@MutableMatrix3f::r02 + } + set(value) { + r00 = value.x + r01 = value.y + r02 = value.z + } + override var r1: Vector3f + get() = object : MutableVector3f(r10, r11, r12) { + override var x by this@MutableMatrix3f::r10 + override var y by this@MutableMatrix3f::r11 + override var z by this@MutableMatrix3f::r12 + } + set(value) { + r10 = value.x + r11 = value.y + r12 = value.z + } + override var r2: Vector3f + get() = object : MutableVector3f(r20, r21, r22) { + override var x by this@MutableMatrix3f::r20 + override var y by this@MutableMatrix3f::r21 + override var z by this@MutableMatrix3f::r22 + } + set(value) { + r20 = value.x + r21 = value.y + r22 = value.z + } + + override fun translate(vector: Vector2f): MutableMatrix3f { + return rm( + r00, r01, r02 + vector.x, + r10, r11, r12 + vector.y, + r20, r21, r22, + ) + } + + override fun translateWithMultiplication(vector: Vector2f): MutableMatrix3f { + return rm( + r00, r01, r02 + vector.x * r00 + vector.y * r01, + r10, r11, r12 + vector.x * r10 + vector.y * r11, + r20, r21, r22, + ) + } + + override fun scale(vector: Vector2f): MutableMatrix3f { + return rm( + r00 * vector.x, r01, r02, + r10, r11 * vector.y, r12, + r20, r21, r22 + ) + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Float = 1f, r01: Float = 0f, r02: Float = 0f, + r10: Float = 0f, r11: Float = 1f, r12: Float = 0f, + r20: Float = 0f, r21: Float = 0f, r22: Float = 1f, + ): MutableMatrix3f { + return MutableMatrix3f( + c00 = r00, c10 = r01, c20 = r02, + c01 = r10, c11 = r11, c21 = r12, + c02 = r20, c12 = r21, c22 = r22, + ) + } + + /** + * Initializes new zero matrix. + */ + fun zero(): MutableMatrix3f { + return MutableMatrix3f( + c00 = 0f, c10 = 0f, c20 = 0f, + c01 = 0f, c11 = 0f, c21 = 0f, + c02 = 0f, c12 = 0f, c22 = 0f, + ) + } + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix4f.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix4f.kt new file mode 100644 index 00000000..25566e7f --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/Matrix4f.kt @@ -0,0 +1,543 @@ + +@file:Suppress("unused") + +package ru.dbotthepony.kvector.matrix.nfloat + +import ru.dbotthepony.kvector.api.IMutableSquareMatrix +import ru.dbotthepony.kvector.api.concrete.IMatrix4f +import ru.dbotthepony.kvector.matrix.ndouble.Matrix4d +import ru.dbotthepony.kvector.matrix.ndouble.MutableMatrix4d +import ru.dbotthepony.kvector.narray.Float2Dimensional +import ru.dbotthepony.kvector.vector.nfloat.* + +/** + * Represents immutable concrete matrix with 4x4 dimensions, storing values as [Float]s. + * + * See [Matrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [Vector4f], generic interface is represented by [IMatrix4f]. + */ +class Matrix4f : AbstractMatrixVf, IMatrix4f { + constructor( + c00: Float = 1f, c01: Float = 0f, c02: Float = 0f, c03: Float = 0f, + c10: Float = 0f, c11: Float = 1f, c12: Float = 0f, c13: Float = 0f, + c20: Float = 0f, c21: Float = 0f, c22: Float = 1f, c23: Float = 0f, + c30: Float = 0f, c31: Float = 0f, c32: Float = 0f, c33: Float = 1f, + ) : super(4, 4, Float2Dimensional(4, 4).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + it[3, 0] = c30 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + it[3, 1] = c31 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + it[3, 2] = c32 + + it[0, 3] = c03 + it[1, 3] = c13 + it[2, 3] = c23 + it[3, 3] = c33 + }) + + private constructor(memory: Float2Dimensional) : super(4, 4, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Float2Dimensional): Matrix4f { + requireSizeEquals(memory) + return Matrix4f(memory) + } + + override val c00: Float get() = memory[0, 0] + override val c10: Float get() = memory[1, 0] + override val c20: Float get() = memory[2, 0] + override val c30: Float get() = memory[3, 0] + override val c01: Float get() = memory[0, 1] + override val c11: Float get() = memory[1, 1] + override val c21: Float get() = memory[2, 1] + override val c31: Float get() = memory[3, 1] + override val c02: Float get() = memory[0, 2] + override val c12: Float get() = memory[1, 2] + override val c22: Float get() = memory[2, 2] + override val c32: Float get() = memory[3, 2] + override val c03: Float get() = memory[0, 3] + override val c13: Float get() = memory[1, 3] + override val c23: Float get() = memory[2, 3] + override val c33: Float get() = memory[3, 3] + + override val r00 by this::c00 + override val r01 by this::c10 + override val r02 by this::c20 + override val r03 by this::c30 + override val r10 by this::c01 + override val r11 by this::c11 + override val r12 by this::c21 + override val r13 by this::c31 + override val r20 by this::c02 + override val r21 by this::c12 + override val r22 by this::c22 + override val r23 by this::c32 + override val r30 by this::c03 + override val r31 by this::c13 + override val r32 by this::c23 + override val r33 by this::c33 + + override val a11 by this::c00 + override val a21 by this::c01 + override val a31 by this::c02 + override val a41 by this::c03 + override val a12 by this::c10 + override val a22 by this::c11 + override val a32 by this::c12 + override val a42 by this::c13 + override val a13 by this::c20 + override val a23 by this::c21 + override val a33 by this::c22 + override val a43 by this::c23 + override val a14 by this::c30 + override val a24 by this::c31 + override val a34 by this::c32 + override val a44 by this::c33 + + override val b11 by this::c00 + override val b21 by this::c10 + override val b31 by this::c20 + override val b41 by this::c30 + override val b12 by this::c01 + override val b22 by this::c11 + override val b32 by this::c21 + override val b42 by this::c31 + override val b13 by this::c02 + override val b23 by this::c12 + override val b33 by this::c22 + override val b43 by this::c32 + override val b14 by this::c03 + override val b24 by this::c13 + override val b34 by this::c23 + override val b44 by this::c33 + + override val c0: Vector4f get() = Vector4f(c00, c01, c02, c03) + override val c1: Vector4f get() = Vector4f(c10, c11, c12, c13) + override val c2: Vector4f get() = Vector4f(c20, c21, c22, c23) + override val c3: Vector4f get() = Vector4f(c30, c31, c32, c33) + + override val r0: Vector4f get() = Vector4f(r00, r01, r02, r03) + override val r1: Vector4f get() = Vector4f(r10, r11, r12, r13) + override val r2: Vector4f get() = Vector4f(r20, r21, r22, r23) + override val r3: Vector4f get() = Vector4f(r30, r31, r32, r33) + + override fun translate(vector: Vector3f): Matrix4f { + return rm( + r00, r01, r02, r03 + vector.x, + r10, r11, r12, r13 + vector.y, + r20, r21, r22, r23 + vector.z, + r30, r31, r32, r33, + ) + } + + override fun translateWithMultiplication(vector: Vector3f): Matrix4f { + return rm( + r00, r01, r02, r03 + vector.x * r00 + vector.y * r01 + vector.z * r02, + r10, r11, r12, r13 + vector.x * r10 + vector.y * r11 + vector.z * r12, + r20, r21, r22, r23 + vector.x * r20 + vector.y * r21 + vector.z * r22, + r30, r31, r32, r33, + ) + } + + override fun scale(vector: Vector3f): Matrix4f { + return rm( + r00 * vector.x, r01, r02, r03, + r10, r11 * vector.y, r12, r13, + r20, r21, r22 * vector.z, r23, + r30, r31, r32, r33, + ) + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Float = 1f, r01: Float = 0f, r02: Float = 0f, r03: Float = 0f, + r10: Float = 0f, r11: Float = 1f, r12: Float = 0f, r13: Float = 0f, + r20: Float = 0f, r21: Float = 0f, r22: Float = 1f, r23: Float = 0f, + r30: Float = 0f, r31: Float = 0f, r32: Float = 0f, r33: Float = 1f, + ): Matrix4f { + return Matrix4f( + c00 = r00, c10 = r01, c20 = r02, c30 = r03, + c01 = r10, c11 = r11, c21 = r12, c31 = r13, + c02 = r20, c12 = r21, c22 = r22, c32 = r23, + c03 = r30, c13 = r31, c23 = r32, c33 = r33, + ) + } + + /** + * Initializes new zero matrix. + * + * Since [Matrix4f] is immutable, it is encouraged you use [ZERO] property instead. + */ + fun zero(): Matrix4f { + return Matrix4f( + c00 = 0f, c10 = 0f, c20 = 0f, c30 = 0f, + c01 = 0f, c11 = 0f, c21 = 0f, c31 = 0f, + c02 = 0f, c12 = 0f, c22 = 0f, c32 = 0f, + c03 = 0f, c13 = 0f, c23 = 0f, c33 = 0f, + ) + } + + /** + * All values of this matrix are zero + */ + @JvmField val ZERO = zero() + + /** + * Main diagonal of this matrix is 1s + */ + @JvmField val IDENTITY = Matrix4f() + } +} + +/** + * Represents mutable concrete matrix with 4x4 dimensions, storing values as [Float]s. + * + * See [MutableMatrix4d] for documentation, with reflection of this class. + * + * Vectorized access use [MutableVector4f], generic interface is represented by [IMatrix4f]. + */ +class MutableMatrix4f : AbstractMutableMatrixVf, IMatrix4f, IMutableSquareMatrix { + constructor( + c00: Float = 1f, c01: Float = 0f, c02: Float = 0f, c03: Float = 0f, + c10: Float = 0f, c11: Float = 1f, c12: Float = 0f, c13: Float = 0f, + c20: Float = 0f, c21: Float = 0f, c22: Float = 1f, c23: Float = 0f, + c30: Float = 0f, c31: Float = 0f, c32: Float = 0f, c33: Float = 1f, + ) : super(4, 4, Float2Dimensional(4, 4).also { + it[0, 0] = c00 + it[1, 0] = c10 + it[2, 0] = c20 + it[3, 0] = c30 + + it[0, 1] = c01 + it[1, 1] = c11 + it[2, 1] = c21 + it[3, 1] = c31 + + it[0, 2] = c02 + it[1, 2] = c12 + it[2, 2] = c22 + it[3, 2] = c32 + + it[0, 3] = c03 + it[1, 3] = c13 + it[2, 3] = c23 + it[3, 3] = c33 + }) + + private constructor(memory: Float2Dimensional) : super(4, 4, memory) + + override val flexible: Boolean = false + + override fun factorize(memory: Float2Dimensional): MutableMatrix4f { + requireSizeEquals(memory) + return MutableMatrix4f(memory) + } + + override fun translate(vector: Vector3f): MutableMatrix4f { + return rm( + r00, r01, r02, r03 + vector.x, + r10, r11, r12, r13 + vector.y, + r20, r21, r22, r23 + vector.z, + r30, r31, r32, r33, + ) + } + + override fun translateWithMultiplication(vector: Vector3f): MutableMatrix4f { + return rm( + r00, r01, r02, r03 + vector.x * r00 + vector.y * r01 + vector.z * r02, + r10, r11, r12, r13 + vector.x * r10 + vector.y * r11 + vector.z * r12, + r20, r21, r22, r23 + vector.x * r20 + vector.y * r21 + vector.z * r22, + r30, r31, r32, r33, + ) + } + + override fun scale(vector: Vector3f): MutableMatrix4f { + return rm( + r00 * vector.x, r01, r02, r03, + r10, r11 * vector.y, r12, r13, + r20, r21, r22 * vector.z, r23, + r30, r31, r32, r33, + ) + } + + override fun translateWithMultiplicationMut(vector: Vector3f): MutableMatrix4f { + r03 += vector.x * r00 + vector.y * r01 + vector.z * r02 + r13 += vector.x * r10 + vector.y * r11 + vector.z * r12 + r23 += vector.x * r20 + vector.y * r21 + vector.z * r22 + return this + } + + override fun scaleMut(vector: Vector3f): MutableMatrix4f { + c00 *= vector.x + c11 *= vector.y + c22 *= vector.z + return this + } + + override var translation: Vector3f + get() = super.translation + set(value) { + r03 = value.x + r13 = value.y + r23 = value.z + } + + override var c00: Float + get() = memory[0, 0] + set(value) { memory[0, 0] = value } + override var c10: Float + get() = memory[1, 0] + set(value) { memory[1, 0] = value } + override var c20: Float + get() = memory[2, 0] + set(value) { memory[2, 0] = value } + override var c30: Float + get() = memory[3, 0] + set(value) { memory[3, 0] = value } + override var c01: Float + get() = memory[0, 1] + set(value) { memory[0, 1] = value } + override var c11: Float + get() = memory[1, 1] + set(value) { memory[1, 1] = value } + override var c21: Float + get() = memory[2, 1] + set(value) { memory[2, 1] = value } + override var c31: Float + get() = memory[3, 1] + set(value) { memory[3, 1] = value } + override var c02: Float + get() = memory[0, 2] + set(value) { memory[0, 2] = value } + override var c12: Float + get() = memory[1, 2] + set(value) { memory[1, 2] = value } + override var c22: Float + get() = memory[2, 2] + set(value) { memory[2, 2] = value } + override var c32: Float + get() = memory[3, 2] + set(value) { memory[3, 2] = value } + override var c03: Float + get() = memory[0, 3] + set(value) { memory[0, 3] = value } + override var c13: Float + get() = memory[1, 3] + set(value) { memory[1, 3] = value } + override var c23: Float + get() = memory[2, 3] + set(value) { memory[2, 3] = value } + override var c33: Float + get() = memory[3, 3] + set(value) { memory[3, 3] = value } + + override var r00 by this::c00 + override var r01 by this::c10 + override var r02 by this::c20 + override var r03 by this::c30 + override var r10 by this::c01 + override var r11 by this::c11 + override var r12 by this::c21 + override var r13 by this::c31 + override var r20 by this::c02 + override var r21 by this::c12 + override var r22 by this::c22 + override var r23 by this::c32 + override var r30 by this::c03 + override var r31 by this::c13 + override var r32 by this::c23 + override var r33 by this::c33 + + override var a11 by this::c00 + override var a21 by this::c01 + override var a31 by this::c02 + override var a41 by this::c03 + override var a12 by this::c10 + override var a22 by this::c11 + override var a32 by this::c12 + override var a42 by this::c13 + override var a13 by this::c20 + override var a23 by this::c21 + override var a33 by this::c22 + override var a43 by this::c23 + override var a14 by this::c30 + override var a24 by this::c31 + override var a34 by this::c32 + override var a44 by this::c33 + + override var b11 by this::c00 + override var b21 by this::c01 + override var b31 by this::c02 + override var b41 by this::c03 + override var b12 by this::c10 + override var b22 by this::c11 + override var b32 by this::c12 + override var b42 by this::c13 + override var b13 by this::c20 + override var b23 by this::c21 + override var b33 by this::c22 + override var b43 by this::c23 + override var b14 by this::c30 + override var b24 by this::c31 + override var b34 by this::c32 + override var b44 by this::c33 + + override var c0: Vector4f + get() = object : MutableVector4f(c00, c01, c02, c03) { + override var x by this@MutableMatrix4f::c00 + override var y by this@MutableMatrix4f::c01 + override var z by this@MutableMatrix4f::c02 + override var w by this@MutableMatrix4f::c03 + } + set(value) { + c00 = value.x + c01 = value.y + c02 = value.z + c03 = value.w + } + + override var c1: Vector4f + get() = object : MutableVector4f(c10, c11, c12, c13) { + override var x by this@MutableMatrix4f::c10 + override var y by this@MutableMatrix4f::c11 + override var z by this@MutableMatrix4f::c12 + override var w by this@MutableMatrix4f::c13 + } + set(value) { + c10 = value.x + c11 = value.y + c12 = value.z + c13 = value.w + } + + override var c2: Vector4f + get() = object : MutableVector4f(c20, c21, c22, c23) { + override var x by this@MutableMatrix4f::c20 + override var y by this@MutableMatrix4f::c21 + override var z by this@MutableMatrix4f::c22 + override var w by this@MutableMatrix4f::c23 + } + set(value) { + c20 = value.x + c21 = value.y + c22 = value.z + c23 = value.w + } + + override var c3: Vector4f + get() = object : MutableVector4f(c30, c31, c32, c33) { + override var x by this@MutableMatrix4f::c30 + override var y by this@MutableMatrix4f::c31 + override var z by this@MutableMatrix4f::c32 + override var w by this@MutableMatrix4f::c33 + } + set(value) { + c30 = value.x + c31 = value.y + c32 = value.z + c33 = value.w + } + + override var r0: Vector4f + get() = object : MutableVector4f(r00, r01, r02, r03) { + override var x by this@MutableMatrix4f::r00 + override var y by this@MutableMatrix4f::r01 + override var z by this@MutableMatrix4f::r02 + override var w by this@MutableMatrix4f::r03 + } + set(value) { + r00 = value.x + r01 = value.y + r02 = value.z + r03 = value.w + } + + override var r1: Vector4f + get() = object : MutableVector4f(r10, r11, r12, r13) { + override var x by this@MutableMatrix4f::r10 + override var y by this@MutableMatrix4f::r11 + override var z by this@MutableMatrix4f::r12 + override var w by this@MutableMatrix4f::r13 + } + set(value) { + r10 = value.x + r11 = value.y + r12 = value.z + r13 = value.w + } + + override var r2: Vector4f + get() = object : MutableVector4f(r20, r21, r22, r23) { + override var x by this@MutableMatrix4f::r20 + override var y by this@MutableMatrix4f::r21 + override var z by this@MutableMatrix4f::r22 + override var w by this@MutableMatrix4f::r23 + } + set(value) { + r20 = value.x + r21 = value.y + r22 = value.z + r23 = value.w + } + + override var r3: Vector4f + get() = object : MutableVector4f(r30, r31, r32, r33) { + override var x by this@MutableMatrix4f::r30 + override var y by this@MutableMatrix4f::r31 + override var z by this@MutableMatrix4f::r32 + override var w by this@MutableMatrix4f::r33 + } + set(value) { + r30 = value.x + r31 = value.y + r32 = value.z + r33 = value.w + } + + companion object { + /** + * Initializes new matrix, with arguments taken in *Row-Major* order, that is, fist row of values + * is fist row in created matrix. + */ + fun rm( + r00: Float = 1f, r01: Float = 0f, r02: Float = 0f, r03: Float = 0f, + r10: Float = 0f, r11: Float = 1f, r12: Float = 0f, r13: Float = 0f, + r20: Float = 0f, r21: Float = 0f, r22: Float = 1f, r23: Float = 0f, + r30: Float = 0f, r31: Float = 0f, r32: Float = 0f, r33: Float = 1f, + ): MutableMatrix4f { + return MutableMatrix4f( + c00 = r00, c10 = r01, c20 = r02, c30 = r03, + c01 = r10, c11 = r11, c21 = r12, c31 = r13, + c02 = r20, c12 = r21, c22 = r22, c32 = r23, + c03 = r30, c13 = r31, c23 = r32, c33 = r33, + ) + } + + /** + * Initializes new mutable zero matrix. + */ + fun zero(): MutableMatrix4f { + return MutableMatrix4f( + c00 = 0f, c10 = 0f, c20 = 0f, c30 = 0f, + c01 = 0f, c11 = 0f, c21 = 0f, c31 = 0f, + c02 = 0f, c12 = 0f, c22 = 0f, c32 = 0f, + c03 = 0f, c13 = 0f, c23 = 0f, c33 = 0f, + ) + } + } +} \ No newline at end of file diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/MatrixVf.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/MatrixVf.kt new file mode 100644 index 00000000..f86beeb2 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/matrix/nfloat/MatrixVf.kt @@ -0,0 +1,316 @@ + +@file:Suppress("unchecked_cast", "unused") + +package ru.dbotthepony.kvector.matrix.nfloat + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.matrix.generated.MultiplicationsFloat +import ru.dbotthepony.kvector.matrix.matrixDeterminant +import ru.dbotthepony.kvector.matrix.multiplyMatrix +import ru.dbotthepony.kvector.matrix.transposeMatrix +import ru.dbotthepony.kvector.narray.Float2Dimensional + +private fun checkRows(value: Int): Int { + require(value > 0) { "Invalid amount of rows $value" } + return value +} + +private fun checkColumns(value: Int): Int { + require(value > 0) { "Invalid amount of columns $value" } + return value +} + +/** + * Abstract class with only one protected abstract method: [factorize]. + * + * This class is meant to be only internally overridden (to implement interfaces), but if you really need to, you can + * extend this class. + */ +abstract class AbstractMatrixVf> protected constructor( + final override val columns: Int, + final override val rows: Int, + @JvmField protected val memory: Float2Dimensional +) : IMatrix, IFloatMatrix, ITransposable { + /** + * To avoid middle-object creation when deriving from [AbstractMatrixVf] ([MatrixVf]), this method + * allows to factory produce new instances of final class + */ + protected abstract fun factorize(memory: Float2Dimensional): T + protected open val flexible = true + + final override fun get(column: Int, row: Int): Float { + return memory[column, row] + } + + override fun plus(other: IMatrixGetterFloat): T { + requireSizeEquals(other) + + val result = Float2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] + other[column, row] + } + } + + return factorize(result) + } + + override fun minus(other: IMatrixGetterFloat): T { + requireSizeEquals(other) + + val result = Float2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] - other[column, row] + } + } + + return factorize(result) + } + + override fun times(other: IMatrixGetterFloat): T { + require(flexible || sizeEquals(other)) { "${this::class.qualifiedName} is not a flexible" } + val result = multiplyMatrix(this, other) + return factorize(result) + } + + override fun times(other: Float): T { + val result = Float2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] * other + } + } + + return factorize(result) + } + + override fun div(other: Float): T { + val result = Float2Dimensional(columns, rows) + + for (column in 0 until columns) { + for (row in 0 until rows) { + result[column, row] = memory[column, row] / other + } + } + + return factorize(result) + } + + override val transposed: T + get() { + val result = transposeMatrix(this) + return factorize(result) + } + + override val trace: Float? + get() { + if (!isSquareMatrix) + return null + + var calc = 0f + + for (i in 0 until rows) { + calc += memory[columns, rows] + } + + return calc + } + + override val determinant: Float? + get() { + if (!isSquareMatrix) + return null + + return matrixDeterminant(this) + } + + override val isFinite: Boolean + get() { + for (column in 0 until columns) { + for (row in 0 until rows) { + if (!memory[column, row].isFinite()) { + return false + } + } + } + + return true + } + + override val isNaN: Boolean + get() { + for (column in 0 until columns) { + for (row in 0 until rows) { + if (memory[column, row].isNaN()) { + return true + } + } + } + + return false + } +} + +/** + * Abstract class inheriting [AbstractMatrixVf], implementing mutating methods. + * + * This class is meant to be only internally overridden (to implement interfaces), but if you really need to, you can + * extend this class. + */ +abstract class AbstractMutableMatrixVf> protected constructor( + columns: Int, + rows: Int, + memory: Float2Dimensional +) : AbstractMatrixVf(columns, rows, memory), IMutableFloatMatrix, IMutableTransposable { + final override fun set(column: Int, row: Int, value: Float) { + memory[column, row] = value + } + + override fun timesMut(other: Float): T { + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] *= other + } + } + + return this as T + } + + override fun divMut(other: Float): T { + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] /= other + } + } + + return this as T + } + + override fun timesMut(other: IMatrixGetterFloat): T { + requireSizeEquals(other) + + if (MultiplicationsFloat.multiplyMatrix(this, other, this) == null) { + val result = multiplyMatrix(this, other) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] = result[column, row] + } + } + } + + return this as T + } + + override fun plusMut(other: IMatrixGetterFloat): T { + requireSizeEquals(other) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] += other[column, row] + } + } + + return this as T + } + + override fun minusMut(other: IMatrixGetterFloat): T { + requireSizeEquals(other) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] -= other[column, row] + } + } + + return this as T + } + + override fun transpose(): T { + check(isSquareMatrix) { "This matrix is not a square matrix (${columns}x${rows})" } + + val result = transposeMatrix(this) + + for (column in 0 until columns) { + for (row in 0 until rows) { + memory[column, row] = result[column, row] + } + } + + return this as T + } +} + +/** + * Represents immutable matrix with arbitrary dimensions, storing values as [Float]s, + * backed by [Float2Dimensional]. + * + * Matrix is initialized to zeros upon creation. + */ +open class MatrixVf protected constructor( + columns: Int, + rows: Int, + memory: Float2Dimensional +) : AbstractMatrixVf(columns, rows, memory) { + constructor(columns: Int, rows: Int) : this(checkColumns(columns), checkRows(rows), Float2Dimensional(checkColumns(columns), checkRows(rows))) + + override fun factorize(memory: Float2Dimensional): MatrixVf { + return MatrixVf(memory.columns, memory.rows, memory) + } + + companion object { + /** + * Copies specified matrix into new [MatrixVf] + */ + fun copy(input: IMatrixGetterFloat): MatrixVf { + val memory = Float2Dimensional(input.columns, input.rows) + + for (column in 0 until input.columns) { + for (row in 0 until input.rows) { + memory[column, row] = input[column, row] + } + } + + return MatrixVf(input.columns, input.rows, memory) + } + } +} + +/** + * Represents mutable matrix with arbitrary dimensions, storing values as [Float]s, + * backed by [Float2Dimensional]. + * + * Matrix is initialized to zeros upon creation. + */ +open class MutableMatrixVf protected constructor( + columns: Int, + rows: Int, + memory: Float2Dimensional +) : AbstractMutableMatrixVf(columns, rows, memory) { + constructor(columns: Int, rows: Int) : this(checkColumns(columns), checkRows(rows), Float2Dimensional(checkColumns(columns), checkRows(rows))) + + override fun factorize(memory: Float2Dimensional): MutableMatrixVf { + return MutableMatrixVf(memory.columns, memory.rows, memory) + } + + companion object { + /** + * Copies specified matrix into new [MutableMatrixVf] + */ + fun copy(input: IMatrixGetterFloat): MutableMatrixVf { + val memory = Float2Dimensional(input.columns, input.rows) + + for (column in 0 until input.columns) { + for (row in 0 until input.rows) { + memory[column, row] = input[column, row] + } + } + + return MutableMatrixVf(input.columns, input.rows, memory) + } + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/narray/TwoDimensional.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/narray/TwoDimensional.kt new file mode 100644 index 00000000..a1cf4459 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/narray/TwoDimensional.kt @@ -0,0 +1,210 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.narray + +import ru.dbotthepony.kvector.api.* + +private inline fun require(condition: Boolean, lazy: () -> Any) { + if (!condition) { + throw IndexOutOfBoundsException(lazy.invoke().toString()) + } +} + +/** + * Two-dimensional array of [Double]s, backed by primitive [DoubleArray]. + * + * Has two constructors, one is for constructing fresh two-dimensional array, and second is for + * viewing already existing array as two-dimensional array. + */ +class Double2Dimensional( + override val columns: Int, + override val rows: Int, + @JvmField val memory: DoubleArray, + private val offset: Int = 0, +) : IMatrixGetterDouble, IMatrixSetterDouble { + init { + require(columns >= 0) { "Tried to create $columns columns" } + require(rows >= 0) { "Tried to create $rows rows" } + require(memory.size - offset >= columns * rows) { "Provided array (${memory.size}) does not satisfy demands of $offset offset, $columns columns and $rows rows" } + } + + constructor(columns: Int, rows: Int) : this(columns, rows, DoubleArray(columns * rows)) + + override operator fun get(column: Int, row: Int): Double { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + return memory[offset + column + row * columns] + } + + override operator fun set(column: Int, row: Int, value: Double) { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + memory[offset + column + row * columns] = value + } +} + +/** + * Two-dimensional array of [Float]s, backed by primitive [FloatArray] + * + * Has two constructors, one is for constructing fresh two-dimensional array, and second is for + * viewing already existing array as two-dimensional array. + */ +class Float2Dimensional( + override val columns: Int, + override val rows: Int, + @JvmField val memory: FloatArray, + private val offset: Int = 0, +) : IMatrixGetterFloat, IMatrixSetterFloat { + init { + require(columns >= 0) { "Tried to create $columns columns" } + require(rows >= 0) { "Tried to create $rows rows" } + require(memory.size - offset >= columns * rows) { "Provided array (${memory.size}) does not satisfy demands of $offset offset, $columns columns and $rows rows" } + } + + constructor(columns: Int, rows: Int) : this(columns, rows, FloatArray(columns * rows)) + + override operator fun get(column: Int, row: Int): Float { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + return memory[offset + column + row * columns] + } + + override operator fun set(column: Int, row: Int, value: Float) { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + memory[offset + column + row * columns] = value + } +} + +/** + * Two-dimensional array of [Byte]s, backed by primitive [ByteArray] + * + * Has two constructors, one is for constructing fresh two-dimensional array, and second is for + * viewing already existing array as two-dimensional array. + */ +class Byte2Dimensional( + override val columns: Int, + override val rows: Int, + @JvmField val memory: ByteArray, + private val offset: Int = 0, +) : IMatrixGetterByte, IMatrixSetterByte { + init { + require(columns >= 0) { "Tried to create $columns columns" } + require(rows >= 0) { "Tried to create $rows rows" } + require(memory.size - offset >= columns * rows) { "Provided array (${memory.size}) does not satisfy demands of $offset offset, $columns columns and $rows rows" } + } + + constructor(columns: Int, rows: Int) : this(columns, rows, ByteArray(columns * rows)) + + override operator fun get(column: Int, row: Int): Byte { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + return memory[offset + column + row * columns] + } + + override operator fun set(column: Int, row: Int, value: Byte) { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + memory[offset + column + row * columns] = value + } +} + +/** + * Two-dimensional array of [Short]s, backed by primitive [ShortArray] + * + * Has two constructors, one is for constructing fresh two-dimensional array, and second is for + * viewing already existing array as two-dimensional array. + */ +class Short2Dimensional( + override val columns: Int, + override val rows: Int, + @JvmField val memory: ShortArray, + private val offset: Int = 0, +) : IMatrixGetterShort, IMatrixSetterShort { + init { + require(columns >= 0) { "Tried to create $columns columns" } + require(rows >= 0) { "Tried to create $rows rows" } + require(memory.size - offset >= columns * rows) { "Provided array (${memory.size}) does not satisfy demands of $offset offset, $columns columns and $rows rows" } + } + + constructor(columns: Int, rows: Int) : this(columns, rows, ShortArray(columns * rows)) + + override operator fun get(column: Int, row: Int): Short { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + return memory[offset + column + row * columns] + } + + override operator fun set(column: Int, row: Int, value: Short) { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + memory[offset + column + row * columns] = value + } +} + +/** + * Two-dimensional array of [Int]s, backed by primitive [IntArray] + * + * Has two constructors, one is for constructing fresh two-dimensional array, and second is for + * viewing already existing array as two-dimensional array. + */ +class Int2Dimensional( + override val columns: Int, + override val rows: Int, + @JvmField val memory: IntArray, + private val offset: Int = 0, +) : IMatrixGetterInt, IMatrixSetterInt { + init { + require(columns >= 0) { "Tried to create $columns columns" } + require(rows >= 0) { "Tried to create $rows rows" } + require(memory.size - offset >= columns * rows) { "Provided array (${memory.size}) does not satisfy demands of $offset offset, $columns columns and $rows rows" } + } + + constructor(columns: Int, rows: Int) : this(columns, rows, IntArray(columns * rows)) + + override operator fun get(column: Int, row: Int): Int { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + return memory[offset + column + row * columns] + } + + override operator fun set(column: Int, row: Int, value: Int) { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + memory[offset + column + row * columns] = value + } +} + +/** + * Two-dimensional array of [Long]s, backed by primitive [LongArray] + * + * Has two constructors, one is for constructing fresh two-dimensional array, and second is for + * viewing already existing array as two-dimensional array. + */ +class Long2Dimensional( + override val columns: Int, + override val rows: Int, + @JvmField val memory: LongArray, + private val offset: Int = 0, +) : IMatrixGetterLong, IMatrixSetterLong { + init { + require(columns >= 0) { "Tried to create $columns columns" } + require(rows >= 0) { "Tried to create $rows rows" } + require(memory.size - offset >= columns * rows) { "Provided array (${memory.size}) does not satisfy demands of $offset offset, $columns columns and $rows rows" } + } + + constructor(columns: Int, rows: Int) : this(columns, rows, LongArray(columns * rows)) + + override operator fun get(column: Int, row: Int): Long { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + return memory[offset + column + row * columns] + } + + override operator fun set(column: Int, row: Int, value: Long) { + require(column in 0 until columns) { "Column out of bounds: $column" } + require(row in 0 until rows) { "Row out of bounds: $row" } + memory[offset + column + row * columns] = value + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector2d.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector2d.kt new file mode 100644 index 00000000..10c4a3ee --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector2d.kt @@ -0,0 +1,407 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.ndouble + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.vector.nfloat.Vector2f +import kotlin.math.absoluteValue +import kotlin.math.pow +import kotlin.math.sqrt + +/** + * 2D Vector, representing two-dimensional coordinates as [Double]s + */ +open class Vector2d( + open val x: Double = 0.0, + open val y: Double = 0.0 +) : AbstractVector(), IFractionalVector, IDoubleVector, IStruct2d, IMatrixGetterDouble { + final override fun component1() = x + final override fun component2() = y + + constructor(input: IStruct2d) : this(input.component1(), input.component2()) + + final override fun get(column: Int, row: Int): Double { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + final override val rows: Int = 2 + final override val lengthSquared: Double + get() = x * x + y * y + + final override val isFinite: Boolean + get() = x.isFinite() && y.isFinite() + final override val isNaN: Boolean + get() = x.isNaN() || y.isNaN() + + open val r by this::x + open val g by this::y + + open val s by this::x + open val t by this::y + + override fun plus(other: Vector2d): Vector2d { + return Vector2d(x + other.x, y + other.y) + } + + override fun minus(other: Vector2d): Vector2d { + return Vector2d(x - other.x, y - other.y) + } + + override fun times(other: Vector2d): Vector2d { + return Vector2d(x * other.x, y * other.y) + } + + override fun div(other: Vector2d): Vector2d { + return Vector2d(x / other.x, y / other.y) + } + + override val absoluteValue: Vector2d + get() = Vector2d(x.absoluteValue, y.absoluteValue) + + override fun coerceAtMost(maximal: Vector2d): Vector2d { + return Vector2d(x.coerceAtMost(maximal.x), y.coerceAtMost(maximal.y)) + } + + override fun coerceAtLeast(minimal: Vector2d): Vector2d { + return Vector2d(x.coerceAtLeast(minimal.x), y.coerceAtLeast(minimal.y)) + } + + override fun clamp(minimal: Vector2d, maximal: Vector2d): Vector2d { + return Vector2d(x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y)) + } + + override fun unaryMinus(): Vector2d { + return Vector2d(-x, -y) + } + + override fun distanceSquared(other: Vector2d): Double { + val x = x - other.x + val y = y - other.y + + return x * x + y * y + } + + override val normalized: Vector2d + get() { + val len = length + + if (len == 0.0) { + return ZERO + } + + return Vector2d(x / len, y / len) + } + + override fun times(other: Double): Vector2d { + return Vector2d(x * other, y * other) + } + + override fun div(other: Double): Vector2d { + return Vector2d(x / other, y / other) + } + + fun times(other: Float): Vector2d { + return Vector2d(x * other, y * other) + } + + fun div(other: Float): Vector2d { + return Vector2d(x / other, y / other) + } + + fun times(other: Int): Vector2d { + return Vector2d(x * other, y * other) + } + + fun div(other: Int): Vector2d { + return Vector2d(x / other, y / other) + } + + /** + * Calculates vector vector * vector, returning result as [Double] + */ + fun cross(other: Vector2d): Double { + return x * other.y - y * other.x + } + + /** + * Calculates 2D cross product between scalar and vector + * + * @return new vector + */ + fun cross(other: Double): Vector2d { + return Vector2d(other * y, -other * x) + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector2d): Double { + return other.x * x + other.y * y + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector3d): Double { + return other.x * x + other.y * y + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector4d): Double { + return other.x * x + other.y * y + } + + /** + * Casts components to [Float] and returns new vector as result + */ + open fun toFloatVector(): Vector2f { + return Vector2f(x.toFloat(), y.toFloat()) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector2d + + if (x != other.x) return false + if (y != other.y) return false + + return true + } + + override fun toString(): String { + return "[$x $y]" + } + + override fun hashCode(): Int { + return 31 * x.hashCode() + y.hashCode() + } + + inline val xx get() = Vector2d(x, x) + inline val xy get() = Vector2d(x, y) + inline val yx get() = Vector2d(y, x) + inline val yy get() = Vector2d(y, y) + inline val xxx get() = Vector3d(x, x, x) + inline val xxy get() = Vector3d(x, x, y) + inline val xyx get() = Vector3d(x, y, x) + inline val xyy get() = Vector3d(x, y, y) + inline val yxx get() = Vector3d(y, x, x) + inline val yxy get() = Vector3d(y, x, y) + inline val yyx get() = Vector3d(y, y, x) + inline val yyy get() = Vector3d(y, y, y) + inline val xxxx get() = Vector4d(x, x, x, x) + inline val xxxy get() = Vector4d(x, x, x, y) + inline val xxyx get() = Vector4d(x, x, y, x) + inline val xxyy get() = Vector4d(x, x, y, y) + inline val xyxx get() = Vector4d(x, y, x, x) + inline val xyxy get() = Vector4d(x, y, x, y) + inline val xyyx get() = Vector4d(x, y, y, x) + inline val xyyy get() = Vector4d(x, y, y, y) + inline val yxxx get() = Vector4d(y, x, x, x) + inline val yxxy get() = Vector4d(y, x, x, y) + inline val yxyx get() = Vector4d(y, x, y, x) + inline val yxyy get() = Vector4d(y, x, y, y) + inline val yyxx get() = Vector4d(y, y, x, x) + inline val yyxy get() = Vector4d(y, y, x, y) + inline val yyyx get() = Vector4d(y, y, y, x) + inline val yyyy get() = Vector4d(y, y, y, y) + inline val rr get() = Vector2d(r, r) + inline val rg get() = Vector2d(r, g) + inline val gr get() = Vector2d(g, r) + inline val gg get() = Vector2d(g, g) + inline val rrr get() = Vector3d(r, r, r) + inline val rrg get() = Vector3d(r, r, g) + inline val rgr get() = Vector3d(r, g, r) + inline val rgg get() = Vector3d(r, g, g) + inline val grr get() = Vector3d(g, r, r) + inline val grg get() = Vector3d(g, r, g) + inline val ggr get() = Vector3d(g, g, r) + inline val ggg get() = Vector3d(g, g, g) + inline val rrrr get() = Vector4d(r, r, r, r) + inline val rrrg get() = Vector4d(r, r, r, g) + inline val rrgr get() = Vector4d(r, r, g, r) + inline val rrgg get() = Vector4d(r, r, g, g) + inline val rgrr get() = Vector4d(r, g, r, r) + inline val rgrg get() = Vector4d(r, g, r, g) + inline val rggr get() = Vector4d(r, g, g, r) + inline val rggg get() = Vector4d(r, g, g, g) + inline val grrr get() = Vector4d(g, r, r, r) + inline val grrg get() = Vector4d(g, r, r, g) + inline val grgr get() = Vector4d(g, r, g, r) + inline val grgg get() = Vector4d(g, r, g, g) + inline val ggrr get() = Vector4d(g, g, r, r) + inline val ggrg get() = Vector4d(g, g, r, g) + inline val gggr get() = Vector4d(g, g, g, r) + inline val gggg get() = Vector4d(g, g, g, g) + inline val ss get() = Vector2d(s, s) + inline val st get() = Vector2d(s, t) + inline val ts get() = Vector2d(t, s) + inline val tt get() = Vector2d(t, t) + inline val sss get() = Vector3d(s, s, s) + inline val sst get() = Vector3d(s, s, t) + inline val sts get() = Vector3d(s, t, s) + inline val stt get() = Vector3d(s, t, t) + inline val tss get() = Vector3d(t, s, s) + inline val tst get() = Vector3d(t, s, t) + inline val tts get() = Vector3d(t, t, s) + inline val ttt get() = Vector3d(t, t, t) + inline val ssss get() = Vector4d(s, s, s, s) + inline val ssst get() = Vector4d(s, s, s, t) + inline val ssts get() = Vector4d(s, s, t, s) + inline val sstt get() = Vector4d(s, s, t, t) + inline val stss get() = Vector4d(s, t, s, s) + inline val stst get() = Vector4d(s, t, s, t) + inline val stts get() = Vector4d(s, t, t, s) + inline val sttt get() = Vector4d(s, t, t, t) + inline val tsss get() = Vector4d(t, s, s, s) + inline val tsst get() = Vector4d(t, s, s, t) + inline val tsts get() = Vector4d(t, s, t, s) + inline val tstt get() = Vector4d(t, s, t, t) + inline val ttss get() = Vector4d(t, t, s, s) + inline val ttst get() = Vector4d(t, t, s, t) + inline val ttts get() = Vector4d(t, t, t, s) + inline val tttt get() = Vector4d(t, t, t, t) + + companion object { + @JvmField val ZERO = Vector2d() + @JvmField val POSITIVE_X = Vector2d(x = 1.0) + @JvmField val NEGATIVE_X = Vector2d(x = -1.0) + @JvmField val POSITIVE_Y = Vector2d(y = 1.0) + @JvmField val NEGATIVE_Y = Vector2d(y = -1.0) + } +} + +fun Double.div(other: Vector2d): Vector2d { + return Vector2d(this / other.x, this / other.y) +} + +fun Double.times(other: Vector2d): Vector2d { + return Vector2d(this * other.x, this * other.y) +} + +/** + * Calculates 2D cross product between scalar and vector + * + * @return new vector + */ +fun Double.cross(other: Vector2d): Vector2d { + return Vector2d(-this * other.y, this * other.x) +} + +/** + * Mutable 2D Vector, representing two-dimensional coordinates as [Double]s + * + * It can be safely passed around to methods which expect immutable [Vector2d], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector2d( + override var x: Double = 0.0, + override var y: Double = 0.0 +) : Vector2d(x, y), IMutableDoubleVector, IMutableFractionalVector, IMutableVector, IMatrixSetterDouble { + constructor(input: IStruct2d) : this(input.component1(), input.component2()) + + override fun set(column: Int, row: Int, value: Double) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override val g by this::y + + override val s by this::x + override val t by this::y + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector2d + + if (x != other.x) return false + if (y != other.y) return false + + return true + } + + override fun plusMut(other: Vector2d): MutableVector2d { + x += other.x + y += other.y + return this + } + + override fun minusMut(other: Vector2d): MutableVector2d { + x -= other.x + y -= other.y + return this + } + + override fun timesMut(other: Vector2d): MutableVector2d { + x *= other.x + y *= other.y + return this + } + + override fun divMut(other: Vector2d): MutableVector2d { + x /= other.x + y /= other.y + return this + } + + override fun normalize(): Double { + val len = length + + if (len == 0.0) { + return len + } + + x /= len + y /= len + + return len + } + + override fun timesMut(other: Double): MutableVector2d { + x *= other + y *= other + return this + } + + override fun divMut(other: Double): MutableVector2d { + x /= other + y /= other + return this + } + + /** + * Calculates 2D cross product between scalar and vector, + * writing result into this vector + * + * @return this vector + */ + fun crossMut(other: Double): Vector2d { + val x = x + val y = y + this.x = other * y + this.y = -other * x + return this + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector3d.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector3d.kt new file mode 100644 index 00000000..e4b2b535 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector3d.kt @@ -0,0 +1,663 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.ndouble + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 3D Vector, representing three-dimensional coordinates as [Double]s + */ +open class Vector3d( + open val x: Double = 0.0, + open val y: Double = 0.0, + open val z: Double = 0.0, +) : AbstractVector(), IFractionalVector, IDoubleVector, IStruct3d, IMatrixGetterDouble { + final override fun component1() = x + final override fun component2() = y + final override fun component3() = z + + override fun get(column: Int, row: Int): Double { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + 2 -> z + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + constructor(input: IStruct2d, z: Double = 0.0) : this(input.component1(), input.component2(), z) + constructor(x: Double, input: IStruct2d) : this(x, input.component1(), input.component2()) + constructor(input: IStruct3d) : this(input.component1(), input.component2(), input.component3()) + + final override val rows: Int = 3 + final override val lengthSquared: Double + get() = x * x + y * y + z * z + + final override val isFinite: Boolean + get() = x.isFinite() && y.isFinite() && z.isFinite() + final override val isNaN: Boolean + get() = x.isNaN() || y.isNaN() || z.isNaN() + + open val r by this::x + open val g by this::y + open val b by this::z + + open val s by this::x + open val t by this::y + open val p by this::z + + override fun plus(other: Vector3d): Vector3d { + return Vector3d( + x + other.x, + y + other.y, + z + other.z + ) + } + + override fun minus(other: Vector3d): Vector3d { + return Vector3d(x - other.x, y - other.y, z - other.z) + } + + override fun times(other: Vector3d): Vector3d { + return Vector3d(x * other.x, y * other.y, z * other.z) + } + + override fun div(other: Vector3d): Vector3d { + return Vector3d(x / other.x, y / other.y, z / other.z) + } + + override val absoluteValue: Vector3d + get() = Vector3d(x.absoluteValue, y.absoluteValue, z.absoluteValue) + + override fun coerceAtMost(maximal: Vector3d): Vector3d { + return Vector3d( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + z.coerceAtMost(maximal.z), + ) + } + + override fun coerceAtLeast(minimal: Vector3d): Vector3d { + return Vector3d( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + z.coerceAtLeast(minimal.z), + ) + } + + override fun clamp(minimal: Vector3d, maximal: Vector3d): Vector3d { + return Vector3d( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + z.coerceAtLeast(minimal.z).coerceAtMost(maximal.z), + ) + } + + override fun unaryMinus(): Vector3d { + return Vector3d(-x, -y, -z) + } + + override fun distanceSquared(other: Vector3d): Double { + val x = x - other.x + val y = y - other.y + val z = z - other.z + + return x * x + y * y + z * z + } + + override val normalized: Vector3d + get() { + val len = length + + if (len == 0.0) { + return ZERO + } + + return Vector3d(x / len, y / len, z / len) + } + + override fun times(other: Double): Vector3d { + return Vector3d(x * other, y * other, z * other) + } + + override fun div(other: Double): Vector3d { + return Vector3d(x / other, y / other, z / other) + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector4d): Double { + return other.x * x + other.y * y + other.z * z + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector3d): Double { + return other.x * x + other.y * y + other.z * z + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector2d): Double { + return other.x * x + other.y * y + } + + /** + * Calculates vector vector * vector, returning result as new vector + */ + fun cross(other: Vector3d): Vector3d { + return Vector3d( + y * other.z - z * other.y, + z * other.x - x * other.z, + x * other.y - y * other.x, + ) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector3d + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + + return true + } + + override fun toString(): String { + return "[$x $y $z]" + } + + override fun hashCode(): Int { + var result = x.hashCode() + result = 31 * result + y.hashCode() + result = 31 * result + z.hashCode() + return result + } + + inline val xx get() = Vector2d(x, x) + inline val xy get() = Vector2d(x, y) + inline val xz get() = Vector2d(x, z) + inline val yx get() = Vector2d(y, x) + inline val yy get() = Vector2d(y, y) + inline val yz get() = Vector2d(y, z) + inline val zx get() = Vector2d(z, x) + inline val zy get() = Vector2d(z, y) + inline val zz get() = Vector2d(z, z) + inline val xxx get() = Vector3d(x, x, x) + inline val xxy get() = Vector3d(x, x, y) + inline val xxz get() = Vector3d(x, x, z) + inline val xyx get() = Vector3d(x, y, x) + inline val xyy get() = Vector3d(x, y, y) + inline val xyz get() = Vector3d(x, y, z) + inline val xzx get() = Vector3d(x, z, x) + inline val xzy get() = Vector3d(x, z, y) + inline val xzz get() = Vector3d(x, z, z) + inline val yxx get() = Vector3d(y, x, x) + inline val yxy get() = Vector3d(y, x, y) + inline val yxz get() = Vector3d(y, x, z) + inline val yyx get() = Vector3d(y, y, x) + inline val yyy get() = Vector3d(y, y, y) + inline val yyz get() = Vector3d(y, y, z) + inline val yzx get() = Vector3d(y, z, x) + inline val yzy get() = Vector3d(y, z, y) + inline val yzz get() = Vector3d(y, z, z) + inline val zxx get() = Vector3d(z, x, x) + inline val zxy get() = Vector3d(z, x, y) + inline val zxz get() = Vector3d(z, x, z) + inline val zyx get() = Vector3d(z, y, x) + inline val zyy get() = Vector3d(z, y, y) + inline val zyz get() = Vector3d(z, y, z) + inline val zzx get() = Vector3d(z, z, x) + inline val zzy get() = Vector3d(z, z, y) + inline val zzz get() = Vector3d(z, z, z) + inline val xxxx get() = Vector4d(x, x, x, x) + inline val xxxy get() = Vector4d(x, x, x, y) + inline val xxxz get() = Vector4d(x, x, x, z) + inline val xxyx get() = Vector4d(x, x, y, x) + inline val xxyy get() = Vector4d(x, x, y, y) + inline val xxyz get() = Vector4d(x, x, y, z) + inline val xxzx get() = Vector4d(x, x, z, x) + inline val xxzy get() = Vector4d(x, x, z, y) + inline val xxzz get() = Vector4d(x, x, z, z) + inline val xyxx get() = Vector4d(x, y, x, x) + inline val xyxy get() = Vector4d(x, y, x, y) + inline val xyxz get() = Vector4d(x, y, x, z) + inline val xyyx get() = Vector4d(x, y, y, x) + inline val xyyy get() = Vector4d(x, y, y, y) + inline val xyyz get() = Vector4d(x, y, y, z) + inline val xyzx get() = Vector4d(x, y, z, x) + inline val xyzy get() = Vector4d(x, y, z, y) + inline val xyzz get() = Vector4d(x, y, z, z) + inline val xzxx get() = Vector4d(x, z, x, x) + inline val xzxy get() = Vector4d(x, z, x, y) + inline val xzxz get() = Vector4d(x, z, x, z) + inline val xzyx get() = Vector4d(x, z, y, x) + inline val xzyy get() = Vector4d(x, z, y, y) + inline val xzyz get() = Vector4d(x, z, y, z) + inline val xzzx get() = Vector4d(x, z, z, x) + inline val xzzy get() = Vector4d(x, z, z, y) + inline val xzzz get() = Vector4d(x, z, z, z) + inline val yxxx get() = Vector4d(y, x, x, x) + inline val yxxy get() = Vector4d(y, x, x, y) + inline val yxxz get() = Vector4d(y, x, x, z) + inline val yxyx get() = Vector4d(y, x, y, x) + inline val yxyy get() = Vector4d(y, x, y, y) + inline val yxyz get() = Vector4d(y, x, y, z) + inline val yxzx get() = Vector4d(y, x, z, x) + inline val yxzy get() = Vector4d(y, x, z, y) + inline val yxzz get() = Vector4d(y, x, z, z) + inline val yyxx get() = Vector4d(y, y, x, x) + inline val yyxy get() = Vector4d(y, y, x, y) + inline val yyxz get() = Vector4d(y, y, x, z) + inline val yyyx get() = Vector4d(y, y, y, x) + inline val yyyy get() = Vector4d(y, y, y, y) + inline val yyyz get() = Vector4d(y, y, y, z) + inline val yyzx get() = Vector4d(y, y, z, x) + inline val yyzy get() = Vector4d(y, y, z, y) + inline val yyzz get() = Vector4d(y, y, z, z) + inline val yzxx get() = Vector4d(y, z, x, x) + inline val yzxy get() = Vector4d(y, z, x, y) + inline val yzxz get() = Vector4d(y, z, x, z) + inline val yzyx get() = Vector4d(y, z, y, x) + inline val yzyy get() = Vector4d(y, z, y, y) + inline val yzyz get() = Vector4d(y, z, y, z) + inline val yzzx get() = Vector4d(y, z, z, x) + inline val yzzy get() = Vector4d(y, z, z, y) + inline val yzzz get() = Vector4d(y, z, z, z) + inline val zxxx get() = Vector4d(z, x, x, x) + inline val zxxy get() = Vector4d(z, x, x, y) + inline val zxxz get() = Vector4d(z, x, x, z) + inline val zxyx get() = Vector4d(z, x, y, x) + inline val zxyy get() = Vector4d(z, x, y, y) + inline val zxyz get() = Vector4d(z, x, y, z) + inline val zxzx get() = Vector4d(z, x, z, x) + inline val zxzy get() = Vector4d(z, x, z, y) + inline val zxzz get() = Vector4d(z, x, z, z) + inline val zyxx get() = Vector4d(z, y, x, x) + inline val zyxy get() = Vector4d(z, y, x, y) + inline val zyxz get() = Vector4d(z, y, x, z) + inline val zyyx get() = Vector4d(z, y, y, x) + inline val zyyy get() = Vector4d(z, y, y, y) + inline val zyyz get() = Vector4d(z, y, y, z) + inline val zyzx get() = Vector4d(z, y, z, x) + inline val zyzy get() = Vector4d(z, y, z, y) + inline val zyzz get() = Vector4d(z, y, z, z) + inline val zzxx get() = Vector4d(z, z, x, x) + inline val zzxy get() = Vector4d(z, z, x, y) + inline val zzxz get() = Vector4d(z, z, x, z) + inline val zzyx get() = Vector4d(z, z, y, x) + inline val zzyy get() = Vector4d(z, z, y, y) + inline val zzyz get() = Vector4d(z, z, y, z) + inline val zzzx get() = Vector4d(z, z, z, x) + inline val zzzy get() = Vector4d(z, z, z, y) + inline val zzzz get() = Vector4d(z, z, z, z) + inline val rr get() = Vector2d(r, r) + inline val rg get() = Vector2d(r, g) + inline val rb get() = Vector2d(r, b) + inline val gr get() = Vector2d(g, r) + inline val gg get() = Vector2d(g, g) + inline val gb get() = Vector2d(g, b) + inline val br get() = Vector2d(b, r) + inline val bg get() = Vector2d(b, g) + inline val bb get() = Vector2d(b, b) + inline val rrr get() = Vector3d(r, r, r) + inline val rrg get() = Vector3d(r, r, g) + inline val rrb get() = Vector3d(r, r, b) + inline val rgr get() = Vector3d(r, g, r) + inline val rgg get() = Vector3d(r, g, g) + inline val rgb get() = Vector3d(r, g, b) + inline val rbr get() = Vector3d(r, b, r) + inline val rbg get() = Vector3d(r, b, g) + inline val rbb get() = Vector3d(r, b, b) + inline val grr get() = Vector3d(g, r, r) + inline val grg get() = Vector3d(g, r, g) + inline val grb get() = Vector3d(g, r, b) + inline val ggr get() = Vector3d(g, g, r) + inline val ggg get() = Vector3d(g, g, g) + inline val ggb get() = Vector3d(g, g, b) + inline val gbr get() = Vector3d(g, b, r) + inline val gbg get() = Vector3d(g, b, g) + inline val gbb get() = Vector3d(g, b, b) + inline val brr get() = Vector3d(b, r, r) + inline val brg get() = Vector3d(b, r, g) + inline val brb get() = Vector3d(b, r, b) + inline val bgr get() = Vector3d(b, g, r) + inline val bgg get() = Vector3d(b, g, g) + inline val bgb get() = Vector3d(b, g, b) + inline val bbr get() = Vector3d(b, b, r) + inline val bbg get() = Vector3d(b, b, g) + inline val bbb get() = Vector3d(b, b, b) + inline val rrrr get() = Vector4d(r, r, r, r) + inline val rrrg get() = Vector4d(r, r, r, g) + inline val rrrb get() = Vector4d(r, r, r, b) + inline val rrgr get() = Vector4d(r, r, g, r) + inline val rrgg get() = Vector4d(r, r, g, g) + inline val rrgb get() = Vector4d(r, r, g, b) + inline val rrbr get() = Vector4d(r, r, b, r) + inline val rrbg get() = Vector4d(r, r, b, g) + inline val rrbb get() = Vector4d(r, r, b, b) + inline val rgrr get() = Vector4d(r, g, r, r) + inline val rgrg get() = Vector4d(r, g, r, g) + inline val rgrb get() = Vector4d(r, g, r, b) + inline val rggr get() = Vector4d(r, g, g, r) + inline val rggg get() = Vector4d(r, g, g, g) + inline val rggb get() = Vector4d(r, g, g, b) + inline val rgbr get() = Vector4d(r, g, b, r) + inline val rgbg get() = Vector4d(r, g, b, g) + inline val rgbb get() = Vector4d(r, g, b, b) + inline val rbrr get() = Vector4d(r, b, r, r) + inline val rbrg get() = Vector4d(r, b, r, g) + inline val rbrb get() = Vector4d(r, b, r, b) + inline val rbgr get() = Vector4d(r, b, g, r) + inline val rbgg get() = Vector4d(r, b, g, g) + inline val rbgb get() = Vector4d(r, b, g, b) + inline val rbbr get() = Vector4d(r, b, b, r) + inline val rbbg get() = Vector4d(r, b, b, g) + inline val rbbb get() = Vector4d(r, b, b, b) + inline val grrr get() = Vector4d(g, r, r, r) + inline val grrg get() = Vector4d(g, r, r, g) + inline val grrb get() = Vector4d(g, r, r, b) + inline val grgr get() = Vector4d(g, r, g, r) + inline val grgg get() = Vector4d(g, r, g, g) + inline val grgb get() = Vector4d(g, r, g, b) + inline val grbr get() = Vector4d(g, r, b, r) + inline val grbg get() = Vector4d(g, r, b, g) + inline val grbb get() = Vector4d(g, r, b, b) + inline val ggrr get() = Vector4d(g, g, r, r) + inline val ggrg get() = Vector4d(g, g, r, g) + inline val ggrb get() = Vector4d(g, g, r, b) + inline val gggr get() = Vector4d(g, g, g, r) + inline val gggg get() = Vector4d(g, g, g, g) + inline val gggb get() = Vector4d(g, g, g, b) + inline val ggbr get() = Vector4d(g, g, b, r) + inline val ggbg get() = Vector4d(g, g, b, g) + inline val ggbb get() = Vector4d(g, g, b, b) + inline val gbrr get() = Vector4d(g, b, r, r) + inline val gbrg get() = Vector4d(g, b, r, g) + inline val gbrb get() = Vector4d(g, b, r, b) + inline val gbgr get() = Vector4d(g, b, g, r) + inline val gbgg get() = Vector4d(g, b, g, g) + inline val gbgb get() = Vector4d(g, b, g, b) + inline val gbbr get() = Vector4d(g, b, b, r) + inline val gbbg get() = Vector4d(g, b, b, g) + inline val gbbb get() = Vector4d(g, b, b, b) + inline val brrr get() = Vector4d(b, r, r, r) + inline val brrg get() = Vector4d(b, r, r, g) + inline val brrb get() = Vector4d(b, r, r, b) + inline val brgr get() = Vector4d(b, r, g, r) + inline val brgg get() = Vector4d(b, r, g, g) + inline val brgb get() = Vector4d(b, r, g, b) + inline val brbr get() = Vector4d(b, r, b, r) + inline val brbg get() = Vector4d(b, r, b, g) + inline val brbb get() = Vector4d(b, r, b, b) + inline val bgrr get() = Vector4d(b, g, r, r) + inline val bgrg get() = Vector4d(b, g, r, g) + inline val bgrb get() = Vector4d(b, g, r, b) + inline val bggr get() = Vector4d(b, g, g, r) + inline val bggg get() = Vector4d(b, g, g, g) + inline val bggb get() = Vector4d(b, g, g, b) + inline val bgbr get() = Vector4d(b, g, b, r) + inline val bgbg get() = Vector4d(b, g, b, g) + inline val bgbb get() = Vector4d(b, g, b, b) + inline val bbrr get() = Vector4d(b, b, r, r) + inline val bbrg get() = Vector4d(b, b, r, g) + inline val bbrb get() = Vector4d(b, b, r, b) + inline val bbgr get() = Vector4d(b, b, g, r) + inline val bbgg get() = Vector4d(b, b, g, g) + inline val bbgb get() = Vector4d(b, b, g, b) + inline val bbbr get() = Vector4d(b, b, b, r) + inline val bbbg get() = Vector4d(b, b, b, g) + inline val bbbb get() = Vector4d(b, b, b, b) + inline val ss get() = Vector2d(s, s) + inline val st get() = Vector2d(s, t) + inline val sp get() = Vector2d(s, p) + inline val ts get() = Vector2d(t, s) + inline val tt get() = Vector2d(t, t) + inline val tp get() = Vector2d(t, p) + inline val ps get() = Vector2d(p, s) + inline val pt get() = Vector2d(p, t) + inline val pp get() = Vector2d(p, p) + inline val sss get() = Vector3d(s, s, s) + inline val sst get() = Vector3d(s, s, t) + inline val ssp get() = Vector3d(s, s, p) + inline val sts get() = Vector3d(s, t, s) + inline val stt get() = Vector3d(s, t, t) + inline val stp get() = Vector3d(s, t, p) + inline val sps get() = Vector3d(s, p, s) + inline val spt get() = Vector3d(s, p, t) + inline val spp get() = Vector3d(s, p, p) + inline val tss get() = Vector3d(t, s, s) + inline val tst get() = Vector3d(t, s, t) + inline val tsp get() = Vector3d(t, s, p) + inline val tts get() = Vector3d(t, t, s) + inline val ttt get() = Vector3d(t, t, t) + inline val ttp get() = Vector3d(t, t, p) + inline val tps get() = Vector3d(t, p, s) + inline val tpt get() = Vector3d(t, p, t) + inline val tpp get() = Vector3d(t, p, p) + inline val pss get() = Vector3d(p, s, s) + inline val pst get() = Vector3d(p, s, t) + inline val psp get() = Vector3d(p, s, p) + inline val pts get() = Vector3d(p, t, s) + inline val ptt get() = Vector3d(p, t, t) + inline val ptp get() = Vector3d(p, t, p) + inline val pps get() = Vector3d(p, p, s) + inline val ppt get() = Vector3d(p, p, t) + inline val ppp get() = Vector3d(p, p, p) + inline val ssss get() = Vector4d(s, s, s, s) + inline val ssst get() = Vector4d(s, s, s, t) + inline val sssp get() = Vector4d(s, s, s, p) + inline val ssts get() = Vector4d(s, s, t, s) + inline val sstt get() = Vector4d(s, s, t, t) + inline val sstp get() = Vector4d(s, s, t, p) + inline val ssps get() = Vector4d(s, s, p, s) + inline val sspt get() = Vector4d(s, s, p, t) + inline val sspp get() = Vector4d(s, s, p, p) + inline val stss get() = Vector4d(s, t, s, s) + inline val stst get() = Vector4d(s, t, s, t) + inline val stsp get() = Vector4d(s, t, s, p) + inline val stts get() = Vector4d(s, t, t, s) + inline val sttt get() = Vector4d(s, t, t, t) + inline val sttp get() = Vector4d(s, t, t, p) + inline val stps get() = Vector4d(s, t, p, s) + inline val stpt get() = Vector4d(s, t, p, t) + inline val stpp get() = Vector4d(s, t, p, p) + inline val spss get() = Vector4d(s, p, s, s) + inline val spst get() = Vector4d(s, p, s, t) + inline val spsp get() = Vector4d(s, p, s, p) + inline val spts get() = Vector4d(s, p, t, s) + inline val sptt get() = Vector4d(s, p, t, t) + inline val sptp get() = Vector4d(s, p, t, p) + inline val spps get() = Vector4d(s, p, p, s) + inline val sppt get() = Vector4d(s, p, p, t) + inline val sppp get() = Vector4d(s, p, p, p) + inline val tsss get() = Vector4d(t, s, s, s) + inline val tsst get() = Vector4d(t, s, s, t) + inline val tssp get() = Vector4d(t, s, s, p) + inline val tsts get() = Vector4d(t, s, t, s) + inline val tstt get() = Vector4d(t, s, t, t) + inline val tstp get() = Vector4d(t, s, t, p) + inline val tsps get() = Vector4d(t, s, p, s) + inline val tspt get() = Vector4d(t, s, p, t) + inline val tspp get() = Vector4d(t, s, p, p) + inline val ttss get() = Vector4d(t, t, s, s) + inline val ttst get() = Vector4d(t, t, s, t) + inline val ttsp get() = Vector4d(t, t, s, p) + inline val ttts get() = Vector4d(t, t, t, s) + inline val tttt get() = Vector4d(t, t, t, t) + inline val tttp get() = Vector4d(t, t, t, p) + inline val ttps get() = Vector4d(t, t, p, s) + inline val ttpt get() = Vector4d(t, t, p, t) + inline val ttpp get() = Vector4d(t, t, p, p) + inline val tpss get() = Vector4d(t, p, s, s) + inline val tpst get() = Vector4d(t, p, s, t) + inline val tpsp get() = Vector4d(t, p, s, p) + inline val tpts get() = Vector4d(t, p, t, s) + inline val tptt get() = Vector4d(t, p, t, t) + inline val tptp get() = Vector4d(t, p, t, p) + inline val tpps get() = Vector4d(t, p, p, s) + inline val tppt get() = Vector4d(t, p, p, t) + inline val tppp get() = Vector4d(t, p, p, p) + inline val psss get() = Vector4d(p, s, s, s) + inline val psst get() = Vector4d(p, s, s, t) + inline val pssp get() = Vector4d(p, s, s, p) + inline val psts get() = Vector4d(p, s, t, s) + inline val pstt get() = Vector4d(p, s, t, t) + inline val pstp get() = Vector4d(p, s, t, p) + inline val psps get() = Vector4d(p, s, p, s) + inline val pspt get() = Vector4d(p, s, p, t) + inline val pspp get() = Vector4d(p, s, p, p) + inline val ptss get() = Vector4d(p, t, s, s) + inline val ptst get() = Vector4d(p, t, s, t) + inline val ptsp get() = Vector4d(p, t, s, p) + inline val ptts get() = Vector4d(p, t, t, s) + inline val pttt get() = Vector4d(p, t, t, t) + inline val pttp get() = Vector4d(p, t, t, p) + inline val ptps get() = Vector4d(p, t, p, s) + inline val ptpt get() = Vector4d(p, t, p, t) + inline val ptpp get() = Vector4d(p, t, p, p) + inline val ppss get() = Vector4d(p, p, s, s) + inline val ppst get() = Vector4d(p, p, s, t) + inline val ppsp get() = Vector4d(p, p, s, p) + inline val ppts get() = Vector4d(p, p, t, s) + inline val pptt get() = Vector4d(p, p, t, t) + inline val pptp get() = Vector4d(p, p, t, p) + inline val ppps get() = Vector4d(p, p, p, s) + inline val pppt get() = Vector4d(p, p, p, t) + inline val pppp get() = Vector4d(p, p, p, p) + + companion object { + @JvmField val ZERO = Vector3d() + @JvmField val POSITIVE_X = Vector3d(x = 1.0) + @JvmField val NEGATIVE_X = Vector3d(x = -1.0) + @JvmField val POSITIVE_Y = Vector3d(y = 1.0) + @JvmField val NEGATIVE_Y = Vector3d(y = -1.0) + @JvmField val POSITIVE_Z = Vector3d(z = 1.0) + @JvmField val NEGATIVE_Z = Vector3d(z = -1.0) + } +} + +fun Double.div(other: Vector3d): Vector3d { + return Vector3d(this / other.x, this / other.y, this / other.z) +} + +fun Double.times(other: Vector3d): Vector3d { + return Vector3d(this * other.x, this * other.y, this * other.z) +} + +/** + * Mutable 3D Vector, representing three-dimensional coordinates as [Double]s + * + * It can be safely passed around to methods which expect immutable [Vector3d], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector3d( + override var x: Double = 0.0, + override var y: Double = 0.0, + override var z: Double = 0.0, +) : Vector3d(x, y, z), IMutableDoubleVector, IMutableFractionalVector, IMutableVector, IMatrixSetterDouble { + constructor(input: IStruct2d, z: Double = 0.0) : this(input.component1(), input.component2(), z) + constructor(x: Double, input: IStruct2d) : this(x, input.component1(), input.component2()) + constructor(input: IStruct3d) : this(input.component1(), input.component2(), input.component3()) + + override fun set(column: Int, row: Int, value: Double) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + 2 -> z = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + override var b by this::z + + override var s by this::x + override var t by this::y + override var p by this::z + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector3d + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + + return true + } + + override fun normalize(): Double { + val len = length + + if (len == 0.0) { + return 0.0 + } + + x /= len + y /= len + z /= len + return len + } + + override fun plusMut(other: Vector3d): MutableVector3d { + x += other.x + y += other.y + z += other.z + return this + } + + override fun minusMut(other: Vector3d): MutableVector3d { + x -= other.x + y -= other.y + z -= other.z + return this + } + + override fun timesMut(other: Vector3d): MutableVector3d { + x *= other.x + y *= other.y + z *= other.z + return this + } + + override fun divMut(other: Vector3d): MutableVector3d { + x /= other.x + y /= other.y + z /= other.z + return this + } + + override fun timesMut(other: Double): MutableVector3d { + x *= other + y *= other + z *= other + return this + } + + override fun divMut(other: Double): MutableVector3d { + x /= other + y /= other + z /= other + return this + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector4d.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector4d.kt new file mode 100644 index 00000000..d1c28fb2 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/ndouble/Vector4d.kt @@ -0,0 +1,1372 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.ndouble + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 4D Vector, representing four-dimensional coordinates as [Double]s + */ +open class Vector4d( + open val x: Double = 0.0, + open val y: Double = 0.0, + open val z: Double = 0.0, + open val w: Double = 0.0, +) : AbstractVector(), IFractionalVector, IDoubleVector, IStruct4d, IMatrixGetterDouble { + final override fun component1() = x + final override fun component2() = y + final override fun component3() = z + final override fun component4() = w + + override fun get(column: Int, row: Int): Double { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + 2 -> z + 3 -> w + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + constructor(input: IStruct2d, z: Double = 0.0, w: Double = 0.0) : this(input.component1(), input.component2(), z, w) + constructor(x: Double, input: IStruct2d, w: Double = 0.0) : this(x, input.component1(), input.component2(), w) + constructor(x: Double, y: Double, input: IStruct2d) : this(x, y, input.component1(), input.component2()) + + constructor(input: IStruct3d, w: Double = 0.0) : this(input.component1(), input.component2(), input.component3(), w) + constructor(x: Double, input: IStruct3d) : this(x, input.component1(), input.component2(), input.component3()) + constructor(input: IStruct4d) : this(input.component1(), input.component2(), input.component3(), input.component4()) + + open val r by this::x + open val g by this::y + open val b by this::z + open val a by this::w + + open val s by this::x + open val t by this::y + open val p by this::z + open val q by this::w + + final override val rows: Int = 4 + final override val lengthSquared: Double + get() = x * x + y * y + z * z + w * w + final override val isFinite: Boolean + get() = x.isFinite() && y.isFinite() && z.isFinite() && w.isFinite() + final override val isNaN: Boolean + get() = x.isNaN() || y.isNaN() || z.isNaN() || w.isNaN() + + override fun plus(other: Vector4d): Vector4d { + return Vector4d( + x + other.x, + y + other.y, + z + other.z, + w + other.w + ) + } + + override fun minus(other: Vector4d): Vector4d { + return Vector4d( + x - other.x, + y - other.y, + z - other.z, + w - other.w + ) + } + + override fun times(other: Vector4d): Vector4d { + return Vector4d( + x * other.x, + y * other.y, + z * other.z, + w * other.w + ) + } + + override fun div(other: Vector4d): Vector4d { + return Vector4d( + x / other.x, + y / other.y, + z / other.z, + w / other.w + ) + } + + override val absoluteValue: Vector4d + get() = Vector4d(x.absoluteValue, y.absoluteValue, z.absoluteValue, w.absoluteValue) + + override fun coerceAtMost(maximal: Vector4d): Vector4d { + return Vector4d( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + z.coerceAtMost(maximal.z), + w.coerceAtMost(maximal.w), + ) + } + + override fun coerceAtLeast(minimal: Vector4d): Vector4d { + return Vector4d( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + z.coerceAtLeast(minimal.z), + w.coerceAtLeast(minimal.w), + ) + } + + override fun clamp(minimal: Vector4d, maximal: Vector4d): Vector4d { + return Vector4d( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + z.coerceAtLeast(minimal.z).coerceAtMost(maximal.z), + w.coerceAtLeast(minimal.w).coerceAtMost(maximal.w), + ) + } + + override fun unaryMinus(): Vector4d { + return Vector4d(-x, -y, -z, -w) + } + + override fun distanceSquared(other: Vector4d): Double { + val x = x - other.x + val y = y - other.y + val z = z - other.z + val w = w - other.w + + return x * x + y * y + z * z + w * w + } + + override val normalized: Vector4d + get() { + val len = length + + if (len == 0.0) { + return ZERO + } + + return Vector4d( + x / len, + y / len, + z / len, + w / len, + ) + } + + override fun times(other: Double): Vector4d { + return Vector4d( + x * other, + y * other, + z * other, + w * other + ) + } + + override fun div(other: Double): Vector4d { + return Vector4d( + x / other, + y / other, + z / other, + w / other + ) + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector4d): Double { + return other.x * x + other.y * y + other.z * z + other.w * w + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector3d): Double { + return other.x * x + other.y * y + other.z * z + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector2d): Double { + return other.x * x + other.y * y + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector4d + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + if (w != other.w) return false + + return true + } + + override fun hashCode(): Int { + var result = x.hashCode() + result = 31 * result + y.hashCode() + result = 31 * result + z.hashCode() + result = 31 * result + w.hashCode() + return result + } + + override fun toString(): String { + return "[$x $y $z $w]" + } + + inline val xx get() = Vector2d(x, x) + inline val xy get() = Vector2d(x, y) + inline val xz get() = Vector2d(x, z) + inline val xw get() = Vector2d(x, w) + inline val yx get() = Vector2d(y, x) + inline val yy get() = Vector2d(y, y) + inline val yz get() = Vector2d(y, z) + inline val yw get() = Vector2d(y, w) + inline val zx get() = Vector2d(z, x) + inline val zy get() = Vector2d(z, y) + inline val zz get() = Vector2d(z, z) + inline val zw get() = Vector2d(z, w) + inline val wx get() = Vector2d(w, x) + inline val wy get() = Vector2d(w, y) + inline val wz get() = Vector2d(w, z) + inline val ww get() = Vector2d(w, w) + inline val xxx get() = Vector3d(x, x, x) + inline val xxy get() = Vector3d(x, x, y) + inline val xxz get() = Vector3d(x, x, z) + inline val xxw get() = Vector3d(x, x, w) + inline val xyx get() = Vector3d(x, y, x) + inline val xyy get() = Vector3d(x, y, y) + inline val xyz get() = Vector3d(x, y, z) + inline val xyw get() = Vector3d(x, y, w) + inline val xzx get() = Vector3d(x, z, x) + inline val xzy get() = Vector3d(x, z, y) + inline val xzz get() = Vector3d(x, z, z) + inline val xzw get() = Vector3d(x, z, w) + inline val xwx get() = Vector3d(x, w, x) + inline val xwy get() = Vector3d(x, w, y) + inline val xwz get() = Vector3d(x, w, z) + inline val xww get() = Vector3d(x, w, w) + inline val yxx get() = Vector3d(y, x, x) + inline val yxy get() = Vector3d(y, x, y) + inline val yxz get() = Vector3d(y, x, z) + inline val yxw get() = Vector3d(y, x, w) + inline val yyx get() = Vector3d(y, y, x) + inline val yyy get() = Vector3d(y, y, y) + inline val yyz get() = Vector3d(y, y, z) + inline val yyw get() = Vector3d(y, y, w) + inline val yzx get() = Vector3d(y, z, x) + inline val yzy get() = Vector3d(y, z, y) + inline val yzz get() = Vector3d(y, z, z) + inline val yzw get() = Vector3d(y, z, w) + inline val ywx get() = Vector3d(y, w, x) + inline val ywy get() = Vector3d(y, w, y) + inline val ywz get() = Vector3d(y, w, z) + inline val yww get() = Vector3d(y, w, w) + inline val zxx get() = Vector3d(z, x, x) + inline val zxy get() = Vector3d(z, x, y) + inline val zxz get() = Vector3d(z, x, z) + inline val zxw get() = Vector3d(z, x, w) + inline val zyx get() = Vector3d(z, y, x) + inline val zyy get() = Vector3d(z, y, y) + inline val zyz get() = Vector3d(z, y, z) + inline val zyw get() = Vector3d(z, y, w) + inline val zzx get() = Vector3d(z, z, x) + inline val zzy get() = Vector3d(z, z, y) + inline val zzz get() = Vector3d(z, z, z) + inline val zzw get() = Vector3d(z, z, w) + inline val zwx get() = Vector3d(z, w, x) + inline val zwy get() = Vector3d(z, w, y) + inline val zwz get() = Vector3d(z, w, z) + inline val zww get() = Vector3d(z, w, w) + inline val wxx get() = Vector3d(w, x, x) + inline val wxy get() = Vector3d(w, x, y) + inline val wxz get() = Vector3d(w, x, z) + inline val wxw get() = Vector3d(w, x, w) + inline val wyx get() = Vector3d(w, y, x) + inline val wyy get() = Vector3d(w, y, y) + inline val wyz get() = Vector3d(w, y, z) + inline val wyw get() = Vector3d(w, y, w) + inline val wzx get() = Vector3d(w, z, x) + inline val wzy get() = Vector3d(w, z, y) + inline val wzz get() = Vector3d(w, z, z) + inline val wzw get() = Vector3d(w, z, w) + inline val wwx get() = Vector3d(w, w, x) + inline val wwy get() = Vector3d(w, w, y) + inline val wwz get() = Vector3d(w, w, z) + inline val www get() = Vector3d(w, w, w) + inline val xxxx get() = Vector4d(x, x, x, x) + inline val xxxy get() = Vector4d(x, x, x, y) + inline val xxxz get() = Vector4d(x, x, x, z) + inline val xxxw get() = Vector4d(x, x, x, w) + inline val xxyx get() = Vector4d(x, x, y, x) + inline val xxyy get() = Vector4d(x, x, y, y) + inline val xxyz get() = Vector4d(x, x, y, z) + inline val xxyw get() = Vector4d(x, x, y, w) + inline val xxzx get() = Vector4d(x, x, z, x) + inline val xxzy get() = Vector4d(x, x, z, y) + inline val xxzz get() = Vector4d(x, x, z, z) + inline val xxzw get() = Vector4d(x, x, z, w) + inline val xxwx get() = Vector4d(x, x, w, x) + inline val xxwy get() = Vector4d(x, x, w, y) + inline val xxwz get() = Vector4d(x, x, w, z) + inline val xxww get() = Vector4d(x, x, w, w) + inline val xyxx get() = Vector4d(x, y, x, x) + inline val xyxy get() = Vector4d(x, y, x, y) + inline val xyxz get() = Vector4d(x, y, x, z) + inline val xyxw get() = Vector4d(x, y, x, w) + inline val xyyx get() = Vector4d(x, y, y, x) + inline val xyyy get() = Vector4d(x, y, y, y) + inline val xyyz get() = Vector4d(x, y, y, z) + inline val xyyw get() = Vector4d(x, y, y, w) + inline val xyzx get() = Vector4d(x, y, z, x) + inline val xyzy get() = Vector4d(x, y, z, y) + inline val xyzz get() = Vector4d(x, y, z, z) + inline val xyzw get() = Vector4d(x, y, z, w) + inline val xywx get() = Vector4d(x, y, w, x) + inline val xywy get() = Vector4d(x, y, w, y) + inline val xywz get() = Vector4d(x, y, w, z) + inline val xyww get() = Vector4d(x, y, w, w) + inline val xzxx get() = Vector4d(x, z, x, x) + inline val xzxy get() = Vector4d(x, z, x, y) + inline val xzxz get() = Vector4d(x, z, x, z) + inline val xzxw get() = Vector4d(x, z, x, w) + inline val xzyx get() = Vector4d(x, z, y, x) + inline val xzyy get() = Vector4d(x, z, y, y) + inline val xzyz get() = Vector4d(x, z, y, z) + inline val xzyw get() = Vector4d(x, z, y, w) + inline val xzzx get() = Vector4d(x, z, z, x) + inline val xzzy get() = Vector4d(x, z, z, y) + inline val xzzz get() = Vector4d(x, z, z, z) + inline val xzzw get() = Vector4d(x, z, z, w) + inline val xzwx get() = Vector4d(x, z, w, x) + inline val xzwy get() = Vector4d(x, z, w, y) + inline val xzwz get() = Vector4d(x, z, w, z) + inline val xzww get() = Vector4d(x, z, w, w) + inline val xwxx get() = Vector4d(x, w, x, x) + inline val xwxy get() = Vector4d(x, w, x, y) + inline val xwxz get() = Vector4d(x, w, x, z) + inline val xwxw get() = Vector4d(x, w, x, w) + inline val xwyx get() = Vector4d(x, w, y, x) + inline val xwyy get() = Vector4d(x, w, y, y) + inline val xwyz get() = Vector4d(x, w, y, z) + inline val xwyw get() = Vector4d(x, w, y, w) + inline val xwzx get() = Vector4d(x, w, z, x) + inline val xwzy get() = Vector4d(x, w, z, y) + inline val xwzz get() = Vector4d(x, w, z, z) + inline val xwzw get() = Vector4d(x, w, z, w) + inline val xwwx get() = Vector4d(x, w, w, x) + inline val xwwy get() = Vector4d(x, w, w, y) + inline val xwwz get() = Vector4d(x, w, w, z) + inline val xwww get() = Vector4d(x, w, w, w) + inline val yxxx get() = Vector4d(y, x, x, x) + inline val yxxy get() = Vector4d(y, x, x, y) + inline val yxxz get() = Vector4d(y, x, x, z) + inline val yxxw get() = Vector4d(y, x, x, w) + inline val yxyx get() = Vector4d(y, x, y, x) + inline val yxyy get() = Vector4d(y, x, y, y) + inline val yxyz get() = Vector4d(y, x, y, z) + inline val yxyw get() = Vector4d(y, x, y, w) + inline val yxzx get() = Vector4d(y, x, z, x) + inline val yxzy get() = Vector4d(y, x, z, y) + inline val yxzz get() = Vector4d(y, x, z, z) + inline val yxzw get() = Vector4d(y, x, z, w) + inline val yxwx get() = Vector4d(y, x, w, x) + inline val yxwy get() = Vector4d(y, x, w, y) + inline val yxwz get() = Vector4d(y, x, w, z) + inline val yxww get() = Vector4d(y, x, w, w) + inline val yyxx get() = Vector4d(y, y, x, x) + inline val yyxy get() = Vector4d(y, y, x, y) + inline val yyxz get() = Vector4d(y, y, x, z) + inline val yyxw get() = Vector4d(y, y, x, w) + inline val yyyx get() = Vector4d(y, y, y, x) + inline val yyyy get() = Vector4d(y, y, y, y) + inline val yyyz get() = Vector4d(y, y, y, z) + inline val yyyw get() = Vector4d(y, y, y, w) + inline val yyzx get() = Vector4d(y, y, z, x) + inline val yyzy get() = Vector4d(y, y, z, y) + inline val yyzz get() = Vector4d(y, y, z, z) + inline val yyzw get() = Vector4d(y, y, z, w) + inline val yywx get() = Vector4d(y, y, w, x) + inline val yywy get() = Vector4d(y, y, w, y) + inline val yywz get() = Vector4d(y, y, w, z) + inline val yyww get() = Vector4d(y, y, w, w) + inline val yzxx get() = Vector4d(y, z, x, x) + inline val yzxy get() = Vector4d(y, z, x, y) + inline val yzxz get() = Vector4d(y, z, x, z) + inline val yzxw get() = Vector4d(y, z, x, w) + inline val yzyx get() = Vector4d(y, z, y, x) + inline val yzyy get() = Vector4d(y, z, y, y) + inline val yzyz get() = Vector4d(y, z, y, z) + inline val yzyw get() = Vector4d(y, z, y, w) + inline val yzzx get() = Vector4d(y, z, z, x) + inline val yzzy get() = Vector4d(y, z, z, y) + inline val yzzz get() = Vector4d(y, z, z, z) + inline val yzzw get() = Vector4d(y, z, z, w) + inline val yzwx get() = Vector4d(y, z, w, x) + inline val yzwy get() = Vector4d(y, z, w, y) + inline val yzwz get() = Vector4d(y, z, w, z) + inline val yzww get() = Vector4d(y, z, w, w) + inline val ywxx get() = Vector4d(y, w, x, x) + inline val ywxy get() = Vector4d(y, w, x, y) + inline val ywxz get() = Vector4d(y, w, x, z) + inline val ywxw get() = Vector4d(y, w, x, w) + inline val ywyx get() = Vector4d(y, w, y, x) + inline val ywyy get() = Vector4d(y, w, y, y) + inline val ywyz get() = Vector4d(y, w, y, z) + inline val ywyw get() = Vector4d(y, w, y, w) + inline val ywzx get() = Vector4d(y, w, z, x) + inline val ywzy get() = Vector4d(y, w, z, y) + inline val ywzz get() = Vector4d(y, w, z, z) + inline val ywzw get() = Vector4d(y, w, z, w) + inline val ywwx get() = Vector4d(y, w, w, x) + inline val ywwy get() = Vector4d(y, w, w, y) + inline val ywwz get() = Vector4d(y, w, w, z) + inline val ywww get() = Vector4d(y, w, w, w) + inline val zxxx get() = Vector4d(z, x, x, x) + inline val zxxy get() = Vector4d(z, x, x, y) + inline val zxxz get() = Vector4d(z, x, x, z) + inline val zxxw get() = Vector4d(z, x, x, w) + inline val zxyx get() = Vector4d(z, x, y, x) + inline val zxyy get() = Vector4d(z, x, y, y) + inline val zxyz get() = Vector4d(z, x, y, z) + inline val zxyw get() = Vector4d(z, x, y, w) + inline val zxzx get() = Vector4d(z, x, z, x) + inline val zxzy get() = Vector4d(z, x, z, y) + inline val zxzz get() = Vector4d(z, x, z, z) + inline val zxzw get() = Vector4d(z, x, z, w) + inline val zxwx get() = Vector4d(z, x, w, x) + inline val zxwy get() = Vector4d(z, x, w, y) + inline val zxwz get() = Vector4d(z, x, w, z) + inline val zxww get() = Vector4d(z, x, w, w) + inline val zyxx get() = Vector4d(z, y, x, x) + inline val zyxy get() = Vector4d(z, y, x, y) + inline val zyxz get() = Vector4d(z, y, x, z) + inline val zyxw get() = Vector4d(z, y, x, w) + inline val zyyx get() = Vector4d(z, y, y, x) + inline val zyyy get() = Vector4d(z, y, y, y) + inline val zyyz get() = Vector4d(z, y, y, z) + inline val zyyw get() = Vector4d(z, y, y, w) + inline val zyzx get() = Vector4d(z, y, z, x) + inline val zyzy get() = Vector4d(z, y, z, y) + inline val zyzz get() = Vector4d(z, y, z, z) + inline val zyzw get() = Vector4d(z, y, z, w) + inline val zywx get() = Vector4d(z, y, w, x) + inline val zywy get() = Vector4d(z, y, w, y) + inline val zywz get() = Vector4d(z, y, w, z) + inline val zyww get() = Vector4d(z, y, w, w) + inline val zzxx get() = Vector4d(z, z, x, x) + inline val zzxy get() = Vector4d(z, z, x, y) + inline val zzxz get() = Vector4d(z, z, x, z) + inline val zzxw get() = Vector4d(z, z, x, w) + inline val zzyx get() = Vector4d(z, z, y, x) + inline val zzyy get() = Vector4d(z, z, y, y) + inline val zzyz get() = Vector4d(z, z, y, z) + inline val zzyw get() = Vector4d(z, z, y, w) + inline val zzzx get() = Vector4d(z, z, z, x) + inline val zzzy get() = Vector4d(z, z, z, y) + inline val zzzz get() = Vector4d(z, z, z, z) + inline val zzzw get() = Vector4d(z, z, z, w) + inline val zzwx get() = Vector4d(z, z, w, x) + inline val zzwy get() = Vector4d(z, z, w, y) + inline val zzwz get() = Vector4d(z, z, w, z) + inline val zzww get() = Vector4d(z, z, w, w) + inline val zwxx get() = Vector4d(z, w, x, x) + inline val zwxy get() = Vector4d(z, w, x, y) + inline val zwxz get() = Vector4d(z, w, x, z) + inline val zwxw get() = Vector4d(z, w, x, w) + inline val zwyx get() = Vector4d(z, w, y, x) + inline val zwyy get() = Vector4d(z, w, y, y) + inline val zwyz get() = Vector4d(z, w, y, z) + inline val zwyw get() = Vector4d(z, w, y, w) + inline val zwzx get() = Vector4d(z, w, z, x) + inline val zwzy get() = Vector4d(z, w, z, y) + inline val zwzz get() = Vector4d(z, w, z, z) + inline val zwzw get() = Vector4d(z, w, z, w) + inline val zwwx get() = Vector4d(z, w, w, x) + inline val zwwy get() = Vector4d(z, w, w, y) + inline val zwwz get() = Vector4d(z, w, w, z) + inline val zwww get() = Vector4d(z, w, w, w) + inline val wxxx get() = Vector4d(w, x, x, x) + inline val wxxy get() = Vector4d(w, x, x, y) + inline val wxxz get() = Vector4d(w, x, x, z) + inline val wxxw get() = Vector4d(w, x, x, w) + inline val wxyx get() = Vector4d(w, x, y, x) + inline val wxyy get() = Vector4d(w, x, y, y) + inline val wxyz get() = Vector4d(w, x, y, z) + inline val wxyw get() = Vector4d(w, x, y, w) + inline val wxzx get() = Vector4d(w, x, z, x) + inline val wxzy get() = Vector4d(w, x, z, y) + inline val wxzz get() = Vector4d(w, x, z, z) + inline val wxzw get() = Vector4d(w, x, z, w) + inline val wxwx get() = Vector4d(w, x, w, x) + inline val wxwy get() = Vector4d(w, x, w, y) + inline val wxwz get() = Vector4d(w, x, w, z) + inline val wxww get() = Vector4d(w, x, w, w) + inline val wyxx get() = Vector4d(w, y, x, x) + inline val wyxy get() = Vector4d(w, y, x, y) + inline val wyxz get() = Vector4d(w, y, x, z) + inline val wyxw get() = Vector4d(w, y, x, w) + inline val wyyx get() = Vector4d(w, y, y, x) + inline val wyyy get() = Vector4d(w, y, y, y) + inline val wyyz get() = Vector4d(w, y, y, z) + inline val wyyw get() = Vector4d(w, y, y, w) + inline val wyzx get() = Vector4d(w, y, z, x) + inline val wyzy get() = Vector4d(w, y, z, y) + inline val wyzz get() = Vector4d(w, y, z, z) + inline val wyzw get() = Vector4d(w, y, z, w) + inline val wywx get() = Vector4d(w, y, w, x) + inline val wywy get() = Vector4d(w, y, w, y) + inline val wywz get() = Vector4d(w, y, w, z) + inline val wyww get() = Vector4d(w, y, w, w) + inline val wzxx get() = Vector4d(w, z, x, x) + inline val wzxy get() = Vector4d(w, z, x, y) + inline val wzxz get() = Vector4d(w, z, x, z) + inline val wzxw get() = Vector4d(w, z, x, w) + inline val wzyx get() = Vector4d(w, z, y, x) + inline val wzyy get() = Vector4d(w, z, y, y) + inline val wzyz get() = Vector4d(w, z, y, z) + inline val wzyw get() = Vector4d(w, z, y, w) + inline val wzzx get() = Vector4d(w, z, z, x) + inline val wzzy get() = Vector4d(w, z, z, y) + inline val wzzz get() = Vector4d(w, z, z, z) + inline val wzzw get() = Vector4d(w, z, z, w) + inline val wzwx get() = Vector4d(w, z, w, x) + inline val wzwy get() = Vector4d(w, z, w, y) + inline val wzwz get() = Vector4d(w, z, w, z) + inline val wzww get() = Vector4d(w, z, w, w) + inline val wwxx get() = Vector4d(w, w, x, x) + inline val wwxy get() = Vector4d(w, w, x, y) + inline val wwxz get() = Vector4d(w, w, x, z) + inline val wwxw get() = Vector4d(w, w, x, w) + inline val wwyx get() = Vector4d(w, w, y, x) + inline val wwyy get() = Vector4d(w, w, y, y) + inline val wwyz get() = Vector4d(w, w, y, z) + inline val wwyw get() = Vector4d(w, w, y, w) + inline val wwzx get() = Vector4d(w, w, z, x) + inline val wwzy get() = Vector4d(w, w, z, y) + inline val wwzz get() = Vector4d(w, w, z, z) + inline val wwzw get() = Vector4d(w, w, z, w) + inline val wwwx get() = Vector4d(w, w, w, x) + inline val wwwy get() = Vector4d(w, w, w, y) + inline val wwwz get() = Vector4d(w, w, w, z) + inline val wwww get() = Vector4d(w, w, w, w) + inline val rr get() = Vector2d(r, r) + inline val rg get() = Vector2d(r, g) + inline val rb get() = Vector2d(r, b) + inline val ra get() = Vector2d(r, a) + inline val gr get() = Vector2d(g, r) + inline val gg get() = Vector2d(g, g) + inline val gb get() = Vector2d(g, b) + inline val ga get() = Vector2d(g, a) + inline val br get() = Vector2d(b, r) + inline val bg get() = Vector2d(b, g) + inline val bb get() = Vector2d(b, b) + inline val ba get() = Vector2d(b, a) + inline val ar get() = Vector2d(a, r) + inline val ag get() = Vector2d(a, g) + inline val ab get() = Vector2d(a, b) + inline val aa get() = Vector2d(a, a) + inline val rrr get() = Vector3d(r, r, r) + inline val rrg get() = Vector3d(r, r, g) + inline val rrb get() = Vector3d(r, r, b) + inline val rra get() = Vector3d(r, r, a) + inline val rgr get() = Vector3d(r, g, r) + inline val rgg get() = Vector3d(r, g, g) + inline val rgb get() = Vector3d(r, g, b) + inline val rga get() = Vector3d(r, g, a) + inline val rbr get() = Vector3d(r, b, r) + inline val rbg get() = Vector3d(r, b, g) + inline val rbb get() = Vector3d(r, b, b) + inline val rba get() = Vector3d(r, b, a) + inline val rar get() = Vector3d(r, a, r) + inline val rag get() = Vector3d(r, a, g) + inline val rab get() = Vector3d(r, a, b) + inline val raa get() = Vector3d(r, a, a) + inline val grr get() = Vector3d(g, r, r) + inline val grg get() = Vector3d(g, r, g) + inline val grb get() = Vector3d(g, r, b) + inline val gra get() = Vector3d(g, r, a) + inline val ggr get() = Vector3d(g, g, r) + inline val ggg get() = Vector3d(g, g, g) + inline val ggb get() = Vector3d(g, g, b) + inline val gga get() = Vector3d(g, g, a) + inline val gbr get() = Vector3d(g, b, r) + inline val gbg get() = Vector3d(g, b, g) + inline val gbb get() = Vector3d(g, b, b) + inline val gba get() = Vector3d(g, b, a) + inline val gar get() = Vector3d(g, a, r) + inline val gag get() = Vector3d(g, a, g) + inline val gab get() = Vector3d(g, a, b) + inline val gaa get() = Vector3d(g, a, a) + inline val brr get() = Vector3d(b, r, r) + inline val brg get() = Vector3d(b, r, g) + inline val brb get() = Vector3d(b, r, b) + inline val bra get() = Vector3d(b, r, a) + inline val bgr get() = Vector3d(b, g, r) + inline val bgg get() = Vector3d(b, g, g) + inline val bgb get() = Vector3d(b, g, b) + inline val bga get() = Vector3d(b, g, a) + inline val bbr get() = Vector3d(b, b, r) + inline val bbg get() = Vector3d(b, b, g) + inline val bbb get() = Vector3d(b, b, b) + inline val bba get() = Vector3d(b, b, a) + inline val bar get() = Vector3d(b, a, r) + inline val bag get() = Vector3d(b, a, g) + inline val bab get() = Vector3d(b, a, b) + inline val baa get() = Vector3d(b, a, a) + inline val arr get() = Vector3d(a, r, r) + inline val arg get() = Vector3d(a, r, g) + inline val arb get() = Vector3d(a, r, b) + inline val ara get() = Vector3d(a, r, a) + inline val agr get() = Vector3d(a, g, r) + inline val agg get() = Vector3d(a, g, g) + inline val agb get() = Vector3d(a, g, b) + inline val aga get() = Vector3d(a, g, a) + inline val abr get() = Vector3d(a, b, r) + inline val abg get() = Vector3d(a, b, g) + inline val abb get() = Vector3d(a, b, b) + inline val aba get() = Vector3d(a, b, a) + inline val aar get() = Vector3d(a, a, r) + inline val aag get() = Vector3d(a, a, g) + inline val aab get() = Vector3d(a, a, b) + inline val aaa get() = Vector3d(a, a, a) + inline val rrrr get() = Vector4d(r, r, r, r) + inline val rrrg get() = Vector4d(r, r, r, g) + inline val rrrb get() = Vector4d(r, r, r, b) + inline val rrra get() = Vector4d(r, r, r, a) + inline val rrgr get() = Vector4d(r, r, g, r) + inline val rrgg get() = Vector4d(r, r, g, g) + inline val rrgb get() = Vector4d(r, r, g, b) + inline val rrga get() = Vector4d(r, r, g, a) + inline val rrbr get() = Vector4d(r, r, b, r) + inline val rrbg get() = Vector4d(r, r, b, g) + inline val rrbb get() = Vector4d(r, r, b, b) + inline val rrba get() = Vector4d(r, r, b, a) + inline val rrar get() = Vector4d(r, r, a, r) + inline val rrag get() = Vector4d(r, r, a, g) + inline val rrab get() = Vector4d(r, r, a, b) + inline val rraa get() = Vector4d(r, r, a, a) + inline val rgrr get() = Vector4d(r, g, r, r) + inline val rgrg get() = Vector4d(r, g, r, g) + inline val rgrb get() = Vector4d(r, g, r, b) + inline val rgra get() = Vector4d(r, g, r, a) + inline val rggr get() = Vector4d(r, g, g, r) + inline val rggg get() = Vector4d(r, g, g, g) + inline val rggb get() = Vector4d(r, g, g, b) + inline val rgga get() = Vector4d(r, g, g, a) + inline val rgbr get() = Vector4d(r, g, b, r) + inline val rgbg get() = Vector4d(r, g, b, g) + inline val rgbb get() = Vector4d(r, g, b, b) + inline val rgba get() = Vector4d(r, g, b, a) + inline val rgar get() = Vector4d(r, g, a, r) + inline val rgag get() = Vector4d(r, g, a, g) + inline val rgab get() = Vector4d(r, g, a, b) + inline val rgaa get() = Vector4d(r, g, a, a) + inline val rbrr get() = Vector4d(r, b, r, r) + inline val rbrg get() = Vector4d(r, b, r, g) + inline val rbrb get() = Vector4d(r, b, r, b) + inline val rbra get() = Vector4d(r, b, r, a) + inline val rbgr get() = Vector4d(r, b, g, r) + inline val rbgg get() = Vector4d(r, b, g, g) + inline val rbgb get() = Vector4d(r, b, g, b) + inline val rbga get() = Vector4d(r, b, g, a) + inline val rbbr get() = Vector4d(r, b, b, r) + inline val rbbg get() = Vector4d(r, b, b, g) + inline val rbbb get() = Vector4d(r, b, b, b) + inline val rbba get() = Vector4d(r, b, b, a) + inline val rbar get() = Vector4d(r, b, a, r) + inline val rbag get() = Vector4d(r, b, a, g) + inline val rbab get() = Vector4d(r, b, a, b) + inline val rbaa get() = Vector4d(r, b, a, a) + inline val rarr get() = Vector4d(r, a, r, r) + inline val rarg get() = Vector4d(r, a, r, g) + inline val rarb get() = Vector4d(r, a, r, b) + inline val rara get() = Vector4d(r, a, r, a) + inline val ragr get() = Vector4d(r, a, g, r) + inline val ragg get() = Vector4d(r, a, g, g) + inline val ragb get() = Vector4d(r, a, g, b) + inline val raga get() = Vector4d(r, a, g, a) + inline val rabr get() = Vector4d(r, a, b, r) + inline val rabg get() = Vector4d(r, a, b, g) + inline val rabb get() = Vector4d(r, a, b, b) + inline val raba get() = Vector4d(r, a, b, a) + inline val raar get() = Vector4d(r, a, a, r) + inline val raag get() = Vector4d(r, a, a, g) + inline val raab get() = Vector4d(r, a, a, b) + inline val raaa get() = Vector4d(r, a, a, a) + inline val grrr get() = Vector4d(g, r, r, r) + inline val grrg get() = Vector4d(g, r, r, g) + inline val grrb get() = Vector4d(g, r, r, b) + inline val grra get() = Vector4d(g, r, r, a) + inline val grgr get() = Vector4d(g, r, g, r) + inline val grgg get() = Vector4d(g, r, g, g) + inline val grgb get() = Vector4d(g, r, g, b) + inline val grga get() = Vector4d(g, r, g, a) + inline val grbr get() = Vector4d(g, r, b, r) + inline val grbg get() = Vector4d(g, r, b, g) + inline val grbb get() = Vector4d(g, r, b, b) + inline val grba get() = Vector4d(g, r, b, a) + inline val grar get() = Vector4d(g, r, a, r) + inline val grag get() = Vector4d(g, r, a, g) + inline val grab get() = Vector4d(g, r, a, b) + inline val graa get() = Vector4d(g, r, a, a) + inline val ggrr get() = Vector4d(g, g, r, r) + inline val ggrg get() = Vector4d(g, g, r, g) + inline val ggrb get() = Vector4d(g, g, r, b) + inline val ggra get() = Vector4d(g, g, r, a) + inline val gggr get() = Vector4d(g, g, g, r) + inline val gggg get() = Vector4d(g, g, g, g) + inline val gggb get() = Vector4d(g, g, g, b) + inline val ggga get() = Vector4d(g, g, g, a) + inline val ggbr get() = Vector4d(g, g, b, r) + inline val ggbg get() = Vector4d(g, g, b, g) + inline val ggbb get() = Vector4d(g, g, b, b) + inline val ggba get() = Vector4d(g, g, b, a) + inline val ggar get() = Vector4d(g, g, a, r) + inline val ggag get() = Vector4d(g, g, a, g) + inline val ggab get() = Vector4d(g, g, a, b) + inline val ggaa get() = Vector4d(g, g, a, a) + inline val gbrr get() = Vector4d(g, b, r, r) + inline val gbrg get() = Vector4d(g, b, r, g) + inline val gbrb get() = Vector4d(g, b, r, b) + inline val gbra get() = Vector4d(g, b, r, a) + inline val gbgr get() = Vector4d(g, b, g, r) + inline val gbgg get() = Vector4d(g, b, g, g) + inline val gbgb get() = Vector4d(g, b, g, b) + inline val gbga get() = Vector4d(g, b, g, a) + inline val gbbr get() = Vector4d(g, b, b, r) + inline val gbbg get() = Vector4d(g, b, b, g) + inline val gbbb get() = Vector4d(g, b, b, b) + inline val gbba get() = Vector4d(g, b, b, a) + inline val gbar get() = Vector4d(g, b, a, r) + inline val gbag get() = Vector4d(g, b, a, g) + inline val gbab get() = Vector4d(g, b, a, b) + inline val gbaa get() = Vector4d(g, b, a, a) + inline val garr get() = Vector4d(g, a, r, r) + inline val garg get() = Vector4d(g, a, r, g) + inline val garb get() = Vector4d(g, a, r, b) + inline val gara get() = Vector4d(g, a, r, a) + inline val gagr get() = Vector4d(g, a, g, r) + inline val gagg get() = Vector4d(g, a, g, g) + inline val gagb get() = Vector4d(g, a, g, b) + inline val gaga get() = Vector4d(g, a, g, a) + inline val gabr get() = Vector4d(g, a, b, r) + inline val gabg get() = Vector4d(g, a, b, g) + inline val gabb get() = Vector4d(g, a, b, b) + inline val gaba get() = Vector4d(g, a, b, a) + inline val gaar get() = Vector4d(g, a, a, r) + inline val gaag get() = Vector4d(g, a, a, g) + inline val gaab get() = Vector4d(g, a, a, b) + inline val gaaa get() = Vector4d(g, a, a, a) + inline val brrr get() = Vector4d(b, r, r, r) + inline val brrg get() = Vector4d(b, r, r, g) + inline val brrb get() = Vector4d(b, r, r, b) + inline val brra get() = Vector4d(b, r, r, a) + inline val brgr get() = Vector4d(b, r, g, r) + inline val brgg get() = Vector4d(b, r, g, g) + inline val brgb get() = Vector4d(b, r, g, b) + inline val brga get() = Vector4d(b, r, g, a) + inline val brbr get() = Vector4d(b, r, b, r) + inline val brbg get() = Vector4d(b, r, b, g) + inline val brbb get() = Vector4d(b, r, b, b) + inline val brba get() = Vector4d(b, r, b, a) + inline val brar get() = Vector4d(b, r, a, r) + inline val brag get() = Vector4d(b, r, a, g) + inline val brab get() = Vector4d(b, r, a, b) + inline val braa get() = Vector4d(b, r, a, a) + inline val bgrr get() = Vector4d(b, g, r, r) + inline val bgrg get() = Vector4d(b, g, r, g) + inline val bgrb get() = Vector4d(b, g, r, b) + inline val bgra get() = Vector4d(b, g, r, a) + inline val bggr get() = Vector4d(b, g, g, r) + inline val bggg get() = Vector4d(b, g, g, g) + inline val bggb get() = Vector4d(b, g, g, b) + inline val bgga get() = Vector4d(b, g, g, a) + inline val bgbr get() = Vector4d(b, g, b, r) + inline val bgbg get() = Vector4d(b, g, b, g) + inline val bgbb get() = Vector4d(b, g, b, b) + inline val bgba get() = Vector4d(b, g, b, a) + inline val bgar get() = Vector4d(b, g, a, r) + inline val bgag get() = Vector4d(b, g, a, g) + inline val bgab get() = Vector4d(b, g, a, b) + inline val bgaa get() = Vector4d(b, g, a, a) + inline val bbrr get() = Vector4d(b, b, r, r) + inline val bbrg get() = Vector4d(b, b, r, g) + inline val bbrb get() = Vector4d(b, b, r, b) + inline val bbra get() = Vector4d(b, b, r, a) + inline val bbgr get() = Vector4d(b, b, g, r) + inline val bbgg get() = Vector4d(b, b, g, g) + inline val bbgb get() = Vector4d(b, b, g, b) + inline val bbga get() = Vector4d(b, b, g, a) + inline val bbbr get() = Vector4d(b, b, b, r) + inline val bbbg get() = Vector4d(b, b, b, g) + inline val bbbb get() = Vector4d(b, b, b, b) + inline val bbba get() = Vector4d(b, b, b, a) + inline val bbar get() = Vector4d(b, b, a, r) + inline val bbag get() = Vector4d(b, b, a, g) + inline val bbab get() = Vector4d(b, b, a, b) + inline val bbaa get() = Vector4d(b, b, a, a) + inline val barr get() = Vector4d(b, a, r, r) + inline val barg get() = Vector4d(b, a, r, g) + inline val barb get() = Vector4d(b, a, r, b) + inline val bara get() = Vector4d(b, a, r, a) + inline val bagr get() = Vector4d(b, a, g, r) + inline val bagg get() = Vector4d(b, a, g, g) + inline val bagb get() = Vector4d(b, a, g, b) + inline val baga get() = Vector4d(b, a, g, a) + inline val babr get() = Vector4d(b, a, b, r) + inline val babg get() = Vector4d(b, a, b, g) + inline val babb get() = Vector4d(b, a, b, b) + inline val baba get() = Vector4d(b, a, b, a) + inline val baar get() = Vector4d(b, a, a, r) + inline val baag get() = Vector4d(b, a, a, g) + inline val baab get() = Vector4d(b, a, a, b) + inline val baaa get() = Vector4d(b, a, a, a) + inline val arrr get() = Vector4d(a, r, r, r) + inline val arrg get() = Vector4d(a, r, r, g) + inline val arrb get() = Vector4d(a, r, r, b) + inline val arra get() = Vector4d(a, r, r, a) + inline val argr get() = Vector4d(a, r, g, r) + inline val argg get() = Vector4d(a, r, g, g) + inline val argb get() = Vector4d(a, r, g, b) + inline val arga get() = Vector4d(a, r, g, a) + inline val arbr get() = Vector4d(a, r, b, r) + inline val arbg get() = Vector4d(a, r, b, g) + inline val arbb get() = Vector4d(a, r, b, b) + inline val arba get() = Vector4d(a, r, b, a) + inline val arar get() = Vector4d(a, r, a, r) + inline val arag get() = Vector4d(a, r, a, g) + inline val arab get() = Vector4d(a, r, a, b) + inline val araa get() = Vector4d(a, r, a, a) + inline val agrr get() = Vector4d(a, g, r, r) + inline val agrg get() = Vector4d(a, g, r, g) + inline val agrb get() = Vector4d(a, g, r, b) + inline val agra get() = Vector4d(a, g, r, a) + inline val aggr get() = Vector4d(a, g, g, r) + inline val aggg get() = Vector4d(a, g, g, g) + inline val aggb get() = Vector4d(a, g, g, b) + inline val agga get() = Vector4d(a, g, g, a) + inline val agbr get() = Vector4d(a, g, b, r) + inline val agbg get() = Vector4d(a, g, b, g) + inline val agbb get() = Vector4d(a, g, b, b) + inline val agba get() = Vector4d(a, g, b, a) + inline val agar get() = Vector4d(a, g, a, r) + inline val agag get() = Vector4d(a, g, a, g) + inline val agab get() = Vector4d(a, g, a, b) + inline val agaa get() = Vector4d(a, g, a, a) + inline val abrr get() = Vector4d(a, b, r, r) + inline val abrg get() = Vector4d(a, b, r, g) + inline val abrb get() = Vector4d(a, b, r, b) + inline val abra get() = Vector4d(a, b, r, a) + inline val abgr get() = Vector4d(a, b, g, r) + inline val abgg get() = Vector4d(a, b, g, g) + inline val abgb get() = Vector4d(a, b, g, b) + inline val abga get() = Vector4d(a, b, g, a) + inline val abbr get() = Vector4d(a, b, b, r) + inline val abbg get() = Vector4d(a, b, b, g) + inline val abbb get() = Vector4d(a, b, b, b) + inline val abba get() = Vector4d(a, b, b, a) + inline val abar get() = Vector4d(a, b, a, r) + inline val abag get() = Vector4d(a, b, a, g) + inline val abab get() = Vector4d(a, b, a, b) + inline val abaa get() = Vector4d(a, b, a, a) + inline val aarr get() = Vector4d(a, a, r, r) + inline val aarg get() = Vector4d(a, a, r, g) + inline val aarb get() = Vector4d(a, a, r, b) + inline val aara get() = Vector4d(a, a, r, a) + inline val aagr get() = Vector4d(a, a, g, r) + inline val aagg get() = Vector4d(a, a, g, g) + inline val aagb get() = Vector4d(a, a, g, b) + inline val aaga get() = Vector4d(a, a, g, a) + inline val aabr get() = Vector4d(a, a, b, r) + inline val aabg get() = Vector4d(a, a, b, g) + inline val aabb get() = Vector4d(a, a, b, b) + inline val aaba get() = Vector4d(a, a, b, a) + inline val aaar get() = Vector4d(a, a, a, r) + inline val aaag get() = Vector4d(a, a, a, g) + inline val aaab get() = Vector4d(a, a, a, b) + inline val aaaa get() = Vector4d(a, a, a, a) + inline val ss get() = Vector2d(s, s) + inline val st get() = Vector2d(s, t) + inline val sp get() = Vector2d(s, p) + inline val sq get() = Vector2d(s, q) + inline val ts get() = Vector2d(t, s) + inline val tt get() = Vector2d(t, t) + inline val tp get() = Vector2d(t, p) + inline val tq get() = Vector2d(t, q) + inline val ps get() = Vector2d(p, s) + inline val pt get() = Vector2d(p, t) + inline val pp get() = Vector2d(p, p) + inline val pq get() = Vector2d(p, q) + inline val qs get() = Vector2d(q, s) + inline val qt get() = Vector2d(q, t) + inline val qp get() = Vector2d(q, p) + inline val qq get() = Vector2d(q, q) + inline val sss get() = Vector3d(s, s, s) + inline val sst get() = Vector3d(s, s, t) + inline val ssp get() = Vector3d(s, s, p) + inline val ssq get() = Vector3d(s, s, q) + inline val sts get() = Vector3d(s, t, s) + inline val stt get() = Vector3d(s, t, t) + inline val stp get() = Vector3d(s, t, p) + inline val stq get() = Vector3d(s, t, q) + inline val sps get() = Vector3d(s, p, s) + inline val spt get() = Vector3d(s, p, t) + inline val spp get() = Vector3d(s, p, p) + inline val spq get() = Vector3d(s, p, q) + inline val sqs get() = Vector3d(s, q, s) + inline val sqt get() = Vector3d(s, q, t) + inline val sqp get() = Vector3d(s, q, p) + inline val sqq get() = Vector3d(s, q, q) + inline val tss get() = Vector3d(t, s, s) + inline val tst get() = Vector3d(t, s, t) + inline val tsp get() = Vector3d(t, s, p) + inline val tsq get() = Vector3d(t, s, q) + inline val tts get() = Vector3d(t, t, s) + inline val ttt get() = Vector3d(t, t, t) + inline val ttp get() = Vector3d(t, t, p) + inline val ttq get() = Vector3d(t, t, q) + inline val tps get() = Vector3d(t, p, s) + inline val tpt get() = Vector3d(t, p, t) + inline val tpp get() = Vector3d(t, p, p) + inline val tpq get() = Vector3d(t, p, q) + inline val tqs get() = Vector3d(t, q, s) + inline val tqt get() = Vector3d(t, q, t) + inline val tqp get() = Vector3d(t, q, p) + inline val tqq get() = Vector3d(t, q, q) + inline val pss get() = Vector3d(p, s, s) + inline val pst get() = Vector3d(p, s, t) + inline val psp get() = Vector3d(p, s, p) + inline val psq get() = Vector3d(p, s, q) + inline val pts get() = Vector3d(p, t, s) + inline val ptt get() = Vector3d(p, t, t) + inline val ptp get() = Vector3d(p, t, p) + inline val ptq get() = Vector3d(p, t, q) + inline val pps get() = Vector3d(p, p, s) + inline val ppt get() = Vector3d(p, p, t) + inline val ppp get() = Vector3d(p, p, p) + inline val ppq get() = Vector3d(p, p, q) + inline val pqs get() = Vector3d(p, q, s) + inline val pqt get() = Vector3d(p, q, t) + inline val pqp get() = Vector3d(p, q, p) + inline val pqq get() = Vector3d(p, q, q) + inline val qss get() = Vector3d(q, s, s) + inline val qst get() = Vector3d(q, s, t) + inline val qsp get() = Vector3d(q, s, p) + inline val qsq get() = Vector3d(q, s, q) + inline val qts get() = Vector3d(q, t, s) + inline val qtt get() = Vector3d(q, t, t) + inline val qtp get() = Vector3d(q, t, p) + inline val qtq get() = Vector3d(q, t, q) + inline val qps get() = Vector3d(q, p, s) + inline val qpt get() = Vector3d(q, p, t) + inline val qpp get() = Vector3d(q, p, p) + inline val qpq get() = Vector3d(q, p, q) + inline val qqs get() = Vector3d(q, q, s) + inline val qqt get() = Vector3d(q, q, t) + inline val qqp get() = Vector3d(q, q, p) + inline val qqq get() = Vector3d(q, q, q) + inline val ssss get() = Vector4d(s, s, s, s) + inline val ssst get() = Vector4d(s, s, s, t) + inline val sssp get() = Vector4d(s, s, s, p) + inline val sssq get() = Vector4d(s, s, s, q) + inline val ssts get() = Vector4d(s, s, t, s) + inline val sstt get() = Vector4d(s, s, t, t) + inline val sstp get() = Vector4d(s, s, t, p) + inline val sstq get() = Vector4d(s, s, t, q) + inline val ssps get() = Vector4d(s, s, p, s) + inline val sspt get() = Vector4d(s, s, p, t) + inline val sspp get() = Vector4d(s, s, p, p) + inline val sspq get() = Vector4d(s, s, p, q) + inline val ssqs get() = Vector4d(s, s, q, s) + inline val ssqt get() = Vector4d(s, s, q, t) + inline val ssqp get() = Vector4d(s, s, q, p) + inline val ssqq get() = Vector4d(s, s, q, q) + inline val stss get() = Vector4d(s, t, s, s) + inline val stst get() = Vector4d(s, t, s, t) + inline val stsp get() = Vector4d(s, t, s, p) + inline val stsq get() = Vector4d(s, t, s, q) + inline val stts get() = Vector4d(s, t, t, s) + inline val sttt get() = Vector4d(s, t, t, t) + inline val sttp get() = Vector4d(s, t, t, p) + inline val sttq get() = Vector4d(s, t, t, q) + inline val stps get() = Vector4d(s, t, p, s) + inline val stpt get() = Vector4d(s, t, p, t) + inline val stpp get() = Vector4d(s, t, p, p) + inline val stpq get() = Vector4d(s, t, p, q) + inline val stqs get() = Vector4d(s, t, q, s) + inline val stqt get() = Vector4d(s, t, q, t) + inline val stqp get() = Vector4d(s, t, q, p) + inline val stqq get() = Vector4d(s, t, q, q) + inline val spss get() = Vector4d(s, p, s, s) + inline val spst get() = Vector4d(s, p, s, t) + inline val spsp get() = Vector4d(s, p, s, p) + inline val spsq get() = Vector4d(s, p, s, q) + inline val spts get() = Vector4d(s, p, t, s) + inline val sptt get() = Vector4d(s, p, t, t) + inline val sptp get() = Vector4d(s, p, t, p) + inline val sptq get() = Vector4d(s, p, t, q) + inline val spps get() = Vector4d(s, p, p, s) + inline val sppt get() = Vector4d(s, p, p, t) + inline val sppp get() = Vector4d(s, p, p, p) + inline val sppq get() = Vector4d(s, p, p, q) + inline val spqs get() = Vector4d(s, p, q, s) + inline val spqt get() = Vector4d(s, p, q, t) + inline val spqp get() = Vector4d(s, p, q, p) + inline val spqq get() = Vector4d(s, p, q, q) + inline val sqss get() = Vector4d(s, q, s, s) + inline val sqst get() = Vector4d(s, q, s, t) + inline val sqsp get() = Vector4d(s, q, s, p) + inline val sqsq get() = Vector4d(s, q, s, q) + inline val sqts get() = Vector4d(s, q, t, s) + inline val sqtt get() = Vector4d(s, q, t, t) + inline val sqtp get() = Vector4d(s, q, t, p) + inline val sqtq get() = Vector4d(s, q, t, q) + inline val sqps get() = Vector4d(s, q, p, s) + inline val sqpt get() = Vector4d(s, q, p, t) + inline val sqpp get() = Vector4d(s, q, p, p) + inline val sqpq get() = Vector4d(s, q, p, q) + inline val sqqs get() = Vector4d(s, q, q, s) + inline val sqqt get() = Vector4d(s, q, q, t) + inline val sqqp get() = Vector4d(s, q, q, p) + inline val sqqq get() = Vector4d(s, q, q, q) + inline val tsss get() = Vector4d(t, s, s, s) + inline val tsst get() = Vector4d(t, s, s, t) + inline val tssp get() = Vector4d(t, s, s, p) + inline val tssq get() = Vector4d(t, s, s, q) + inline val tsts get() = Vector4d(t, s, t, s) + inline val tstt get() = Vector4d(t, s, t, t) + inline val tstp get() = Vector4d(t, s, t, p) + inline val tstq get() = Vector4d(t, s, t, q) + inline val tsps get() = Vector4d(t, s, p, s) + inline val tspt get() = Vector4d(t, s, p, t) + inline val tspp get() = Vector4d(t, s, p, p) + inline val tspq get() = Vector4d(t, s, p, q) + inline val tsqs get() = Vector4d(t, s, q, s) + inline val tsqt get() = Vector4d(t, s, q, t) + inline val tsqp get() = Vector4d(t, s, q, p) + inline val tsqq get() = Vector4d(t, s, q, q) + inline val ttss get() = Vector4d(t, t, s, s) + inline val ttst get() = Vector4d(t, t, s, t) + inline val ttsp get() = Vector4d(t, t, s, p) + inline val ttsq get() = Vector4d(t, t, s, q) + inline val ttts get() = Vector4d(t, t, t, s) + inline val tttt get() = Vector4d(t, t, t, t) + inline val tttp get() = Vector4d(t, t, t, p) + inline val tttq get() = Vector4d(t, t, t, q) + inline val ttps get() = Vector4d(t, t, p, s) + inline val ttpt get() = Vector4d(t, t, p, t) + inline val ttpp get() = Vector4d(t, t, p, p) + inline val ttpq get() = Vector4d(t, t, p, q) + inline val ttqs get() = Vector4d(t, t, q, s) + inline val ttqt get() = Vector4d(t, t, q, t) + inline val ttqp get() = Vector4d(t, t, q, p) + inline val ttqq get() = Vector4d(t, t, q, q) + inline val tpss get() = Vector4d(t, p, s, s) + inline val tpst get() = Vector4d(t, p, s, t) + inline val tpsp get() = Vector4d(t, p, s, p) + inline val tpsq get() = Vector4d(t, p, s, q) + inline val tpts get() = Vector4d(t, p, t, s) + inline val tptt get() = Vector4d(t, p, t, t) + inline val tptp get() = Vector4d(t, p, t, p) + inline val tptq get() = Vector4d(t, p, t, q) + inline val tpps get() = Vector4d(t, p, p, s) + inline val tppt get() = Vector4d(t, p, p, t) + inline val tppp get() = Vector4d(t, p, p, p) + inline val tppq get() = Vector4d(t, p, p, q) + inline val tpqs get() = Vector4d(t, p, q, s) + inline val tpqt get() = Vector4d(t, p, q, t) + inline val tpqp get() = Vector4d(t, p, q, p) + inline val tpqq get() = Vector4d(t, p, q, q) + inline val tqss get() = Vector4d(t, q, s, s) + inline val tqst get() = Vector4d(t, q, s, t) + inline val tqsp get() = Vector4d(t, q, s, p) + inline val tqsq get() = Vector4d(t, q, s, q) + inline val tqts get() = Vector4d(t, q, t, s) + inline val tqtt get() = Vector4d(t, q, t, t) + inline val tqtp get() = Vector4d(t, q, t, p) + inline val tqtq get() = Vector4d(t, q, t, q) + inline val tqps get() = Vector4d(t, q, p, s) + inline val tqpt get() = Vector4d(t, q, p, t) + inline val tqpp get() = Vector4d(t, q, p, p) + inline val tqpq get() = Vector4d(t, q, p, q) + inline val tqqs get() = Vector4d(t, q, q, s) + inline val tqqt get() = Vector4d(t, q, q, t) + inline val tqqp get() = Vector4d(t, q, q, p) + inline val tqqq get() = Vector4d(t, q, q, q) + inline val psss get() = Vector4d(p, s, s, s) + inline val psst get() = Vector4d(p, s, s, t) + inline val pssp get() = Vector4d(p, s, s, p) + inline val pssq get() = Vector4d(p, s, s, q) + inline val psts get() = Vector4d(p, s, t, s) + inline val pstt get() = Vector4d(p, s, t, t) + inline val pstp get() = Vector4d(p, s, t, p) + inline val pstq get() = Vector4d(p, s, t, q) + inline val psps get() = Vector4d(p, s, p, s) + inline val pspt get() = Vector4d(p, s, p, t) + inline val pspp get() = Vector4d(p, s, p, p) + inline val pspq get() = Vector4d(p, s, p, q) + inline val psqs get() = Vector4d(p, s, q, s) + inline val psqt get() = Vector4d(p, s, q, t) + inline val psqp get() = Vector4d(p, s, q, p) + inline val psqq get() = Vector4d(p, s, q, q) + inline val ptss get() = Vector4d(p, t, s, s) + inline val ptst get() = Vector4d(p, t, s, t) + inline val ptsp get() = Vector4d(p, t, s, p) + inline val ptsq get() = Vector4d(p, t, s, q) + inline val ptts get() = Vector4d(p, t, t, s) + inline val pttt get() = Vector4d(p, t, t, t) + inline val pttp get() = Vector4d(p, t, t, p) + inline val pttq get() = Vector4d(p, t, t, q) + inline val ptps get() = Vector4d(p, t, p, s) + inline val ptpt get() = Vector4d(p, t, p, t) + inline val ptpp get() = Vector4d(p, t, p, p) + inline val ptpq get() = Vector4d(p, t, p, q) + inline val ptqs get() = Vector4d(p, t, q, s) + inline val ptqt get() = Vector4d(p, t, q, t) + inline val ptqp get() = Vector4d(p, t, q, p) + inline val ptqq get() = Vector4d(p, t, q, q) + inline val ppss get() = Vector4d(p, p, s, s) + inline val ppst get() = Vector4d(p, p, s, t) + inline val ppsp get() = Vector4d(p, p, s, p) + inline val ppsq get() = Vector4d(p, p, s, q) + inline val ppts get() = Vector4d(p, p, t, s) + inline val pptt get() = Vector4d(p, p, t, t) + inline val pptp get() = Vector4d(p, p, t, p) + inline val pptq get() = Vector4d(p, p, t, q) + inline val ppps get() = Vector4d(p, p, p, s) + inline val pppt get() = Vector4d(p, p, p, t) + inline val pppp get() = Vector4d(p, p, p, p) + inline val pppq get() = Vector4d(p, p, p, q) + inline val ppqs get() = Vector4d(p, p, q, s) + inline val ppqt get() = Vector4d(p, p, q, t) + inline val ppqp get() = Vector4d(p, p, q, p) + inline val ppqq get() = Vector4d(p, p, q, q) + inline val pqss get() = Vector4d(p, q, s, s) + inline val pqst get() = Vector4d(p, q, s, t) + inline val pqsp get() = Vector4d(p, q, s, p) + inline val pqsq get() = Vector4d(p, q, s, q) + inline val pqts get() = Vector4d(p, q, t, s) + inline val pqtt get() = Vector4d(p, q, t, t) + inline val pqtp get() = Vector4d(p, q, t, p) + inline val pqtq get() = Vector4d(p, q, t, q) + inline val pqps get() = Vector4d(p, q, p, s) + inline val pqpt get() = Vector4d(p, q, p, t) + inline val pqpp get() = Vector4d(p, q, p, p) + inline val pqpq get() = Vector4d(p, q, p, q) + inline val pqqs get() = Vector4d(p, q, q, s) + inline val pqqt get() = Vector4d(p, q, q, t) + inline val pqqp get() = Vector4d(p, q, q, p) + inline val pqqq get() = Vector4d(p, q, q, q) + inline val qsss get() = Vector4d(q, s, s, s) + inline val qsst get() = Vector4d(q, s, s, t) + inline val qssp get() = Vector4d(q, s, s, p) + inline val qssq get() = Vector4d(q, s, s, q) + inline val qsts get() = Vector4d(q, s, t, s) + inline val qstt get() = Vector4d(q, s, t, t) + inline val qstp get() = Vector4d(q, s, t, p) + inline val qstq get() = Vector4d(q, s, t, q) + inline val qsps get() = Vector4d(q, s, p, s) + inline val qspt get() = Vector4d(q, s, p, t) + inline val qspp get() = Vector4d(q, s, p, p) + inline val qspq get() = Vector4d(q, s, p, q) + inline val qsqs get() = Vector4d(q, s, q, s) + inline val qsqt get() = Vector4d(q, s, q, t) + inline val qsqp get() = Vector4d(q, s, q, p) + inline val qsqq get() = Vector4d(q, s, q, q) + inline val qtss get() = Vector4d(q, t, s, s) + inline val qtst get() = Vector4d(q, t, s, t) + inline val qtsp get() = Vector4d(q, t, s, p) + inline val qtsq get() = Vector4d(q, t, s, q) + inline val qtts get() = Vector4d(q, t, t, s) + inline val qttt get() = Vector4d(q, t, t, t) + inline val qttp get() = Vector4d(q, t, t, p) + inline val qttq get() = Vector4d(q, t, t, q) + inline val qtps get() = Vector4d(q, t, p, s) + inline val qtpt get() = Vector4d(q, t, p, t) + inline val qtpp get() = Vector4d(q, t, p, p) + inline val qtpq get() = Vector4d(q, t, p, q) + inline val qtqs get() = Vector4d(q, t, q, s) + inline val qtqt get() = Vector4d(q, t, q, t) + inline val qtqp get() = Vector4d(q, t, q, p) + inline val qtqq get() = Vector4d(q, t, q, q) + inline val qpss get() = Vector4d(q, p, s, s) + inline val qpst get() = Vector4d(q, p, s, t) + inline val qpsp get() = Vector4d(q, p, s, p) + inline val qpsq get() = Vector4d(q, p, s, q) + inline val qpts get() = Vector4d(q, p, t, s) + inline val qptt get() = Vector4d(q, p, t, t) + inline val qptp get() = Vector4d(q, p, t, p) + inline val qptq get() = Vector4d(q, p, t, q) + inline val qpps get() = Vector4d(q, p, p, s) + inline val qppt get() = Vector4d(q, p, p, t) + inline val qppp get() = Vector4d(q, p, p, p) + inline val qppq get() = Vector4d(q, p, p, q) + inline val qpqs get() = Vector4d(q, p, q, s) + inline val qpqt get() = Vector4d(q, p, q, t) + inline val qpqp get() = Vector4d(q, p, q, p) + inline val qpqq get() = Vector4d(q, p, q, q) + inline val qqss get() = Vector4d(q, q, s, s) + inline val qqst get() = Vector4d(q, q, s, t) + inline val qqsp get() = Vector4d(q, q, s, p) + inline val qqsq get() = Vector4d(q, q, s, q) + inline val qqts get() = Vector4d(q, q, t, s) + inline val qqtt get() = Vector4d(q, q, t, t) + inline val qqtp get() = Vector4d(q, q, t, p) + inline val qqtq get() = Vector4d(q, q, t, q) + inline val qqps get() = Vector4d(q, q, p, s) + inline val qqpt get() = Vector4d(q, q, p, t) + inline val qqpp get() = Vector4d(q, q, p, p) + inline val qqpq get() = Vector4d(q, q, p, q) + inline val qqqs get() = Vector4d(q, q, q, s) + inline val qqqt get() = Vector4d(q, q, q, t) + inline val qqqp get() = Vector4d(q, q, q, p) + inline val qqqq get() = Vector4d(q, q, q, q) + + companion object { + @JvmField val ZERO = Vector4d() + @JvmField val POSITIVE_X = Vector4d(x = 1.0) + @JvmField val NEGATIVE_X = Vector4d(x = -1.0) + @JvmField val POSITIVE_Y = Vector4d(y = 1.0) + @JvmField val NEGATIVE_Y = Vector4d(y = -1.0) + @JvmField val POSITIVE_Z = Vector4d(z = 1.0) + @JvmField val NEGATIVE_Z = Vector4d(z = -1.0) + @JvmField val POSITIVE_W = Vector4d(w = 1.0) + @JvmField val NEGATIVE_W = Vector4d(w = -1.0) + } +} + +fun Double.div(other: Vector4d): Vector4d { + return Vector4d(this / other.x, this / other.y, this / other.z, this / other.w) +} + +fun Double.times(other: Vector4d): Vector4d { + return Vector4d(this * other.x, this * other.y, this * other.z, this * other.w) +} + +/** + * Mutable 4D Vector, representing four-dimensional coordinates as [Double]s + * + * It can be safely passed around to methods which expect immutable [Vector4d], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector4d( + override var x: Double = 0.0, + override var y: Double = 0.0, + override var z: Double = 0.0, + override var w: Double = 0.0, +) : Vector4d(x, y, z, w), IMutableDoubleVector, IMutableFractionalVector, IMutableVector, IMatrixSetterDouble { + constructor(input: IStruct2d, z: Double = 0.0, w: Double = 0.0) : this(input.component1(), input.component2(), z, w) + constructor(x: Double, input: IStruct2d, w: Double = 0.0) : this(x, input.component1(), input.component2(), w) + constructor(x: Double, y: Double, input: IStruct2d) : this(x, y, input.component1(), input.component2()) + + constructor(input: IStruct3d, w: Double = 0.0) : this(input.component1(), input.component2(), input.component3(), w) + constructor(x: Double, input: IStruct3d) : this(x, input.component1(), input.component2(), input.component3()) + constructor(input: IStruct4d) : this(input.component1(), input.component2(), input.component3(), input.component4()) + + override fun set(column: Int, row: Int, value: Double) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + 2 -> z = value + 3 -> w = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + override var b by this::z + override var a by this::w + + override var s by this::x + override var t by this::y + override var p by this::z + override var q by this::w + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector4d + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + if (w != other.w) return false + + return true + } + + override fun normalize(): Double { + val len = length + + if (len == 0.0) { + return 0.0 + } + + x /= len + y /= len + z /= len + w /= len + return len + } + + override fun plusMut(other: Vector4d): MutableVector4d { + x += other.x + y += other.y + z += other.z + w += other.w + return this + } + + override fun minusMut(other: Vector4d): MutableVector4d { + x -= other.x + y -= other.y + z -= other.z + w -= other.w + return this + } + + override fun timesMut(other: Vector4d): MutableVector4d { + x *= other.x + y *= other.y + z *= other.z + w *= other.w + return this + } + + override fun divMut(other: Vector4d): MutableVector4d { + x /= other.x + y /= other.y + z /= other.z + w /= other.w + return this + } + + override fun timesMut(other: Double): MutableVector4d { + x *= other + y *= other + z *= other + w *= other + return this + } + + override fun divMut(other: Double): MutableVector4d { + x /= other + y /= other + z /= other + w /= other + return this + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector2f.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector2f.kt new file mode 100644 index 00000000..c2c5ba5c --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector2f.kt @@ -0,0 +1,395 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.nfloat + +import ru.dbotthepony.kvector.api.* +import ru.dbotthepony.kvector.vector.ndouble.Vector2d +import kotlin.math.absoluteValue + +/** + * 2D Vector, representing two-dimensional coordinates as [Float]s + */ +open class Vector2f( + open val x: Float = 0f, + open val y: Float = 0f +) : AbstractVector(), IFractionalVector, IFloatVector, IStruct2f, IMatrixGetterFloat { + final override fun component1() = x + final override fun component2() = y + + constructor(input: IStruct2f) : this(input.component1(), input.component2()) + + final override fun get(column: Int, row: Int): Float { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + final override val rows: Int = 2 + final override val lengthSquared: Double + get() = x.toDouble() * x.toDouble() + y.toDouble() * y.toDouble() + + final override val isFinite: Boolean + get() = x.isFinite() && y.isFinite() + final override val isNaN: Boolean + get() = x.isNaN() || y.isNaN() + + open val r by this::x + open val g by this::y + + open val s by this::x + open val t by this::y + + override fun plus(other: Vector2f): Vector2f { + return Vector2f( + x + other.x, + y + other.y, + ) + } + + override fun minus(other: Vector2f): Vector2f { + return Vector2f( + x - other.x, + y - other.y, + ) + } + + override fun times(other: Vector2f): Vector2f { + return Vector2f( + x * other.x, + y * other.y, + ) + } + + override fun div(other: Vector2f): Vector2f { + return Vector2f( + x / other.x, + y / other.y, + ) + } + + override val absoluteValue: Vector2f + get() = Vector2f(x.absoluteValue, y.absoluteValue) + + override fun coerceAtMost(maximal: Vector2f): Vector2f { + return Vector2f( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + ) + } + + override fun coerceAtLeast(minimal: Vector2f): Vector2f { + return Vector2f( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + ) + } + + override fun clamp(minimal: Vector2f, maximal: Vector2f): Vector2f { + return Vector2f( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + ) + } + + override fun unaryMinus(): Vector2f { + return Vector2f(-x, -y) + } + + override fun distanceSquared(other: Vector2f): Double { + val x = x.toDouble() - other.x.toDouble() + val y = y.toDouble() - other.y.toDouble() + + return x * x + y * y + } + + override val normalized: Vector2f + get() { + val len = length + + if (len == 0.0) { + return ZERO + } + + return Vector2f((x / len).toFloat(), (y / len).toFloat()) + } + + override fun times(other: Float): Vector2f { + return Vector2f( + x * other, + y * other + ) + } + + override fun div(other: Float): Vector2f { + return Vector2f( + x / other, + y / other + ) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector2f + + if (x != other.x) return false + if (y != other.y) return false + + return true + } + + override fun hashCode(): Int { + var result = x.hashCode() + result = 31 * result + y.hashCode() + return result + } + + override fun toString(): String { + return "[${x}f ${y}f]" + } + + /** + * Calculates vector vector * vector, returning result as [Double] + */ + fun cross(other: Vector2f): Double { + return x.toDouble() * other.y.toDouble() - y.toDouble() * other.x.toDouble() + } + + /** + * Calculates 2D cross product between scalar and vector + * + * @return new vector + */ + fun cross(other: Float): Vector2f { + return Vector2f(other * y, -other * x) + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector2f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector3f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector4f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + } + + /** + * Casts components to [Double] and returns new vector as result + */ + open fun toDoubleVector(): Vector2d { + return Vector2d(x.toDouble(), y.toDouble()) + } + + inline val xx get() = Vector2f(x, x) + inline val xy get() = Vector2f(x, y) + inline val yx get() = Vector2f(y, x) + inline val yy get() = Vector2f(y, y) + inline val xxx get() = Vector3f(x, x, x) + inline val xxy get() = Vector3f(x, x, y) + inline val xyx get() = Vector3f(x, y, x) + inline val xyy get() = Vector3f(x, y, y) + inline val yxx get() = Vector3f(y, x, x) + inline val yxy get() = Vector3f(y, x, y) + inline val yyx get() = Vector3f(y, y, x) + inline val yyy get() = Vector3f(y, y, y) + inline val xxxx get() = Vector4f(x, x, x, x) + inline val xxxy get() = Vector4f(x, x, x, y) + inline val xxyx get() = Vector4f(x, x, y, x) + inline val xxyy get() = Vector4f(x, x, y, y) + inline val xyxx get() = Vector4f(x, y, x, x) + inline val xyxy get() = Vector4f(x, y, x, y) + inline val xyyx get() = Vector4f(x, y, y, x) + inline val xyyy get() = Vector4f(x, y, y, y) + inline val yxxx get() = Vector4f(y, x, x, x) + inline val yxxy get() = Vector4f(y, x, x, y) + inline val yxyx get() = Vector4f(y, x, y, x) + inline val yxyy get() = Vector4f(y, x, y, y) + inline val yyxx get() = Vector4f(y, y, x, x) + inline val yyxy get() = Vector4f(y, y, x, y) + inline val yyyx get() = Vector4f(y, y, y, x) + inline val yyyy get() = Vector4f(y, y, y, y) + inline val rr get() = Vector2f(r, r) + inline val rg get() = Vector2f(r, g) + inline val gr get() = Vector2f(g, r) + inline val gg get() = Vector2f(g, g) + inline val rrr get() = Vector3f(r, r, r) + inline val rrg get() = Vector3f(r, r, g) + inline val rgr get() = Vector3f(r, g, r) + inline val rgg get() = Vector3f(r, g, g) + inline val grr get() = Vector3f(g, r, r) + inline val grg get() = Vector3f(g, r, g) + inline val ggr get() = Vector3f(g, g, r) + inline val ggg get() = Vector3f(g, g, g) + inline val rrrr get() = Vector4f(r, r, r, r) + inline val rrrg get() = Vector4f(r, r, r, g) + inline val rrgr get() = Vector4f(r, r, g, r) + inline val rrgg get() = Vector4f(r, r, g, g) + inline val rgrr get() = Vector4f(r, g, r, r) + inline val rgrg get() = Vector4f(r, g, r, g) + inline val rggr get() = Vector4f(r, g, g, r) + inline val rggg get() = Vector4f(r, g, g, g) + inline val grrr get() = Vector4f(g, r, r, r) + inline val grrg get() = Vector4f(g, r, r, g) + inline val grgr get() = Vector4f(g, r, g, r) + inline val grgg get() = Vector4f(g, r, g, g) + inline val ggrr get() = Vector4f(g, g, r, r) + inline val ggrg get() = Vector4f(g, g, r, g) + inline val gggr get() = Vector4f(g, g, g, r) + inline val gggg get() = Vector4f(g, g, g, g) + inline val ss get() = Vector2f(s, s) + inline val st get() = Vector2f(s, t) + inline val ts get() = Vector2f(t, s) + inline val tt get() = Vector2f(t, t) + inline val sss get() = Vector3f(s, s, s) + inline val sst get() = Vector3f(s, s, t) + inline val sts get() = Vector3f(s, t, s) + inline val stt get() = Vector3f(s, t, t) + inline val tss get() = Vector3f(t, s, s) + inline val tst get() = Vector3f(t, s, t) + inline val tts get() = Vector3f(t, t, s) + inline val ttt get() = Vector3f(t, t, t) + inline val ssss get() = Vector4f(s, s, s, s) + inline val ssst get() = Vector4f(s, s, s, t) + inline val ssts get() = Vector4f(s, s, t, s) + inline val sstt get() = Vector4f(s, s, t, t) + inline val stss get() = Vector4f(s, t, s, s) + inline val stst get() = Vector4f(s, t, s, t) + inline val stts get() = Vector4f(s, t, t, s) + inline val sttt get() = Vector4f(s, t, t, t) + inline val tsss get() = Vector4f(t, s, s, s) + inline val tsst get() = Vector4f(t, s, s, t) + inline val tsts get() = Vector4f(t, s, t, s) + inline val tstt get() = Vector4f(t, s, t, t) + inline val ttss get() = Vector4f(t, t, s, s) + inline val ttst get() = Vector4f(t, t, s, t) + inline val ttts get() = Vector4f(t, t, t, s) + inline val tttt get() = Vector4f(t, t, t, t) + + companion object { + @JvmField val ZERO = Vector2f() + @JvmField val POSITIVE_X = Vector2f(x = 1f) + @JvmField val NEGATIVE_X = Vector2f(x = -1f) + @JvmField val POSITIVE_Y = Vector2f(y = 1f) + @JvmField val NEGATIVE_Y = Vector2f(y = -1f) + } +} + +operator fun Float.times(other: Vector2f): Vector2f { + return Vector2f(this * other.x, this * other.y) +} + +operator fun Float.div(other: Vector2f): Vector2f { + return Vector2f(this / other.x, this / other.y) +} + +/** + * Mutable 2D Vector, representing two-dimensional coordinates as [Float]s + * + * It can be safely passed around to methods which expect immutable [Vector2f], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector2f( + override var x: Float = 0f, + override var y: Float = 0f +) : Vector2f(x, y), IMutableFloatVector, IMutableFractionalVector, IMutableVector, IMatrixSetterFloat { + constructor(input: IStruct2f) : this(input.component1(), input.component2()) + + override fun set(column: Int, row: Int, value: Float) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + + override var s by this::x + override var t by this::y + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector2f + + if (x != other.x) return false + if (y != other.y) return false + + return true + } + + override fun normalize(): Double { + val len = length + + if (len == 0.0) { + return len + } + + x = (x / len).toFloat() + y = (y / len).toFloat() + + return len + } + + override fun plusMut(other: Vector2f): MutableVector2f { + x += other.x + y += other.y + return this + } + + override fun minusMut(other: Vector2f): MutableVector2f { + x -= other.x + y -= other.y + return this + } + + override fun timesMut(other: Vector2f): MutableVector2f { + x *= other.x + y *= other.y + return this + } + + override fun divMut(other: Vector2f): MutableVector2f { + x /= other.x + y /= other.y + return this + } + + override fun timesMut(other: Float): MutableVector2f { + x *= other + y *= other + return this + } + + override fun divMut(other: Float): MutableVector2f { + x /= other + y /= other + return this + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector3f.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector3f.kt new file mode 100644 index 00000000..a6a51844 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector3f.kt @@ -0,0 +1,680 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.nfloat + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 3D Vector, representing three-dimensional coordinates as [Float]s + */ +open class Vector3f( + open val x: Float = 0f, + open val y: Float = 0f, + open val z: Float = 0f, +) : AbstractVector(), IFractionalVector, IFloatVector, IStruct3f, IMatrixGetterFloat { + final override fun component1() = x + final override fun component2() = y + final override fun component3() = z + + override fun get(column: Int, row: Int): Float { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + 2 -> z + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + constructor(input: IStruct2f, z: Float = 0f) : this(input.component1(), input.component2(), z) + constructor(x: Float, input: IStruct2f) : this(x, input.component1(), input.component2()) + constructor(input: IStruct3f) : this(input.component1(), input.component2(), input.component3()) + + final override val rows: Int = 3 + final override val lengthSquared: Double + get() = x.toDouble() * x.toDouble() + y.toDouble() * y.toDouble() + z.toDouble() * z.toDouble() + + final override val isFinite: Boolean + get() = x.isFinite() && y.isFinite() && z.isFinite() + final override val isNaN: Boolean + get() = x.isNaN() || y.isNaN() || z.isNaN() + + open val r by this::x + open val g by this::y + open val b by this::z + + open val s by this::x + open val t by this::y + open val p by this::z + + override fun plus(other: Vector3f): Vector3f { + return Vector3f( + x + other.x, + y + other.y, + z + other.z, + ) + } + + override fun minus(other: Vector3f): Vector3f { + return Vector3f( + x - other.x, + y - other.y, + z - other.z, + ) + } + + override fun times(other: Vector3f): Vector3f { + return Vector3f( + x * other.x, + y * other.y, + z * other.z, + ) + } + + override fun div(other: Vector3f): Vector3f { + return Vector3f( + x / other.x, + y / other.y, + z / other.z, + ) + } + + override val absoluteValue: Vector3f + get() = Vector3f(x.absoluteValue, y.absoluteValue, z.absoluteValue) + + override fun coerceAtMost(maximal: Vector3f): Vector3f { + return Vector3f( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + z.coerceAtMost(maximal.z), + ) + } + + override fun coerceAtLeast(minimal: Vector3f): Vector3f { + return Vector3f( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + z.coerceAtLeast(minimal.z), + ) + } + + override fun clamp(minimal: Vector3f, maximal: Vector3f): Vector3f { + return Vector3f( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + z.coerceAtLeast(minimal.z).coerceAtMost(maximal.z), + ) + } + + override fun unaryMinus(): Vector3f { + return Vector3f(-x, -y, -z) + } + + override fun distanceSquared(other: Vector3f): Double { + val x = x.toDouble() - other.x.toDouble() + val y = y.toDouble() - other.y.toDouble() + val z = z.toDouble() - other.z.toDouble() + + return x * x + y * y + z * z + } + + override val normalized: Vector3f + get() { + val len = length + + if (len == 0.0) { + return ZERO + } + + return Vector3f( + (x / len).toFloat(), + (y / len).toFloat(), + (z / len).toFloat() + ) + } + + override fun times(other: Float): Vector3f { + return Vector3f(x * other, y * other, z * other) + } + + override fun div(other: Float): Vector3f { + return Vector3f(x / other, y / other, z / other) + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector4f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + other.z.toDouble() * z.toDouble() + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector3f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + other.z.toDouble() * z.toDouble() + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector2f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + } + + /** + * Calculates vector vector * vector, returning result as new vector + */ + fun cross(other: Vector3f): Vector3f { + return Vector3f( + y * other.z - z * other.y, + z * other.x - x * other.z, + x * other.y - y * other.x, + ) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector3f + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + + return true + } + + override fun hashCode(): Int { + var result = x.hashCode() + result = 31 * result + y.hashCode() + result = 31 * result + z.hashCode() + return result + } + + override fun toString(): String { + return "[${x}f ${y}f ${z}f]" + } + + inline val xx get() = Vector2f(x, x) + inline val xy get() = Vector2f(x, y) + inline val xz get() = Vector2f(x, z) + inline val yx get() = Vector2f(y, x) + inline val yy get() = Vector2f(y, y) + inline val yz get() = Vector2f(y, z) + inline val zx get() = Vector2f(z, x) + inline val zy get() = Vector2f(z, y) + inline val zz get() = Vector2f(z, z) + inline val xxx get() = Vector3f(x, x, x) + inline val xxy get() = Vector3f(x, x, y) + inline val xxz get() = Vector3f(x, x, z) + inline val xyx get() = Vector3f(x, y, x) + inline val xyy get() = Vector3f(x, y, y) + inline val xyz get() = Vector3f(x, y, z) + inline val xzx get() = Vector3f(x, z, x) + inline val xzy get() = Vector3f(x, z, y) + inline val xzz get() = Vector3f(x, z, z) + inline val yxx get() = Vector3f(y, x, x) + inline val yxy get() = Vector3f(y, x, y) + inline val yxz get() = Vector3f(y, x, z) + inline val yyx get() = Vector3f(y, y, x) + inline val yyy get() = Vector3f(y, y, y) + inline val yyz get() = Vector3f(y, y, z) + inline val yzx get() = Vector3f(y, z, x) + inline val yzy get() = Vector3f(y, z, y) + inline val yzz get() = Vector3f(y, z, z) + inline val zxx get() = Vector3f(z, x, x) + inline val zxy get() = Vector3f(z, x, y) + inline val zxz get() = Vector3f(z, x, z) + inline val zyx get() = Vector3f(z, y, x) + inline val zyy get() = Vector3f(z, y, y) + inline val zyz get() = Vector3f(z, y, z) + inline val zzx get() = Vector3f(z, z, x) + inline val zzy get() = Vector3f(z, z, y) + inline val zzz get() = Vector3f(z, z, z) + inline val xxxx get() = Vector4f(x, x, x, x) + inline val xxxy get() = Vector4f(x, x, x, y) + inline val xxxz get() = Vector4f(x, x, x, z) + inline val xxyx get() = Vector4f(x, x, y, x) + inline val xxyy get() = Vector4f(x, x, y, y) + inline val xxyz get() = Vector4f(x, x, y, z) + inline val xxzx get() = Vector4f(x, x, z, x) + inline val xxzy get() = Vector4f(x, x, z, y) + inline val xxzz get() = Vector4f(x, x, z, z) + inline val xyxx get() = Vector4f(x, y, x, x) + inline val xyxy get() = Vector4f(x, y, x, y) + inline val xyxz get() = Vector4f(x, y, x, z) + inline val xyyx get() = Vector4f(x, y, y, x) + inline val xyyy get() = Vector4f(x, y, y, y) + inline val xyyz get() = Vector4f(x, y, y, z) + inline val xyzx get() = Vector4f(x, y, z, x) + inline val xyzy get() = Vector4f(x, y, z, y) + inline val xyzz get() = Vector4f(x, y, z, z) + inline val xzxx get() = Vector4f(x, z, x, x) + inline val xzxy get() = Vector4f(x, z, x, y) + inline val xzxz get() = Vector4f(x, z, x, z) + inline val xzyx get() = Vector4f(x, z, y, x) + inline val xzyy get() = Vector4f(x, z, y, y) + inline val xzyz get() = Vector4f(x, z, y, z) + inline val xzzx get() = Vector4f(x, z, z, x) + inline val xzzy get() = Vector4f(x, z, z, y) + inline val xzzz get() = Vector4f(x, z, z, z) + inline val yxxx get() = Vector4f(y, x, x, x) + inline val yxxy get() = Vector4f(y, x, x, y) + inline val yxxz get() = Vector4f(y, x, x, z) + inline val yxyx get() = Vector4f(y, x, y, x) + inline val yxyy get() = Vector4f(y, x, y, y) + inline val yxyz get() = Vector4f(y, x, y, z) + inline val yxzx get() = Vector4f(y, x, z, x) + inline val yxzy get() = Vector4f(y, x, z, y) + inline val yxzz get() = Vector4f(y, x, z, z) + inline val yyxx get() = Vector4f(y, y, x, x) + inline val yyxy get() = Vector4f(y, y, x, y) + inline val yyxz get() = Vector4f(y, y, x, z) + inline val yyyx get() = Vector4f(y, y, y, x) + inline val yyyy get() = Vector4f(y, y, y, y) + inline val yyyz get() = Vector4f(y, y, y, z) + inline val yyzx get() = Vector4f(y, y, z, x) + inline val yyzy get() = Vector4f(y, y, z, y) + inline val yyzz get() = Vector4f(y, y, z, z) + inline val yzxx get() = Vector4f(y, z, x, x) + inline val yzxy get() = Vector4f(y, z, x, y) + inline val yzxz get() = Vector4f(y, z, x, z) + inline val yzyx get() = Vector4f(y, z, y, x) + inline val yzyy get() = Vector4f(y, z, y, y) + inline val yzyz get() = Vector4f(y, z, y, z) + inline val yzzx get() = Vector4f(y, z, z, x) + inline val yzzy get() = Vector4f(y, z, z, y) + inline val yzzz get() = Vector4f(y, z, z, z) + inline val zxxx get() = Vector4f(z, x, x, x) + inline val zxxy get() = Vector4f(z, x, x, y) + inline val zxxz get() = Vector4f(z, x, x, z) + inline val zxyx get() = Vector4f(z, x, y, x) + inline val zxyy get() = Vector4f(z, x, y, y) + inline val zxyz get() = Vector4f(z, x, y, z) + inline val zxzx get() = Vector4f(z, x, z, x) + inline val zxzy get() = Vector4f(z, x, z, y) + inline val zxzz get() = Vector4f(z, x, z, z) + inline val zyxx get() = Vector4f(z, y, x, x) + inline val zyxy get() = Vector4f(z, y, x, y) + inline val zyxz get() = Vector4f(z, y, x, z) + inline val zyyx get() = Vector4f(z, y, y, x) + inline val zyyy get() = Vector4f(z, y, y, y) + inline val zyyz get() = Vector4f(z, y, y, z) + inline val zyzx get() = Vector4f(z, y, z, x) + inline val zyzy get() = Vector4f(z, y, z, y) + inline val zyzz get() = Vector4f(z, y, z, z) + inline val zzxx get() = Vector4f(z, z, x, x) + inline val zzxy get() = Vector4f(z, z, x, y) + inline val zzxz get() = Vector4f(z, z, x, z) + inline val zzyx get() = Vector4f(z, z, y, x) + inline val zzyy get() = Vector4f(z, z, y, y) + inline val zzyz get() = Vector4f(z, z, y, z) + inline val zzzx get() = Vector4f(z, z, z, x) + inline val zzzy get() = Vector4f(z, z, z, y) + inline val zzzz get() = Vector4f(z, z, z, z) + inline val rr get() = Vector2f(r, r) + inline val rg get() = Vector2f(r, g) + inline val rb get() = Vector2f(r, b) + inline val gr get() = Vector2f(g, r) + inline val gg get() = Vector2f(g, g) + inline val gb get() = Vector2f(g, b) + inline val br get() = Vector2f(b, r) + inline val bg get() = Vector2f(b, g) + inline val bb get() = Vector2f(b, b) + inline val rrr get() = Vector3f(r, r, r) + inline val rrg get() = Vector3f(r, r, g) + inline val rrb get() = Vector3f(r, r, b) + inline val rgr get() = Vector3f(r, g, r) + inline val rgg get() = Vector3f(r, g, g) + inline val rgb get() = Vector3f(r, g, b) + inline val rbr get() = Vector3f(r, b, r) + inline val rbg get() = Vector3f(r, b, g) + inline val rbb get() = Vector3f(r, b, b) + inline val grr get() = Vector3f(g, r, r) + inline val grg get() = Vector3f(g, r, g) + inline val grb get() = Vector3f(g, r, b) + inline val ggr get() = Vector3f(g, g, r) + inline val ggg get() = Vector3f(g, g, g) + inline val ggb get() = Vector3f(g, g, b) + inline val gbr get() = Vector3f(g, b, r) + inline val gbg get() = Vector3f(g, b, g) + inline val gbb get() = Vector3f(g, b, b) + inline val brr get() = Vector3f(b, r, r) + inline val brg get() = Vector3f(b, r, g) + inline val brb get() = Vector3f(b, r, b) + inline val bgr get() = Vector3f(b, g, r) + inline val bgg get() = Vector3f(b, g, g) + inline val bgb get() = Vector3f(b, g, b) + inline val bbr get() = Vector3f(b, b, r) + inline val bbg get() = Vector3f(b, b, g) + inline val bbb get() = Vector3f(b, b, b) + inline val rrrr get() = Vector4f(r, r, r, r) + inline val rrrg get() = Vector4f(r, r, r, g) + inline val rrrb get() = Vector4f(r, r, r, b) + inline val rrgr get() = Vector4f(r, r, g, r) + inline val rrgg get() = Vector4f(r, r, g, g) + inline val rrgb get() = Vector4f(r, r, g, b) + inline val rrbr get() = Vector4f(r, r, b, r) + inline val rrbg get() = Vector4f(r, r, b, g) + inline val rrbb get() = Vector4f(r, r, b, b) + inline val rgrr get() = Vector4f(r, g, r, r) + inline val rgrg get() = Vector4f(r, g, r, g) + inline val rgrb get() = Vector4f(r, g, r, b) + inline val rggr get() = Vector4f(r, g, g, r) + inline val rggg get() = Vector4f(r, g, g, g) + inline val rggb get() = Vector4f(r, g, g, b) + inline val rgbr get() = Vector4f(r, g, b, r) + inline val rgbg get() = Vector4f(r, g, b, g) + inline val rgbb get() = Vector4f(r, g, b, b) + inline val rbrr get() = Vector4f(r, b, r, r) + inline val rbrg get() = Vector4f(r, b, r, g) + inline val rbrb get() = Vector4f(r, b, r, b) + inline val rbgr get() = Vector4f(r, b, g, r) + inline val rbgg get() = Vector4f(r, b, g, g) + inline val rbgb get() = Vector4f(r, b, g, b) + inline val rbbr get() = Vector4f(r, b, b, r) + inline val rbbg get() = Vector4f(r, b, b, g) + inline val rbbb get() = Vector4f(r, b, b, b) + inline val grrr get() = Vector4f(g, r, r, r) + inline val grrg get() = Vector4f(g, r, r, g) + inline val grrb get() = Vector4f(g, r, r, b) + inline val grgr get() = Vector4f(g, r, g, r) + inline val grgg get() = Vector4f(g, r, g, g) + inline val grgb get() = Vector4f(g, r, g, b) + inline val grbr get() = Vector4f(g, r, b, r) + inline val grbg get() = Vector4f(g, r, b, g) + inline val grbb get() = Vector4f(g, r, b, b) + inline val ggrr get() = Vector4f(g, g, r, r) + inline val ggrg get() = Vector4f(g, g, r, g) + inline val ggrb get() = Vector4f(g, g, r, b) + inline val gggr get() = Vector4f(g, g, g, r) + inline val gggg get() = Vector4f(g, g, g, g) + inline val gggb get() = Vector4f(g, g, g, b) + inline val ggbr get() = Vector4f(g, g, b, r) + inline val ggbg get() = Vector4f(g, g, b, g) + inline val ggbb get() = Vector4f(g, g, b, b) + inline val gbrr get() = Vector4f(g, b, r, r) + inline val gbrg get() = Vector4f(g, b, r, g) + inline val gbrb get() = Vector4f(g, b, r, b) + inline val gbgr get() = Vector4f(g, b, g, r) + inline val gbgg get() = Vector4f(g, b, g, g) + inline val gbgb get() = Vector4f(g, b, g, b) + inline val gbbr get() = Vector4f(g, b, b, r) + inline val gbbg get() = Vector4f(g, b, b, g) + inline val gbbb get() = Vector4f(g, b, b, b) + inline val brrr get() = Vector4f(b, r, r, r) + inline val brrg get() = Vector4f(b, r, r, g) + inline val brrb get() = Vector4f(b, r, r, b) + inline val brgr get() = Vector4f(b, r, g, r) + inline val brgg get() = Vector4f(b, r, g, g) + inline val brgb get() = Vector4f(b, r, g, b) + inline val brbr get() = Vector4f(b, r, b, r) + inline val brbg get() = Vector4f(b, r, b, g) + inline val brbb get() = Vector4f(b, r, b, b) + inline val bgrr get() = Vector4f(b, g, r, r) + inline val bgrg get() = Vector4f(b, g, r, g) + inline val bgrb get() = Vector4f(b, g, r, b) + inline val bggr get() = Vector4f(b, g, g, r) + inline val bggg get() = Vector4f(b, g, g, g) + inline val bggb get() = Vector4f(b, g, g, b) + inline val bgbr get() = Vector4f(b, g, b, r) + inline val bgbg get() = Vector4f(b, g, b, g) + inline val bgbb get() = Vector4f(b, g, b, b) + inline val bbrr get() = Vector4f(b, b, r, r) + inline val bbrg get() = Vector4f(b, b, r, g) + inline val bbrb get() = Vector4f(b, b, r, b) + inline val bbgr get() = Vector4f(b, b, g, r) + inline val bbgg get() = Vector4f(b, b, g, g) + inline val bbgb get() = Vector4f(b, b, g, b) + inline val bbbr get() = Vector4f(b, b, b, r) + inline val bbbg get() = Vector4f(b, b, b, g) + inline val bbbb get() = Vector4f(b, b, b, b) + inline val ss get() = Vector2f(s, s) + inline val st get() = Vector2f(s, t) + inline val sp get() = Vector2f(s, p) + inline val ts get() = Vector2f(t, s) + inline val tt get() = Vector2f(t, t) + inline val tp get() = Vector2f(t, p) + inline val ps get() = Vector2f(p, s) + inline val pt get() = Vector2f(p, t) + inline val pp get() = Vector2f(p, p) + inline val sss get() = Vector3f(s, s, s) + inline val sst get() = Vector3f(s, s, t) + inline val ssp get() = Vector3f(s, s, p) + inline val sts get() = Vector3f(s, t, s) + inline val stt get() = Vector3f(s, t, t) + inline val stp get() = Vector3f(s, t, p) + inline val sps get() = Vector3f(s, p, s) + inline val spt get() = Vector3f(s, p, t) + inline val spp get() = Vector3f(s, p, p) + inline val tss get() = Vector3f(t, s, s) + inline val tst get() = Vector3f(t, s, t) + inline val tsp get() = Vector3f(t, s, p) + inline val tts get() = Vector3f(t, t, s) + inline val ttt get() = Vector3f(t, t, t) + inline val ttp get() = Vector3f(t, t, p) + inline val tps get() = Vector3f(t, p, s) + inline val tpt get() = Vector3f(t, p, t) + inline val tpp get() = Vector3f(t, p, p) + inline val pss get() = Vector3f(p, s, s) + inline val pst get() = Vector3f(p, s, t) + inline val psp get() = Vector3f(p, s, p) + inline val pts get() = Vector3f(p, t, s) + inline val ptt get() = Vector3f(p, t, t) + inline val ptp get() = Vector3f(p, t, p) + inline val pps get() = Vector3f(p, p, s) + inline val ppt get() = Vector3f(p, p, t) + inline val ppp get() = Vector3f(p, p, p) + inline val ssss get() = Vector4f(s, s, s, s) + inline val ssst get() = Vector4f(s, s, s, t) + inline val sssp get() = Vector4f(s, s, s, p) + inline val ssts get() = Vector4f(s, s, t, s) + inline val sstt get() = Vector4f(s, s, t, t) + inline val sstp get() = Vector4f(s, s, t, p) + inline val ssps get() = Vector4f(s, s, p, s) + inline val sspt get() = Vector4f(s, s, p, t) + inline val sspp get() = Vector4f(s, s, p, p) + inline val stss get() = Vector4f(s, t, s, s) + inline val stst get() = Vector4f(s, t, s, t) + inline val stsp get() = Vector4f(s, t, s, p) + inline val stts get() = Vector4f(s, t, t, s) + inline val sttt get() = Vector4f(s, t, t, t) + inline val sttp get() = Vector4f(s, t, t, p) + inline val stps get() = Vector4f(s, t, p, s) + inline val stpt get() = Vector4f(s, t, p, t) + inline val stpp get() = Vector4f(s, t, p, p) + inline val spss get() = Vector4f(s, p, s, s) + inline val spst get() = Vector4f(s, p, s, t) + inline val spsp get() = Vector4f(s, p, s, p) + inline val spts get() = Vector4f(s, p, t, s) + inline val sptt get() = Vector4f(s, p, t, t) + inline val sptp get() = Vector4f(s, p, t, p) + inline val spps get() = Vector4f(s, p, p, s) + inline val sppt get() = Vector4f(s, p, p, t) + inline val sppp get() = Vector4f(s, p, p, p) + inline val tsss get() = Vector4f(t, s, s, s) + inline val tsst get() = Vector4f(t, s, s, t) + inline val tssp get() = Vector4f(t, s, s, p) + inline val tsts get() = Vector4f(t, s, t, s) + inline val tstt get() = Vector4f(t, s, t, t) + inline val tstp get() = Vector4f(t, s, t, p) + inline val tsps get() = Vector4f(t, s, p, s) + inline val tspt get() = Vector4f(t, s, p, t) + inline val tspp get() = Vector4f(t, s, p, p) + inline val ttss get() = Vector4f(t, t, s, s) + inline val ttst get() = Vector4f(t, t, s, t) + inline val ttsp get() = Vector4f(t, t, s, p) + inline val ttts get() = Vector4f(t, t, t, s) + inline val tttt get() = Vector4f(t, t, t, t) + inline val tttp get() = Vector4f(t, t, t, p) + inline val ttps get() = Vector4f(t, t, p, s) + inline val ttpt get() = Vector4f(t, t, p, t) + inline val ttpp get() = Vector4f(t, t, p, p) + inline val tpss get() = Vector4f(t, p, s, s) + inline val tpst get() = Vector4f(t, p, s, t) + inline val tpsp get() = Vector4f(t, p, s, p) + inline val tpts get() = Vector4f(t, p, t, s) + inline val tptt get() = Vector4f(t, p, t, t) + inline val tptp get() = Vector4f(t, p, t, p) + inline val tpps get() = Vector4f(t, p, p, s) + inline val tppt get() = Vector4f(t, p, p, t) + inline val tppp get() = Vector4f(t, p, p, p) + inline val psss get() = Vector4f(p, s, s, s) + inline val psst get() = Vector4f(p, s, s, t) + inline val pssp get() = Vector4f(p, s, s, p) + inline val psts get() = Vector4f(p, s, t, s) + inline val pstt get() = Vector4f(p, s, t, t) + inline val pstp get() = Vector4f(p, s, t, p) + inline val psps get() = Vector4f(p, s, p, s) + inline val pspt get() = Vector4f(p, s, p, t) + inline val pspp get() = Vector4f(p, s, p, p) + inline val ptss get() = Vector4f(p, t, s, s) + inline val ptst get() = Vector4f(p, t, s, t) + inline val ptsp get() = Vector4f(p, t, s, p) + inline val ptts get() = Vector4f(p, t, t, s) + inline val pttt get() = Vector4f(p, t, t, t) + inline val pttp get() = Vector4f(p, t, t, p) + inline val ptps get() = Vector4f(p, t, p, s) + inline val ptpt get() = Vector4f(p, t, p, t) + inline val ptpp get() = Vector4f(p, t, p, p) + inline val ppss get() = Vector4f(p, p, s, s) + inline val ppst get() = Vector4f(p, p, s, t) + inline val ppsp get() = Vector4f(p, p, s, p) + inline val ppts get() = Vector4f(p, p, t, s) + inline val pptt get() = Vector4f(p, p, t, t) + inline val pptp get() = Vector4f(p, p, t, p) + inline val ppps get() = Vector4f(p, p, p, s) + inline val pppt get() = Vector4f(p, p, p, t) + inline val pppp get() = Vector4f(p, p, p, p) + + companion object { + @JvmField val ZERO = Vector3f() + @JvmField val POSITIVE_X = Vector3f(x = 1f) + @JvmField val NEGATIVE_X = Vector3f(x = -1f) + @JvmField val POSITIVE_Y = Vector3f(y = 1f) + @JvmField val NEGATIVE_Y = Vector3f(y = -1f) + @JvmField val POSITIVE_Z = Vector3f(z = 1f) + @JvmField val NEGATIVE_Z = Vector3f(z = -1f) + } +} + +operator fun Float.times(other: Vector3f): Vector3f { + return Vector3f(this * other.x, this * other.y, this * other.z) +} + +operator fun Float.div(other: Vector3f): Vector3f { + return Vector3f(this / other.x, this / other.y, this / other.z) +} + +/** + * Mutable 3D Vector, representing three-dimensional coordinates as [Float]s + * + * It can be safely passed around to methods which expect immutable [Vector3f], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector3f( + override var x: Float = 0f, + override var y: Float = 0f, + override var z: Float = 0f, +) : Vector3f(x, y), IMutableFloatVector, IMutableFractionalVector, IMutableVector, IMatrixSetterFloat { + constructor(input: IStruct2f, z: Float = 0f) : this(input.component1(), input.component2(), z) + constructor(x: Float, input: IStruct2f) : this(x, input.component1(), input.component2()) + constructor(input: IStruct3f) : this(input.component1(), input.component2(), input.component3()) + + override fun set(column: Int, row: Int, value: Float) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + 2 -> z = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + override var b by this::z + + override var s by this::x + override var t by this::y + override var p by this::z + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector3f + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + + return true + } + + override fun normalize(): Double { + val len = length + + if (len == 0.0) { + return 0.0 + } + + x = (x / len).toFloat() + y = (y / len).toFloat() + z = (z / len).toFloat() + + return len + } + + override fun plusMut(other: Vector3f): MutableVector3f { + x += other.x + y += other.y + z += other.z + return this + } + + override fun minusMut(other: Vector3f): MutableVector3f { + x -= other.x + y -= other.y + z -= other.z + return this + } + + override fun timesMut(other: Vector3f): MutableVector3f { + x *= other.x + y *= other.y + z *= other.z + return this + } + + override fun divMut(other: Vector3f): MutableVector3f { + x /= other.x + y /= other.y + z /= other.z + return this + } + + override fun timesMut(other: Float): MutableVector3f { + x *= other + y *= other + z *= other + return this + } + + override fun divMut(other: Float): MutableVector3f { + x /= other + y /= other + z /= other + return this + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector4f.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector4f.kt new file mode 100644 index 00000000..6c9578d8 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nfloat/Vector4f.kt @@ -0,0 +1,1363 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.nfloat + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 4D Vector, representing four-dimensional coordinates as [Float]s + */ +open class Vector4f( + open val x: Float = 0f, + open val y: Float = 0f, + open val z: Float = 0f, + open val w: Float = 0f, +) : AbstractVector(), IFractionalVector, IFloatVector, IStruct4f, IMatrixGetterFloat { + final override fun component1() = x + final override fun component2() = y + final override fun component3() = z + final override fun component4() = w + + override fun get(column: Int, row: Int): Float { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + 2 -> z + 3 -> w + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + constructor(input: IStruct2f, z: Float = 0f, w: Float = 0f) : this(input.component1(), input.component2(), z, w) + constructor(x: Float, input: IStruct2f, w: Float = 0f) : this(x, input.component1(), input.component2(), w) + constructor(x: Float, y: Float, input: IStruct2f) : this(x, y, input.component1(), input.component2()) + + constructor(input: IStruct3f, w: Float = 0f) : this(input.component1(), input.component2(), input.component3(), w) + constructor(x: Float, input: IStruct3f) : this(x, input.component1(), input.component2(), input.component3()) + constructor(input: IStruct4f) : this(input.component1(), input.component2(), input.component3(), input.component4()) + + final override val rows: Int = 4 + final override val lengthSquared: Double + get() = x.toDouble() * x.toDouble() + y.toDouble() * y.toDouble() + z.toDouble() * z.toDouble() + w.toDouble() * w.toDouble() + + final override val isFinite: Boolean + get() = x.isFinite() && y.isFinite() && z.isFinite() && w.isFinite() + final override val isNaN: Boolean + get() = x.isNaN() || y.isNaN() || z.isNaN() || w.isNaN() + + open val r by this::x + open val g by this::y + open val b by this::z + open val a by this::w + + open val s by this::x + open val t by this::y + open val p by this::z + open val q by this::w + + override fun plus(other: Vector4f): Vector4f { + return Vector4f( + x + other.x, + y + other.y, + z + other.z, + w + other.w, + ) + } + + override fun minus(other: Vector4f): Vector4f { + return Vector4f( + x - other.x, + y - other.y, + z - other.z, + w - other.w, + ) + } + + override fun times(other: Vector4f): Vector4f { + return Vector4f( + x * other.x, + y * other.y, + z * other.z, + w * other.w, + ) + } + + override fun div(other: Vector4f): Vector4f { + return Vector4f( + x / other.x, + y / other.y, + z / other.z, + w / other.w, + ) + } + + override val absoluteValue: Vector4f + get() = Vector4f(x.absoluteValue, y.absoluteValue, z.absoluteValue, w.absoluteValue) + + override fun coerceAtMost(maximal: Vector4f): Vector4f { + return Vector4f( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + z.coerceAtMost(maximal.z), + w.coerceAtMost(maximal.w), + ) + } + + override fun coerceAtLeast(minimal: Vector4f): Vector4f { + return Vector4f( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + z.coerceAtLeast(minimal.z), + w.coerceAtLeast(minimal.w), + ) + } + + override fun clamp(minimal: Vector4f, maximal: Vector4f): Vector4f { + return Vector4f( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + z.coerceAtLeast(minimal.z).coerceAtMost(maximal.z), + w.coerceAtLeast(minimal.w).coerceAtMost(maximal.w), + ) + } + + override fun unaryMinus(): Vector4f { + return Vector4f(-x, -y, -z, -w) + } + + override fun distanceSquared(other: Vector4f): Double { + val x = x.toDouble() - other.x.toDouble() + val y = y.toDouble() - other.y.toDouble() + val z = z.toDouble() - other.z.toDouble() + val w = w.toDouble() - other.w.toDouble() + + return x * x + y * y + z * z + w * w + } + + override val normalized: Vector4f + get() { + val len = length + + if (len == 0.0) { + return ZERO + } + + return Vector4f( + (x / len).toFloat(), + (y / len).toFloat(), + (z / len).toFloat(), + (w / len).toFloat(), + ) + } + + override fun times(other: Float): Vector4f { + return Vector4f(x * other, y * other, z * other, w * other) + } + + override fun div(other: Float): Vector4f { + return Vector4f(x / other, y / other, z / other, w / other) + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector4f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + other.z.toDouble() * z.toDouble() + other.w.toDouble() * w.toDouble() + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector3f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + other.z.toDouble() * z.toDouble() + } + + /** + * Calculates scalar vector * vector, returning result as [Double] + */ + fun dot(other: Vector2f): Double { + return other.x.toDouble() * x.toDouble() + other.y.toDouble() * y.toDouble() + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector4f + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + if (w != other.w) return false + + return true + } + + override fun hashCode(): Int { + var result = x.hashCode() + result = 31 * result + y.hashCode() + result = 31 * result + z.hashCode() + result = 31 * result + w.hashCode() + return result + } + + override fun toString(): String { + return "[${x}f ${y}f ${z}f ${w}f]" + } + + inline val xx get() = Vector2f(x, x) + inline val xy get() = Vector2f(x, y) + inline val xz get() = Vector2f(x, z) + inline val xw get() = Vector2f(x, w) + inline val yx get() = Vector2f(y, x) + inline val yy get() = Vector2f(y, y) + inline val yz get() = Vector2f(y, z) + inline val yw get() = Vector2f(y, w) + inline val zx get() = Vector2f(z, x) + inline val zy get() = Vector2f(z, y) + inline val zz get() = Vector2f(z, z) + inline val zw get() = Vector2f(z, w) + inline val wx get() = Vector2f(w, x) + inline val wy get() = Vector2f(w, y) + inline val wz get() = Vector2f(w, z) + inline val ww get() = Vector2f(w, w) + inline val xxx get() = Vector3f(x, x, x) + inline val xxy get() = Vector3f(x, x, y) + inline val xxz get() = Vector3f(x, x, z) + inline val xxw get() = Vector3f(x, x, w) + inline val xyx get() = Vector3f(x, y, x) + inline val xyy get() = Vector3f(x, y, y) + inline val xyz get() = Vector3f(x, y, z) + inline val xyw get() = Vector3f(x, y, w) + inline val xzx get() = Vector3f(x, z, x) + inline val xzy get() = Vector3f(x, z, y) + inline val xzz get() = Vector3f(x, z, z) + inline val xzw get() = Vector3f(x, z, w) + inline val xwx get() = Vector3f(x, w, x) + inline val xwy get() = Vector3f(x, w, y) + inline val xwz get() = Vector3f(x, w, z) + inline val xww get() = Vector3f(x, w, w) + inline val yxx get() = Vector3f(y, x, x) + inline val yxy get() = Vector3f(y, x, y) + inline val yxz get() = Vector3f(y, x, z) + inline val yxw get() = Vector3f(y, x, w) + inline val yyx get() = Vector3f(y, y, x) + inline val yyy get() = Vector3f(y, y, y) + inline val yyz get() = Vector3f(y, y, z) + inline val yyw get() = Vector3f(y, y, w) + inline val yzx get() = Vector3f(y, z, x) + inline val yzy get() = Vector3f(y, z, y) + inline val yzz get() = Vector3f(y, z, z) + inline val yzw get() = Vector3f(y, z, w) + inline val ywx get() = Vector3f(y, w, x) + inline val ywy get() = Vector3f(y, w, y) + inline val ywz get() = Vector3f(y, w, z) + inline val yww get() = Vector3f(y, w, w) + inline val zxx get() = Vector3f(z, x, x) + inline val zxy get() = Vector3f(z, x, y) + inline val zxz get() = Vector3f(z, x, z) + inline val zxw get() = Vector3f(z, x, w) + inline val zyx get() = Vector3f(z, y, x) + inline val zyy get() = Vector3f(z, y, y) + inline val zyz get() = Vector3f(z, y, z) + inline val zyw get() = Vector3f(z, y, w) + inline val zzx get() = Vector3f(z, z, x) + inline val zzy get() = Vector3f(z, z, y) + inline val zzz get() = Vector3f(z, z, z) + inline val zzw get() = Vector3f(z, z, w) + inline val zwx get() = Vector3f(z, w, x) + inline val zwy get() = Vector3f(z, w, y) + inline val zwz get() = Vector3f(z, w, z) + inline val zww get() = Vector3f(z, w, w) + inline val wxx get() = Vector3f(w, x, x) + inline val wxy get() = Vector3f(w, x, y) + inline val wxz get() = Vector3f(w, x, z) + inline val wxw get() = Vector3f(w, x, w) + inline val wyx get() = Vector3f(w, y, x) + inline val wyy get() = Vector3f(w, y, y) + inline val wyz get() = Vector3f(w, y, z) + inline val wyw get() = Vector3f(w, y, w) + inline val wzx get() = Vector3f(w, z, x) + inline val wzy get() = Vector3f(w, z, y) + inline val wzz get() = Vector3f(w, z, z) + inline val wzw get() = Vector3f(w, z, w) + inline val wwx get() = Vector3f(w, w, x) + inline val wwy get() = Vector3f(w, w, y) + inline val wwz get() = Vector3f(w, w, z) + inline val www get() = Vector3f(w, w, w) + inline val xxxx get() = Vector4f(x, x, x, x) + inline val xxxy get() = Vector4f(x, x, x, y) + inline val xxxz get() = Vector4f(x, x, x, z) + inline val xxxw get() = Vector4f(x, x, x, w) + inline val xxyx get() = Vector4f(x, x, y, x) + inline val xxyy get() = Vector4f(x, x, y, y) + inline val xxyz get() = Vector4f(x, x, y, z) + inline val xxyw get() = Vector4f(x, x, y, w) + inline val xxzx get() = Vector4f(x, x, z, x) + inline val xxzy get() = Vector4f(x, x, z, y) + inline val xxzz get() = Vector4f(x, x, z, z) + inline val xxzw get() = Vector4f(x, x, z, w) + inline val xxwx get() = Vector4f(x, x, w, x) + inline val xxwy get() = Vector4f(x, x, w, y) + inline val xxwz get() = Vector4f(x, x, w, z) + inline val xxww get() = Vector4f(x, x, w, w) + inline val xyxx get() = Vector4f(x, y, x, x) + inline val xyxy get() = Vector4f(x, y, x, y) + inline val xyxz get() = Vector4f(x, y, x, z) + inline val xyxw get() = Vector4f(x, y, x, w) + inline val xyyx get() = Vector4f(x, y, y, x) + inline val xyyy get() = Vector4f(x, y, y, y) + inline val xyyz get() = Vector4f(x, y, y, z) + inline val xyyw get() = Vector4f(x, y, y, w) + inline val xyzx get() = Vector4f(x, y, z, x) + inline val xyzy get() = Vector4f(x, y, z, y) + inline val xyzz get() = Vector4f(x, y, z, z) + inline val xyzw get() = Vector4f(x, y, z, w) + inline val xywx get() = Vector4f(x, y, w, x) + inline val xywy get() = Vector4f(x, y, w, y) + inline val xywz get() = Vector4f(x, y, w, z) + inline val xyww get() = Vector4f(x, y, w, w) + inline val xzxx get() = Vector4f(x, z, x, x) + inline val xzxy get() = Vector4f(x, z, x, y) + inline val xzxz get() = Vector4f(x, z, x, z) + inline val xzxw get() = Vector4f(x, z, x, w) + inline val xzyx get() = Vector4f(x, z, y, x) + inline val xzyy get() = Vector4f(x, z, y, y) + inline val xzyz get() = Vector4f(x, z, y, z) + inline val xzyw get() = Vector4f(x, z, y, w) + inline val xzzx get() = Vector4f(x, z, z, x) + inline val xzzy get() = Vector4f(x, z, z, y) + inline val xzzz get() = Vector4f(x, z, z, z) + inline val xzzw get() = Vector4f(x, z, z, w) + inline val xzwx get() = Vector4f(x, z, w, x) + inline val xzwy get() = Vector4f(x, z, w, y) + inline val xzwz get() = Vector4f(x, z, w, z) + inline val xzww get() = Vector4f(x, z, w, w) + inline val xwxx get() = Vector4f(x, w, x, x) + inline val xwxy get() = Vector4f(x, w, x, y) + inline val xwxz get() = Vector4f(x, w, x, z) + inline val xwxw get() = Vector4f(x, w, x, w) + inline val xwyx get() = Vector4f(x, w, y, x) + inline val xwyy get() = Vector4f(x, w, y, y) + inline val xwyz get() = Vector4f(x, w, y, z) + inline val xwyw get() = Vector4f(x, w, y, w) + inline val xwzx get() = Vector4f(x, w, z, x) + inline val xwzy get() = Vector4f(x, w, z, y) + inline val xwzz get() = Vector4f(x, w, z, z) + inline val xwzw get() = Vector4f(x, w, z, w) + inline val xwwx get() = Vector4f(x, w, w, x) + inline val xwwy get() = Vector4f(x, w, w, y) + inline val xwwz get() = Vector4f(x, w, w, z) + inline val xwww get() = Vector4f(x, w, w, w) + inline val yxxx get() = Vector4f(y, x, x, x) + inline val yxxy get() = Vector4f(y, x, x, y) + inline val yxxz get() = Vector4f(y, x, x, z) + inline val yxxw get() = Vector4f(y, x, x, w) + inline val yxyx get() = Vector4f(y, x, y, x) + inline val yxyy get() = Vector4f(y, x, y, y) + inline val yxyz get() = Vector4f(y, x, y, z) + inline val yxyw get() = Vector4f(y, x, y, w) + inline val yxzx get() = Vector4f(y, x, z, x) + inline val yxzy get() = Vector4f(y, x, z, y) + inline val yxzz get() = Vector4f(y, x, z, z) + inline val yxzw get() = Vector4f(y, x, z, w) + inline val yxwx get() = Vector4f(y, x, w, x) + inline val yxwy get() = Vector4f(y, x, w, y) + inline val yxwz get() = Vector4f(y, x, w, z) + inline val yxww get() = Vector4f(y, x, w, w) + inline val yyxx get() = Vector4f(y, y, x, x) + inline val yyxy get() = Vector4f(y, y, x, y) + inline val yyxz get() = Vector4f(y, y, x, z) + inline val yyxw get() = Vector4f(y, y, x, w) + inline val yyyx get() = Vector4f(y, y, y, x) + inline val yyyy get() = Vector4f(y, y, y, y) + inline val yyyz get() = Vector4f(y, y, y, z) + inline val yyyw get() = Vector4f(y, y, y, w) + inline val yyzx get() = Vector4f(y, y, z, x) + inline val yyzy get() = Vector4f(y, y, z, y) + inline val yyzz get() = Vector4f(y, y, z, z) + inline val yyzw get() = Vector4f(y, y, z, w) + inline val yywx get() = Vector4f(y, y, w, x) + inline val yywy get() = Vector4f(y, y, w, y) + inline val yywz get() = Vector4f(y, y, w, z) + inline val yyww get() = Vector4f(y, y, w, w) + inline val yzxx get() = Vector4f(y, z, x, x) + inline val yzxy get() = Vector4f(y, z, x, y) + inline val yzxz get() = Vector4f(y, z, x, z) + inline val yzxw get() = Vector4f(y, z, x, w) + inline val yzyx get() = Vector4f(y, z, y, x) + inline val yzyy get() = Vector4f(y, z, y, y) + inline val yzyz get() = Vector4f(y, z, y, z) + inline val yzyw get() = Vector4f(y, z, y, w) + inline val yzzx get() = Vector4f(y, z, z, x) + inline val yzzy get() = Vector4f(y, z, z, y) + inline val yzzz get() = Vector4f(y, z, z, z) + inline val yzzw get() = Vector4f(y, z, z, w) + inline val yzwx get() = Vector4f(y, z, w, x) + inline val yzwy get() = Vector4f(y, z, w, y) + inline val yzwz get() = Vector4f(y, z, w, z) + inline val yzww get() = Vector4f(y, z, w, w) + inline val ywxx get() = Vector4f(y, w, x, x) + inline val ywxy get() = Vector4f(y, w, x, y) + inline val ywxz get() = Vector4f(y, w, x, z) + inline val ywxw get() = Vector4f(y, w, x, w) + inline val ywyx get() = Vector4f(y, w, y, x) + inline val ywyy get() = Vector4f(y, w, y, y) + inline val ywyz get() = Vector4f(y, w, y, z) + inline val ywyw get() = Vector4f(y, w, y, w) + inline val ywzx get() = Vector4f(y, w, z, x) + inline val ywzy get() = Vector4f(y, w, z, y) + inline val ywzz get() = Vector4f(y, w, z, z) + inline val ywzw get() = Vector4f(y, w, z, w) + inline val ywwx get() = Vector4f(y, w, w, x) + inline val ywwy get() = Vector4f(y, w, w, y) + inline val ywwz get() = Vector4f(y, w, w, z) + inline val ywww get() = Vector4f(y, w, w, w) + inline val zxxx get() = Vector4f(z, x, x, x) + inline val zxxy get() = Vector4f(z, x, x, y) + inline val zxxz get() = Vector4f(z, x, x, z) + inline val zxxw get() = Vector4f(z, x, x, w) + inline val zxyx get() = Vector4f(z, x, y, x) + inline val zxyy get() = Vector4f(z, x, y, y) + inline val zxyz get() = Vector4f(z, x, y, z) + inline val zxyw get() = Vector4f(z, x, y, w) + inline val zxzx get() = Vector4f(z, x, z, x) + inline val zxzy get() = Vector4f(z, x, z, y) + inline val zxzz get() = Vector4f(z, x, z, z) + inline val zxzw get() = Vector4f(z, x, z, w) + inline val zxwx get() = Vector4f(z, x, w, x) + inline val zxwy get() = Vector4f(z, x, w, y) + inline val zxwz get() = Vector4f(z, x, w, z) + inline val zxww get() = Vector4f(z, x, w, w) + inline val zyxx get() = Vector4f(z, y, x, x) + inline val zyxy get() = Vector4f(z, y, x, y) + inline val zyxz get() = Vector4f(z, y, x, z) + inline val zyxw get() = Vector4f(z, y, x, w) + inline val zyyx get() = Vector4f(z, y, y, x) + inline val zyyy get() = Vector4f(z, y, y, y) + inline val zyyz get() = Vector4f(z, y, y, z) + inline val zyyw get() = Vector4f(z, y, y, w) + inline val zyzx get() = Vector4f(z, y, z, x) + inline val zyzy get() = Vector4f(z, y, z, y) + inline val zyzz get() = Vector4f(z, y, z, z) + inline val zyzw get() = Vector4f(z, y, z, w) + inline val zywx get() = Vector4f(z, y, w, x) + inline val zywy get() = Vector4f(z, y, w, y) + inline val zywz get() = Vector4f(z, y, w, z) + inline val zyww get() = Vector4f(z, y, w, w) + inline val zzxx get() = Vector4f(z, z, x, x) + inline val zzxy get() = Vector4f(z, z, x, y) + inline val zzxz get() = Vector4f(z, z, x, z) + inline val zzxw get() = Vector4f(z, z, x, w) + inline val zzyx get() = Vector4f(z, z, y, x) + inline val zzyy get() = Vector4f(z, z, y, y) + inline val zzyz get() = Vector4f(z, z, y, z) + inline val zzyw get() = Vector4f(z, z, y, w) + inline val zzzx get() = Vector4f(z, z, z, x) + inline val zzzy get() = Vector4f(z, z, z, y) + inline val zzzz get() = Vector4f(z, z, z, z) + inline val zzzw get() = Vector4f(z, z, z, w) + inline val zzwx get() = Vector4f(z, z, w, x) + inline val zzwy get() = Vector4f(z, z, w, y) + inline val zzwz get() = Vector4f(z, z, w, z) + inline val zzww get() = Vector4f(z, z, w, w) + inline val zwxx get() = Vector4f(z, w, x, x) + inline val zwxy get() = Vector4f(z, w, x, y) + inline val zwxz get() = Vector4f(z, w, x, z) + inline val zwxw get() = Vector4f(z, w, x, w) + inline val zwyx get() = Vector4f(z, w, y, x) + inline val zwyy get() = Vector4f(z, w, y, y) + inline val zwyz get() = Vector4f(z, w, y, z) + inline val zwyw get() = Vector4f(z, w, y, w) + inline val zwzx get() = Vector4f(z, w, z, x) + inline val zwzy get() = Vector4f(z, w, z, y) + inline val zwzz get() = Vector4f(z, w, z, z) + inline val zwzw get() = Vector4f(z, w, z, w) + inline val zwwx get() = Vector4f(z, w, w, x) + inline val zwwy get() = Vector4f(z, w, w, y) + inline val zwwz get() = Vector4f(z, w, w, z) + inline val zwww get() = Vector4f(z, w, w, w) + inline val wxxx get() = Vector4f(w, x, x, x) + inline val wxxy get() = Vector4f(w, x, x, y) + inline val wxxz get() = Vector4f(w, x, x, z) + inline val wxxw get() = Vector4f(w, x, x, w) + inline val wxyx get() = Vector4f(w, x, y, x) + inline val wxyy get() = Vector4f(w, x, y, y) + inline val wxyz get() = Vector4f(w, x, y, z) + inline val wxyw get() = Vector4f(w, x, y, w) + inline val wxzx get() = Vector4f(w, x, z, x) + inline val wxzy get() = Vector4f(w, x, z, y) + inline val wxzz get() = Vector4f(w, x, z, z) + inline val wxzw get() = Vector4f(w, x, z, w) + inline val wxwx get() = Vector4f(w, x, w, x) + inline val wxwy get() = Vector4f(w, x, w, y) + inline val wxwz get() = Vector4f(w, x, w, z) + inline val wxww get() = Vector4f(w, x, w, w) + inline val wyxx get() = Vector4f(w, y, x, x) + inline val wyxy get() = Vector4f(w, y, x, y) + inline val wyxz get() = Vector4f(w, y, x, z) + inline val wyxw get() = Vector4f(w, y, x, w) + inline val wyyx get() = Vector4f(w, y, y, x) + inline val wyyy get() = Vector4f(w, y, y, y) + inline val wyyz get() = Vector4f(w, y, y, z) + inline val wyyw get() = Vector4f(w, y, y, w) + inline val wyzx get() = Vector4f(w, y, z, x) + inline val wyzy get() = Vector4f(w, y, z, y) + inline val wyzz get() = Vector4f(w, y, z, z) + inline val wyzw get() = Vector4f(w, y, z, w) + inline val wywx get() = Vector4f(w, y, w, x) + inline val wywy get() = Vector4f(w, y, w, y) + inline val wywz get() = Vector4f(w, y, w, z) + inline val wyww get() = Vector4f(w, y, w, w) + inline val wzxx get() = Vector4f(w, z, x, x) + inline val wzxy get() = Vector4f(w, z, x, y) + inline val wzxz get() = Vector4f(w, z, x, z) + inline val wzxw get() = Vector4f(w, z, x, w) + inline val wzyx get() = Vector4f(w, z, y, x) + inline val wzyy get() = Vector4f(w, z, y, y) + inline val wzyz get() = Vector4f(w, z, y, z) + inline val wzyw get() = Vector4f(w, z, y, w) + inline val wzzx get() = Vector4f(w, z, z, x) + inline val wzzy get() = Vector4f(w, z, z, y) + inline val wzzz get() = Vector4f(w, z, z, z) + inline val wzzw get() = Vector4f(w, z, z, w) + inline val wzwx get() = Vector4f(w, z, w, x) + inline val wzwy get() = Vector4f(w, z, w, y) + inline val wzwz get() = Vector4f(w, z, w, z) + inline val wzww get() = Vector4f(w, z, w, w) + inline val wwxx get() = Vector4f(w, w, x, x) + inline val wwxy get() = Vector4f(w, w, x, y) + inline val wwxz get() = Vector4f(w, w, x, z) + inline val wwxw get() = Vector4f(w, w, x, w) + inline val wwyx get() = Vector4f(w, w, y, x) + inline val wwyy get() = Vector4f(w, w, y, y) + inline val wwyz get() = Vector4f(w, w, y, z) + inline val wwyw get() = Vector4f(w, w, y, w) + inline val wwzx get() = Vector4f(w, w, z, x) + inline val wwzy get() = Vector4f(w, w, z, y) + inline val wwzz get() = Vector4f(w, w, z, z) + inline val wwzw get() = Vector4f(w, w, z, w) + inline val wwwx get() = Vector4f(w, w, w, x) + inline val wwwy get() = Vector4f(w, w, w, y) + inline val wwwz get() = Vector4f(w, w, w, z) + inline val wwww get() = Vector4f(w, w, w, w) + inline val rr get() = Vector2f(r, r) + inline val rg get() = Vector2f(r, g) + inline val rb get() = Vector2f(r, b) + inline val ra get() = Vector2f(r, a) + inline val gr get() = Vector2f(g, r) + inline val gg get() = Vector2f(g, g) + inline val gb get() = Vector2f(g, b) + inline val ga get() = Vector2f(g, a) + inline val br get() = Vector2f(b, r) + inline val bg get() = Vector2f(b, g) + inline val bb get() = Vector2f(b, b) + inline val ba get() = Vector2f(b, a) + inline val ar get() = Vector2f(a, r) + inline val ag get() = Vector2f(a, g) + inline val ab get() = Vector2f(a, b) + inline val aa get() = Vector2f(a, a) + inline val rrr get() = Vector3f(r, r, r) + inline val rrg get() = Vector3f(r, r, g) + inline val rrb get() = Vector3f(r, r, b) + inline val rra get() = Vector3f(r, r, a) + inline val rgr get() = Vector3f(r, g, r) + inline val rgg get() = Vector3f(r, g, g) + inline val rgb get() = Vector3f(r, g, b) + inline val rga get() = Vector3f(r, g, a) + inline val rbr get() = Vector3f(r, b, r) + inline val rbg get() = Vector3f(r, b, g) + inline val rbb get() = Vector3f(r, b, b) + inline val rba get() = Vector3f(r, b, a) + inline val rar get() = Vector3f(r, a, r) + inline val rag get() = Vector3f(r, a, g) + inline val rab get() = Vector3f(r, a, b) + inline val raa get() = Vector3f(r, a, a) + inline val grr get() = Vector3f(g, r, r) + inline val grg get() = Vector3f(g, r, g) + inline val grb get() = Vector3f(g, r, b) + inline val gra get() = Vector3f(g, r, a) + inline val ggr get() = Vector3f(g, g, r) + inline val ggg get() = Vector3f(g, g, g) + inline val ggb get() = Vector3f(g, g, b) + inline val gga get() = Vector3f(g, g, a) + inline val gbr get() = Vector3f(g, b, r) + inline val gbg get() = Vector3f(g, b, g) + inline val gbb get() = Vector3f(g, b, b) + inline val gba get() = Vector3f(g, b, a) + inline val gar get() = Vector3f(g, a, r) + inline val gag get() = Vector3f(g, a, g) + inline val gab get() = Vector3f(g, a, b) + inline val gaa get() = Vector3f(g, a, a) + inline val brr get() = Vector3f(b, r, r) + inline val brg get() = Vector3f(b, r, g) + inline val brb get() = Vector3f(b, r, b) + inline val bra get() = Vector3f(b, r, a) + inline val bgr get() = Vector3f(b, g, r) + inline val bgg get() = Vector3f(b, g, g) + inline val bgb get() = Vector3f(b, g, b) + inline val bga get() = Vector3f(b, g, a) + inline val bbr get() = Vector3f(b, b, r) + inline val bbg get() = Vector3f(b, b, g) + inline val bbb get() = Vector3f(b, b, b) + inline val bba get() = Vector3f(b, b, a) + inline val bar get() = Vector3f(b, a, r) + inline val bag get() = Vector3f(b, a, g) + inline val bab get() = Vector3f(b, a, b) + inline val baa get() = Vector3f(b, a, a) + inline val arr get() = Vector3f(a, r, r) + inline val arg get() = Vector3f(a, r, g) + inline val arb get() = Vector3f(a, r, b) + inline val ara get() = Vector3f(a, r, a) + inline val agr get() = Vector3f(a, g, r) + inline val agg get() = Vector3f(a, g, g) + inline val agb get() = Vector3f(a, g, b) + inline val aga get() = Vector3f(a, g, a) + inline val abr get() = Vector3f(a, b, r) + inline val abg get() = Vector3f(a, b, g) + inline val abb get() = Vector3f(a, b, b) + inline val aba get() = Vector3f(a, b, a) + inline val aar get() = Vector3f(a, a, r) + inline val aag get() = Vector3f(a, a, g) + inline val aab get() = Vector3f(a, a, b) + inline val aaa get() = Vector3f(a, a, a) + inline val rrrr get() = Vector4f(r, r, r, r) + inline val rrrg get() = Vector4f(r, r, r, g) + inline val rrrb get() = Vector4f(r, r, r, b) + inline val rrra get() = Vector4f(r, r, r, a) + inline val rrgr get() = Vector4f(r, r, g, r) + inline val rrgg get() = Vector4f(r, r, g, g) + inline val rrgb get() = Vector4f(r, r, g, b) + inline val rrga get() = Vector4f(r, r, g, a) + inline val rrbr get() = Vector4f(r, r, b, r) + inline val rrbg get() = Vector4f(r, r, b, g) + inline val rrbb get() = Vector4f(r, r, b, b) + inline val rrba get() = Vector4f(r, r, b, a) + inline val rrar get() = Vector4f(r, r, a, r) + inline val rrag get() = Vector4f(r, r, a, g) + inline val rrab get() = Vector4f(r, r, a, b) + inline val rraa get() = Vector4f(r, r, a, a) + inline val rgrr get() = Vector4f(r, g, r, r) + inline val rgrg get() = Vector4f(r, g, r, g) + inline val rgrb get() = Vector4f(r, g, r, b) + inline val rgra get() = Vector4f(r, g, r, a) + inline val rggr get() = Vector4f(r, g, g, r) + inline val rggg get() = Vector4f(r, g, g, g) + inline val rggb get() = Vector4f(r, g, g, b) + inline val rgga get() = Vector4f(r, g, g, a) + inline val rgbr get() = Vector4f(r, g, b, r) + inline val rgbg get() = Vector4f(r, g, b, g) + inline val rgbb get() = Vector4f(r, g, b, b) + inline val rgba get() = Vector4f(r, g, b, a) + inline val rgar get() = Vector4f(r, g, a, r) + inline val rgag get() = Vector4f(r, g, a, g) + inline val rgab get() = Vector4f(r, g, a, b) + inline val rgaa get() = Vector4f(r, g, a, a) + inline val rbrr get() = Vector4f(r, b, r, r) + inline val rbrg get() = Vector4f(r, b, r, g) + inline val rbrb get() = Vector4f(r, b, r, b) + inline val rbra get() = Vector4f(r, b, r, a) + inline val rbgr get() = Vector4f(r, b, g, r) + inline val rbgg get() = Vector4f(r, b, g, g) + inline val rbgb get() = Vector4f(r, b, g, b) + inline val rbga get() = Vector4f(r, b, g, a) + inline val rbbr get() = Vector4f(r, b, b, r) + inline val rbbg get() = Vector4f(r, b, b, g) + inline val rbbb get() = Vector4f(r, b, b, b) + inline val rbba get() = Vector4f(r, b, b, a) + inline val rbar get() = Vector4f(r, b, a, r) + inline val rbag get() = Vector4f(r, b, a, g) + inline val rbab get() = Vector4f(r, b, a, b) + inline val rbaa get() = Vector4f(r, b, a, a) + inline val rarr get() = Vector4f(r, a, r, r) + inline val rarg get() = Vector4f(r, a, r, g) + inline val rarb get() = Vector4f(r, a, r, b) + inline val rara get() = Vector4f(r, a, r, a) + inline val ragr get() = Vector4f(r, a, g, r) + inline val ragg get() = Vector4f(r, a, g, g) + inline val ragb get() = Vector4f(r, a, g, b) + inline val raga get() = Vector4f(r, a, g, a) + inline val rabr get() = Vector4f(r, a, b, r) + inline val rabg get() = Vector4f(r, a, b, g) + inline val rabb get() = Vector4f(r, a, b, b) + inline val raba get() = Vector4f(r, a, b, a) + inline val raar get() = Vector4f(r, a, a, r) + inline val raag get() = Vector4f(r, a, a, g) + inline val raab get() = Vector4f(r, a, a, b) + inline val raaa get() = Vector4f(r, a, a, a) + inline val grrr get() = Vector4f(g, r, r, r) + inline val grrg get() = Vector4f(g, r, r, g) + inline val grrb get() = Vector4f(g, r, r, b) + inline val grra get() = Vector4f(g, r, r, a) + inline val grgr get() = Vector4f(g, r, g, r) + inline val grgg get() = Vector4f(g, r, g, g) + inline val grgb get() = Vector4f(g, r, g, b) + inline val grga get() = Vector4f(g, r, g, a) + inline val grbr get() = Vector4f(g, r, b, r) + inline val grbg get() = Vector4f(g, r, b, g) + inline val grbb get() = Vector4f(g, r, b, b) + inline val grba get() = Vector4f(g, r, b, a) + inline val grar get() = Vector4f(g, r, a, r) + inline val grag get() = Vector4f(g, r, a, g) + inline val grab get() = Vector4f(g, r, a, b) + inline val graa get() = Vector4f(g, r, a, a) + inline val ggrr get() = Vector4f(g, g, r, r) + inline val ggrg get() = Vector4f(g, g, r, g) + inline val ggrb get() = Vector4f(g, g, r, b) + inline val ggra get() = Vector4f(g, g, r, a) + inline val gggr get() = Vector4f(g, g, g, r) + inline val gggg get() = Vector4f(g, g, g, g) + inline val gggb get() = Vector4f(g, g, g, b) + inline val ggga get() = Vector4f(g, g, g, a) + inline val ggbr get() = Vector4f(g, g, b, r) + inline val ggbg get() = Vector4f(g, g, b, g) + inline val ggbb get() = Vector4f(g, g, b, b) + inline val ggba get() = Vector4f(g, g, b, a) + inline val ggar get() = Vector4f(g, g, a, r) + inline val ggag get() = Vector4f(g, g, a, g) + inline val ggab get() = Vector4f(g, g, a, b) + inline val ggaa get() = Vector4f(g, g, a, a) + inline val gbrr get() = Vector4f(g, b, r, r) + inline val gbrg get() = Vector4f(g, b, r, g) + inline val gbrb get() = Vector4f(g, b, r, b) + inline val gbra get() = Vector4f(g, b, r, a) + inline val gbgr get() = Vector4f(g, b, g, r) + inline val gbgg get() = Vector4f(g, b, g, g) + inline val gbgb get() = Vector4f(g, b, g, b) + inline val gbga get() = Vector4f(g, b, g, a) + inline val gbbr get() = Vector4f(g, b, b, r) + inline val gbbg get() = Vector4f(g, b, b, g) + inline val gbbb get() = Vector4f(g, b, b, b) + inline val gbba get() = Vector4f(g, b, b, a) + inline val gbar get() = Vector4f(g, b, a, r) + inline val gbag get() = Vector4f(g, b, a, g) + inline val gbab get() = Vector4f(g, b, a, b) + inline val gbaa get() = Vector4f(g, b, a, a) + inline val garr get() = Vector4f(g, a, r, r) + inline val garg get() = Vector4f(g, a, r, g) + inline val garb get() = Vector4f(g, a, r, b) + inline val gara get() = Vector4f(g, a, r, a) + inline val gagr get() = Vector4f(g, a, g, r) + inline val gagg get() = Vector4f(g, a, g, g) + inline val gagb get() = Vector4f(g, a, g, b) + inline val gaga get() = Vector4f(g, a, g, a) + inline val gabr get() = Vector4f(g, a, b, r) + inline val gabg get() = Vector4f(g, a, b, g) + inline val gabb get() = Vector4f(g, a, b, b) + inline val gaba get() = Vector4f(g, a, b, a) + inline val gaar get() = Vector4f(g, a, a, r) + inline val gaag get() = Vector4f(g, a, a, g) + inline val gaab get() = Vector4f(g, a, a, b) + inline val gaaa get() = Vector4f(g, a, a, a) + inline val brrr get() = Vector4f(b, r, r, r) + inline val brrg get() = Vector4f(b, r, r, g) + inline val brrb get() = Vector4f(b, r, r, b) + inline val brra get() = Vector4f(b, r, r, a) + inline val brgr get() = Vector4f(b, r, g, r) + inline val brgg get() = Vector4f(b, r, g, g) + inline val brgb get() = Vector4f(b, r, g, b) + inline val brga get() = Vector4f(b, r, g, a) + inline val brbr get() = Vector4f(b, r, b, r) + inline val brbg get() = Vector4f(b, r, b, g) + inline val brbb get() = Vector4f(b, r, b, b) + inline val brba get() = Vector4f(b, r, b, a) + inline val brar get() = Vector4f(b, r, a, r) + inline val brag get() = Vector4f(b, r, a, g) + inline val brab get() = Vector4f(b, r, a, b) + inline val braa get() = Vector4f(b, r, a, a) + inline val bgrr get() = Vector4f(b, g, r, r) + inline val bgrg get() = Vector4f(b, g, r, g) + inline val bgrb get() = Vector4f(b, g, r, b) + inline val bgra get() = Vector4f(b, g, r, a) + inline val bggr get() = Vector4f(b, g, g, r) + inline val bggg get() = Vector4f(b, g, g, g) + inline val bggb get() = Vector4f(b, g, g, b) + inline val bgga get() = Vector4f(b, g, g, a) + inline val bgbr get() = Vector4f(b, g, b, r) + inline val bgbg get() = Vector4f(b, g, b, g) + inline val bgbb get() = Vector4f(b, g, b, b) + inline val bgba get() = Vector4f(b, g, b, a) + inline val bgar get() = Vector4f(b, g, a, r) + inline val bgag get() = Vector4f(b, g, a, g) + inline val bgab get() = Vector4f(b, g, a, b) + inline val bgaa get() = Vector4f(b, g, a, a) + inline val bbrr get() = Vector4f(b, b, r, r) + inline val bbrg get() = Vector4f(b, b, r, g) + inline val bbrb get() = Vector4f(b, b, r, b) + inline val bbra get() = Vector4f(b, b, r, a) + inline val bbgr get() = Vector4f(b, b, g, r) + inline val bbgg get() = Vector4f(b, b, g, g) + inline val bbgb get() = Vector4f(b, b, g, b) + inline val bbga get() = Vector4f(b, b, g, a) + inline val bbbr get() = Vector4f(b, b, b, r) + inline val bbbg get() = Vector4f(b, b, b, g) + inline val bbbb get() = Vector4f(b, b, b, b) + inline val bbba get() = Vector4f(b, b, b, a) + inline val bbar get() = Vector4f(b, b, a, r) + inline val bbag get() = Vector4f(b, b, a, g) + inline val bbab get() = Vector4f(b, b, a, b) + inline val bbaa get() = Vector4f(b, b, a, a) + inline val barr get() = Vector4f(b, a, r, r) + inline val barg get() = Vector4f(b, a, r, g) + inline val barb get() = Vector4f(b, a, r, b) + inline val bara get() = Vector4f(b, a, r, a) + inline val bagr get() = Vector4f(b, a, g, r) + inline val bagg get() = Vector4f(b, a, g, g) + inline val bagb get() = Vector4f(b, a, g, b) + inline val baga get() = Vector4f(b, a, g, a) + inline val babr get() = Vector4f(b, a, b, r) + inline val babg get() = Vector4f(b, a, b, g) + inline val babb get() = Vector4f(b, a, b, b) + inline val baba get() = Vector4f(b, a, b, a) + inline val baar get() = Vector4f(b, a, a, r) + inline val baag get() = Vector4f(b, a, a, g) + inline val baab get() = Vector4f(b, a, a, b) + inline val baaa get() = Vector4f(b, a, a, a) + inline val arrr get() = Vector4f(a, r, r, r) + inline val arrg get() = Vector4f(a, r, r, g) + inline val arrb get() = Vector4f(a, r, r, b) + inline val arra get() = Vector4f(a, r, r, a) + inline val argr get() = Vector4f(a, r, g, r) + inline val argg get() = Vector4f(a, r, g, g) + inline val argb get() = Vector4f(a, r, g, b) + inline val arga get() = Vector4f(a, r, g, a) + inline val arbr get() = Vector4f(a, r, b, r) + inline val arbg get() = Vector4f(a, r, b, g) + inline val arbb get() = Vector4f(a, r, b, b) + inline val arba get() = Vector4f(a, r, b, a) + inline val arar get() = Vector4f(a, r, a, r) + inline val arag get() = Vector4f(a, r, a, g) + inline val arab get() = Vector4f(a, r, a, b) + inline val araa get() = Vector4f(a, r, a, a) + inline val agrr get() = Vector4f(a, g, r, r) + inline val agrg get() = Vector4f(a, g, r, g) + inline val agrb get() = Vector4f(a, g, r, b) + inline val agra get() = Vector4f(a, g, r, a) + inline val aggr get() = Vector4f(a, g, g, r) + inline val aggg get() = Vector4f(a, g, g, g) + inline val aggb get() = Vector4f(a, g, g, b) + inline val agga get() = Vector4f(a, g, g, a) + inline val agbr get() = Vector4f(a, g, b, r) + inline val agbg get() = Vector4f(a, g, b, g) + inline val agbb get() = Vector4f(a, g, b, b) + inline val agba get() = Vector4f(a, g, b, a) + inline val agar get() = Vector4f(a, g, a, r) + inline val agag get() = Vector4f(a, g, a, g) + inline val agab get() = Vector4f(a, g, a, b) + inline val agaa get() = Vector4f(a, g, a, a) + inline val abrr get() = Vector4f(a, b, r, r) + inline val abrg get() = Vector4f(a, b, r, g) + inline val abrb get() = Vector4f(a, b, r, b) + inline val abra get() = Vector4f(a, b, r, a) + inline val abgr get() = Vector4f(a, b, g, r) + inline val abgg get() = Vector4f(a, b, g, g) + inline val abgb get() = Vector4f(a, b, g, b) + inline val abga get() = Vector4f(a, b, g, a) + inline val abbr get() = Vector4f(a, b, b, r) + inline val abbg get() = Vector4f(a, b, b, g) + inline val abbb get() = Vector4f(a, b, b, b) + inline val abba get() = Vector4f(a, b, b, a) + inline val abar get() = Vector4f(a, b, a, r) + inline val abag get() = Vector4f(a, b, a, g) + inline val abab get() = Vector4f(a, b, a, b) + inline val abaa get() = Vector4f(a, b, a, a) + inline val aarr get() = Vector4f(a, a, r, r) + inline val aarg get() = Vector4f(a, a, r, g) + inline val aarb get() = Vector4f(a, a, r, b) + inline val aara get() = Vector4f(a, a, r, a) + inline val aagr get() = Vector4f(a, a, g, r) + inline val aagg get() = Vector4f(a, a, g, g) + inline val aagb get() = Vector4f(a, a, g, b) + inline val aaga get() = Vector4f(a, a, g, a) + inline val aabr get() = Vector4f(a, a, b, r) + inline val aabg get() = Vector4f(a, a, b, g) + inline val aabb get() = Vector4f(a, a, b, b) + inline val aaba get() = Vector4f(a, a, b, a) + inline val aaar get() = Vector4f(a, a, a, r) + inline val aaag get() = Vector4f(a, a, a, g) + inline val aaab get() = Vector4f(a, a, a, b) + inline val aaaa get() = Vector4f(a, a, a, a) + inline val ss get() = Vector2f(s, s) + inline val st get() = Vector2f(s, t) + inline val sp get() = Vector2f(s, p) + inline val sq get() = Vector2f(s, q) + inline val ts get() = Vector2f(t, s) + inline val tt get() = Vector2f(t, t) + inline val tp get() = Vector2f(t, p) + inline val tq get() = Vector2f(t, q) + inline val ps get() = Vector2f(p, s) + inline val pt get() = Vector2f(p, t) + inline val pp get() = Vector2f(p, p) + inline val pq get() = Vector2f(p, q) + inline val qs get() = Vector2f(q, s) + inline val qt get() = Vector2f(q, t) + inline val qp get() = Vector2f(q, p) + inline val qq get() = Vector2f(q, q) + inline val sss get() = Vector3f(s, s, s) + inline val sst get() = Vector3f(s, s, t) + inline val ssp get() = Vector3f(s, s, p) + inline val ssq get() = Vector3f(s, s, q) + inline val sts get() = Vector3f(s, t, s) + inline val stt get() = Vector3f(s, t, t) + inline val stp get() = Vector3f(s, t, p) + inline val stq get() = Vector3f(s, t, q) + inline val sps get() = Vector3f(s, p, s) + inline val spt get() = Vector3f(s, p, t) + inline val spp get() = Vector3f(s, p, p) + inline val spq get() = Vector3f(s, p, q) + inline val sqs get() = Vector3f(s, q, s) + inline val sqt get() = Vector3f(s, q, t) + inline val sqp get() = Vector3f(s, q, p) + inline val sqq get() = Vector3f(s, q, q) + inline val tss get() = Vector3f(t, s, s) + inline val tst get() = Vector3f(t, s, t) + inline val tsp get() = Vector3f(t, s, p) + inline val tsq get() = Vector3f(t, s, q) + inline val tts get() = Vector3f(t, t, s) + inline val ttt get() = Vector3f(t, t, t) + inline val ttp get() = Vector3f(t, t, p) + inline val ttq get() = Vector3f(t, t, q) + inline val tps get() = Vector3f(t, p, s) + inline val tpt get() = Vector3f(t, p, t) + inline val tpp get() = Vector3f(t, p, p) + inline val tpq get() = Vector3f(t, p, q) + inline val tqs get() = Vector3f(t, q, s) + inline val tqt get() = Vector3f(t, q, t) + inline val tqp get() = Vector3f(t, q, p) + inline val tqq get() = Vector3f(t, q, q) + inline val pss get() = Vector3f(p, s, s) + inline val pst get() = Vector3f(p, s, t) + inline val psp get() = Vector3f(p, s, p) + inline val psq get() = Vector3f(p, s, q) + inline val pts get() = Vector3f(p, t, s) + inline val ptt get() = Vector3f(p, t, t) + inline val ptp get() = Vector3f(p, t, p) + inline val ptq get() = Vector3f(p, t, q) + inline val pps get() = Vector3f(p, p, s) + inline val ppt get() = Vector3f(p, p, t) + inline val ppp get() = Vector3f(p, p, p) + inline val ppq get() = Vector3f(p, p, q) + inline val pqs get() = Vector3f(p, q, s) + inline val pqt get() = Vector3f(p, q, t) + inline val pqp get() = Vector3f(p, q, p) + inline val pqq get() = Vector3f(p, q, q) + inline val qss get() = Vector3f(q, s, s) + inline val qst get() = Vector3f(q, s, t) + inline val qsp get() = Vector3f(q, s, p) + inline val qsq get() = Vector3f(q, s, q) + inline val qts get() = Vector3f(q, t, s) + inline val qtt get() = Vector3f(q, t, t) + inline val qtp get() = Vector3f(q, t, p) + inline val qtq get() = Vector3f(q, t, q) + inline val qps get() = Vector3f(q, p, s) + inline val qpt get() = Vector3f(q, p, t) + inline val qpp get() = Vector3f(q, p, p) + inline val qpq get() = Vector3f(q, p, q) + inline val qqs get() = Vector3f(q, q, s) + inline val qqt get() = Vector3f(q, q, t) + inline val qqp get() = Vector3f(q, q, p) + inline val qqq get() = Vector3f(q, q, q) + inline val ssss get() = Vector4f(s, s, s, s) + inline val ssst get() = Vector4f(s, s, s, t) + inline val sssp get() = Vector4f(s, s, s, p) + inline val sssq get() = Vector4f(s, s, s, q) + inline val ssts get() = Vector4f(s, s, t, s) + inline val sstt get() = Vector4f(s, s, t, t) + inline val sstp get() = Vector4f(s, s, t, p) + inline val sstq get() = Vector4f(s, s, t, q) + inline val ssps get() = Vector4f(s, s, p, s) + inline val sspt get() = Vector4f(s, s, p, t) + inline val sspp get() = Vector4f(s, s, p, p) + inline val sspq get() = Vector4f(s, s, p, q) + inline val ssqs get() = Vector4f(s, s, q, s) + inline val ssqt get() = Vector4f(s, s, q, t) + inline val ssqp get() = Vector4f(s, s, q, p) + inline val ssqq get() = Vector4f(s, s, q, q) + inline val stss get() = Vector4f(s, t, s, s) + inline val stst get() = Vector4f(s, t, s, t) + inline val stsp get() = Vector4f(s, t, s, p) + inline val stsq get() = Vector4f(s, t, s, q) + inline val stts get() = Vector4f(s, t, t, s) + inline val sttt get() = Vector4f(s, t, t, t) + inline val sttp get() = Vector4f(s, t, t, p) + inline val sttq get() = Vector4f(s, t, t, q) + inline val stps get() = Vector4f(s, t, p, s) + inline val stpt get() = Vector4f(s, t, p, t) + inline val stpp get() = Vector4f(s, t, p, p) + inline val stpq get() = Vector4f(s, t, p, q) + inline val stqs get() = Vector4f(s, t, q, s) + inline val stqt get() = Vector4f(s, t, q, t) + inline val stqp get() = Vector4f(s, t, q, p) + inline val stqq get() = Vector4f(s, t, q, q) + inline val spss get() = Vector4f(s, p, s, s) + inline val spst get() = Vector4f(s, p, s, t) + inline val spsp get() = Vector4f(s, p, s, p) + inline val spsq get() = Vector4f(s, p, s, q) + inline val spts get() = Vector4f(s, p, t, s) + inline val sptt get() = Vector4f(s, p, t, t) + inline val sptp get() = Vector4f(s, p, t, p) + inline val sptq get() = Vector4f(s, p, t, q) + inline val spps get() = Vector4f(s, p, p, s) + inline val sppt get() = Vector4f(s, p, p, t) + inline val sppp get() = Vector4f(s, p, p, p) + inline val sppq get() = Vector4f(s, p, p, q) + inline val spqs get() = Vector4f(s, p, q, s) + inline val spqt get() = Vector4f(s, p, q, t) + inline val spqp get() = Vector4f(s, p, q, p) + inline val spqq get() = Vector4f(s, p, q, q) + inline val sqss get() = Vector4f(s, q, s, s) + inline val sqst get() = Vector4f(s, q, s, t) + inline val sqsp get() = Vector4f(s, q, s, p) + inline val sqsq get() = Vector4f(s, q, s, q) + inline val sqts get() = Vector4f(s, q, t, s) + inline val sqtt get() = Vector4f(s, q, t, t) + inline val sqtp get() = Vector4f(s, q, t, p) + inline val sqtq get() = Vector4f(s, q, t, q) + inline val sqps get() = Vector4f(s, q, p, s) + inline val sqpt get() = Vector4f(s, q, p, t) + inline val sqpp get() = Vector4f(s, q, p, p) + inline val sqpq get() = Vector4f(s, q, p, q) + inline val sqqs get() = Vector4f(s, q, q, s) + inline val sqqt get() = Vector4f(s, q, q, t) + inline val sqqp get() = Vector4f(s, q, q, p) + inline val sqqq get() = Vector4f(s, q, q, q) + inline val tsss get() = Vector4f(t, s, s, s) + inline val tsst get() = Vector4f(t, s, s, t) + inline val tssp get() = Vector4f(t, s, s, p) + inline val tssq get() = Vector4f(t, s, s, q) + inline val tsts get() = Vector4f(t, s, t, s) + inline val tstt get() = Vector4f(t, s, t, t) + inline val tstp get() = Vector4f(t, s, t, p) + inline val tstq get() = Vector4f(t, s, t, q) + inline val tsps get() = Vector4f(t, s, p, s) + inline val tspt get() = Vector4f(t, s, p, t) + inline val tspp get() = Vector4f(t, s, p, p) + inline val tspq get() = Vector4f(t, s, p, q) + inline val tsqs get() = Vector4f(t, s, q, s) + inline val tsqt get() = Vector4f(t, s, q, t) + inline val tsqp get() = Vector4f(t, s, q, p) + inline val tsqq get() = Vector4f(t, s, q, q) + inline val ttss get() = Vector4f(t, t, s, s) + inline val ttst get() = Vector4f(t, t, s, t) + inline val ttsp get() = Vector4f(t, t, s, p) + inline val ttsq get() = Vector4f(t, t, s, q) + inline val ttts get() = Vector4f(t, t, t, s) + inline val tttt get() = Vector4f(t, t, t, t) + inline val tttp get() = Vector4f(t, t, t, p) + inline val tttq get() = Vector4f(t, t, t, q) + inline val ttps get() = Vector4f(t, t, p, s) + inline val ttpt get() = Vector4f(t, t, p, t) + inline val ttpp get() = Vector4f(t, t, p, p) + inline val ttpq get() = Vector4f(t, t, p, q) + inline val ttqs get() = Vector4f(t, t, q, s) + inline val ttqt get() = Vector4f(t, t, q, t) + inline val ttqp get() = Vector4f(t, t, q, p) + inline val ttqq get() = Vector4f(t, t, q, q) + inline val tpss get() = Vector4f(t, p, s, s) + inline val tpst get() = Vector4f(t, p, s, t) + inline val tpsp get() = Vector4f(t, p, s, p) + inline val tpsq get() = Vector4f(t, p, s, q) + inline val tpts get() = Vector4f(t, p, t, s) + inline val tptt get() = Vector4f(t, p, t, t) + inline val tptp get() = Vector4f(t, p, t, p) + inline val tptq get() = Vector4f(t, p, t, q) + inline val tpps get() = Vector4f(t, p, p, s) + inline val tppt get() = Vector4f(t, p, p, t) + inline val tppp get() = Vector4f(t, p, p, p) + inline val tppq get() = Vector4f(t, p, p, q) + inline val tpqs get() = Vector4f(t, p, q, s) + inline val tpqt get() = Vector4f(t, p, q, t) + inline val tpqp get() = Vector4f(t, p, q, p) + inline val tpqq get() = Vector4f(t, p, q, q) + inline val tqss get() = Vector4f(t, q, s, s) + inline val tqst get() = Vector4f(t, q, s, t) + inline val tqsp get() = Vector4f(t, q, s, p) + inline val tqsq get() = Vector4f(t, q, s, q) + inline val tqts get() = Vector4f(t, q, t, s) + inline val tqtt get() = Vector4f(t, q, t, t) + inline val tqtp get() = Vector4f(t, q, t, p) + inline val tqtq get() = Vector4f(t, q, t, q) + inline val tqps get() = Vector4f(t, q, p, s) + inline val tqpt get() = Vector4f(t, q, p, t) + inline val tqpp get() = Vector4f(t, q, p, p) + inline val tqpq get() = Vector4f(t, q, p, q) + inline val tqqs get() = Vector4f(t, q, q, s) + inline val tqqt get() = Vector4f(t, q, q, t) + inline val tqqp get() = Vector4f(t, q, q, p) + inline val tqqq get() = Vector4f(t, q, q, q) + inline val psss get() = Vector4f(p, s, s, s) + inline val psst get() = Vector4f(p, s, s, t) + inline val pssp get() = Vector4f(p, s, s, p) + inline val pssq get() = Vector4f(p, s, s, q) + inline val psts get() = Vector4f(p, s, t, s) + inline val pstt get() = Vector4f(p, s, t, t) + inline val pstp get() = Vector4f(p, s, t, p) + inline val pstq get() = Vector4f(p, s, t, q) + inline val psps get() = Vector4f(p, s, p, s) + inline val pspt get() = Vector4f(p, s, p, t) + inline val pspp get() = Vector4f(p, s, p, p) + inline val pspq get() = Vector4f(p, s, p, q) + inline val psqs get() = Vector4f(p, s, q, s) + inline val psqt get() = Vector4f(p, s, q, t) + inline val psqp get() = Vector4f(p, s, q, p) + inline val psqq get() = Vector4f(p, s, q, q) + inline val ptss get() = Vector4f(p, t, s, s) + inline val ptst get() = Vector4f(p, t, s, t) + inline val ptsp get() = Vector4f(p, t, s, p) + inline val ptsq get() = Vector4f(p, t, s, q) + inline val ptts get() = Vector4f(p, t, t, s) + inline val pttt get() = Vector4f(p, t, t, t) + inline val pttp get() = Vector4f(p, t, t, p) + inline val pttq get() = Vector4f(p, t, t, q) + inline val ptps get() = Vector4f(p, t, p, s) + inline val ptpt get() = Vector4f(p, t, p, t) + inline val ptpp get() = Vector4f(p, t, p, p) + inline val ptpq get() = Vector4f(p, t, p, q) + inline val ptqs get() = Vector4f(p, t, q, s) + inline val ptqt get() = Vector4f(p, t, q, t) + inline val ptqp get() = Vector4f(p, t, q, p) + inline val ptqq get() = Vector4f(p, t, q, q) + inline val ppss get() = Vector4f(p, p, s, s) + inline val ppst get() = Vector4f(p, p, s, t) + inline val ppsp get() = Vector4f(p, p, s, p) + inline val ppsq get() = Vector4f(p, p, s, q) + inline val ppts get() = Vector4f(p, p, t, s) + inline val pptt get() = Vector4f(p, p, t, t) + inline val pptp get() = Vector4f(p, p, t, p) + inline val pptq get() = Vector4f(p, p, t, q) + inline val ppps get() = Vector4f(p, p, p, s) + inline val pppt get() = Vector4f(p, p, p, t) + inline val pppp get() = Vector4f(p, p, p, p) + inline val pppq get() = Vector4f(p, p, p, q) + inline val ppqs get() = Vector4f(p, p, q, s) + inline val ppqt get() = Vector4f(p, p, q, t) + inline val ppqp get() = Vector4f(p, p, q, p) + inline val ppqq get() = Vector4f(p, p, q, q) + inline val pqss get() = Vector4f(p, q, s, s) + inline val pqst get() = Vector4f(p, q, s, t) + inline val pqsp get() = Vector4f(p, q, s, p) + inline val pqsq get() = Vector4f(p, q, s, q) + inline val pqts get() = Vector4f(p, q, t, s) + inline val pqtt get() = Vector4f(p, q, t, t) + inline val pqtp get() = Vector4f(p, q, t, p) + inline val pqtq get() = Vector4f(p, q, t, q) + inline val pqps get() = Vector4f(p, q, p, s) + inline val pqpt get() = Vector4f(p, q, p, t) + inline val pqpp get() = Vector4f(p, q, p, p) + inline val pqpq get() = Vector4f(p, q, p, q) + inline val pqqs get() = Vector4f(p, q, q, s) + inline val pqqt get() = Vector4f(p, q, q, t) + inline val pqqp get() = Vector4f(p, q, q, p) + inline val pqqq get() = Vector4f(p, q, q, q) + inline val qsss get() = Vector4f(q, s, s, s) + inline val qsst get() = Vector4f(q, s, s, t) + inline val qssp get() = Vector4f(q, s, s, p) + inline val qssq get() = Vector4f(q, s, s, q) + inline val qsts get() = Vector4f(q, s, t, s) + inline val qstt get() = Vector4f(q, s, t, t) + inline val qstp get() = Vector4f(q, s, t, p) + inline val qstq get() = Vector4f(q, s, t, q) + inline val qsps get() = Vector4f(q, s, p, s) + inline val qspt get() = Vector4f(q, s, p, t) + inline val qspp get() = Vector4f(q, s, p, p) + inline val qspq get() = Vector4f(q, s, p, q) + inline val qsqs get() = Vector4f(q, s, q, s) + inline val qsqt get() = Vector4f(q, s, q, t) + inline val qsqp get() = Vector4f(q, s, q, p) + inline val qsqq get() = Vector4f(q, s, q, q) + inline val qtss get() = Vector4f(q, t, s, s) + inline val qtst get() = Vector4f(q, t, s, t) + inline val qtsp get() = Vector4f(q, t, s, p) + inline val qtsq get() = Vector4f(q, t, s, q) + inline val qtts get() = Vector4f(q, t, t, s) + inline val qttt get() = Vector4f(q, t, t, t) + inline val qttp get() = Vector4f(q, t, t, p) + inline val qttq get() = Vector4f(q, t, t, q) + inline val qtps get() = Vector4f(q, t, p, s) + inline val qtpt get() = Vector4f(q, t, p, t) + inline val qtpp get() = Vector4f(q, t, p, p) + inline val qtpq get() = Vector4f(q, t, p, q) + inline val qtqs get() = Vector4f(q, t, q, s) + inline val qtqt get() = Vector4f(q, t, q, t) + inline val qtqp get() = Vector4f(q, t, q, p) + inline val qtqq get() = Vector4f(q, t, q, q) + inline val qpss get() = Vector4f(q, p, s, s) + inline val qpst get() = Vector4f(q, p, s, t) + inline val qpsp get() = Vector4f(q, p, s, p) + inline val qpsq get() = Vector4f(q, p, s, q) + inline val qpts get() = Vector4f(q, p, t, s) + inline val qptt get() = Vector4f(q, p, t, t) + inline val qptp get() = Vector4f(q, p, t, p) + inline val qptq get() = Vector4f(q, p, t, q) + inline val qpps get() = Vector4f(q, p, p, s) + inline val qppt get() = Vector4f(q, p, p, t) + inline val qppp get() = Vector4f(q, p, p, p) + inline val qppq get() = Vector4f(q, p, p, q) + inline val qpqs get() = Vector4f(q, p, q, s) + inline val qpqt get() = Vector4f(q, p, q, t) + inline val qpqp get() = Vector4f(q, p, q, p) + inline val qpqq get() = Vector4f(q, p, q, q) + inline val qqss get() = Vector4f(q, q, s, s) + inline val qqst get() = Vector4f(q, q, s, t) + inline val qqsp get() = Vector4f(q, q, s, p) + inline val qqsq get() = Vector4f(q, q, s, q) + inline val qqts get() = Vector4f(q, q, t, s) + inline val qqtt get() = Vector4f(q, q, t, t) + inline val qqtp get() = Vector4f(q, q, t, p) + inline val qqtq get() = Vector4f(q, q, t, q) + inline val qqps get() = Vector4f(q, q, p, s) + inline val qqpt get() = Vector4f(q, q, p, t) + inline val qqpp get() = Vector4f(q, q, p, p) + inline val qqpq get() = Vector4f(q, q, p, q) + inline val qqqs get() = Vector4f(q, q, q, s) + inline val qqqt get() = Vector4f(q, q, q, t) + inline val qqqp get() = Vector4f(q, q, q, p) + inline val qqqq get() = Vector4f(q, q, q, q) + + companion object { + @JvmField val ZERO = Vector4f() + @JvmField val POSITIVE_X = Vector4f(x = 1f) + @JvmField val NEGATIVE_X = Vector4f(x = -1f) + @JvmField val POSITIVE_Y = Vector4f(y = 1f) + @JvmField val NEGATIVE_Y = Vector4f(y = -1f) + @JvmField val POSITIVE_Z = Vector4f(z = 1f) + @JvmField val NEGATIVE_Z = Vector4f(z = -1f) + @JvmField val POSITIVE_W = Vector4f(w = 1f) + @JvmField val NEGATIVE_W = Vector4f(w = -1f) + } +} + +operator fun Float.times(other: Vector4f): Vector4f { + return Vector4f(this * other.x, this * other.y, this * other.z, this * other.w) +} + +operator fun Float.div(other: Vector4f): Vector4f { + return Vector4f(this / other.x, this / other.y, this / other.z, this / other.w) +} + +/** + * Mutable 4D Vector, representing four-dimensional coordinates as [Float]s + * + * It can be safely passed around to methods which expect immutable [Vector4f], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector4f( + override var x: Float = 0f, + override var y: Float = 0f, + override var z: Float = 0f, + override var w: Float = 0f, +) : Vector4f(x, y), IMutableFloatVector, IMutableFractionalVector, IMutableVector, IMatrixSetterFloat { + constructor(input: IStruct2f, z: Float = 0f, w: Float = 0f) : this(input.component1(), input.component2(), z, w) + constructor(x: Float, input: IStruct2f, w: Float = 0f) : this(x, input.component1(), input.component2(), w) + constructor(x: Float, y: Float, input: IStruct2f) : this(x, y, input.component1(), input.component2()) + + constructor(input: IStruct3f, w: Float = 0f) : this(input.component1(), input.component2(), input.component3(), w) + constructor(x: Float, input: IStruct3f) : this(x, input.component1(), input.component2(), input.component3()) + constructor(input: IStruct4f) : this(input.component1(), input.component2(), input.component3(), input.component4()) + + override fun set(column: Int, row: Int, value: Float) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + 2 -> z = value + 3 -> w = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + override var b by this::z + override var a by this::w + + override var s by this::x + override var t by this::y + override var p by this::z + override var q by this::w + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector4f + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + if (w != other.w) return false + + return true + } + + override fun normalize(): Double { + val len = length + + if (len == 0.0) { + return 0.0 + } + + x = (x / len).toFloat() + y = (y / len).toFloat() + z = (z / len).toFloat() + w = (w / len).toFloat() + + return len + } + + override fun plusMut(other: Vector4f): MutableVector4f { + x += other.x + y += other.y + z += other.z + w += other.w + return this + } + + override fun minusMut(other: Vector4f): MutableVector4f { + x -= other.x + y -= other.y + z -= other.z + w -= other.w + return this + } + + override fun timesMut(other: Vector4f): MutableVector4f { + x *= other.x + y *= other.y + z *= other.z + w *= other.w + return this + } + + override fun divMut(other: Vector4f): MutableVector4f { + x /= other.x + y /= other.y + z /= other.z + return this + } + + override fun timesMut(other: Float): MutableVector4f { + x *= other + y *= other + z *= other + w *= other + return this + } + + override fun divMut(other: Float): MutableVector4f { + x /= other + y /= other + z /= other + w /= other + return this + } +} \ No newline at end of file diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector2i.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector2i.kt new file mode 100644 index 00000000..3813ed80 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector2i.kt @@ -0,0 +1,331 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.nint + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 2D Vector, representing two-dimensional coordinates as [Int]s + */ +open class Vector2i( + open val x: Int = 0, + open val y: Int = 0, +) : AbstractVector(), IWholeVector, IIntVector, IStruct2i, IMatrixGetterInt { + constructor(input: IStruct2i) : this(input.component1(), input.component2()) + + final override fun get(column: Int, row: Int): Int { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + final override val rows: Int = 2 + + final override fun component1() = x + final override fun component2() = y + + open val r by this::x + open val g by this::y + + open val s by this::x + open val t by this::y + + final override val lengthSquared: Double + get() = (x.toLong() * x.toLong() + y.toLong() * y.toLong()).toDouble() + final override val isFinite: Boolean = true + final override val isNaN: Boolean = false + + override fun plus(other: Vector2i): Vector2i { + return Vector2i( + x + other.x, + y + other.y, + ) + } + + override fun minus(other: Vector2i): Vector2i { + return Vector2i( + x - other.x, + y - other.y, + ) + } + + override fun times(other: Vector2i): Vector2i { + return Vector2i( + x * other.x, + y * other.y, + ) + } + + override fun div(other: Vector2i): Vector2i { + return Vector2i( + x / other.x, + y / other.y, + ) + } + + override val absoluteValue: Vector2i + get() = Vector2i(x.absoluteValue, y.absoluteValue) + + override fun coerceAtMost(maximal: Vector2i): Vector2i { + return Vector2i( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + ) + } + + override fun coerceAtLeast(minimal: Vector2i): Vector2i { + return Vector2i( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + ) + } + + override fun clamp(minimal: Vector2i, maximal: Vector2i): Vector2i { + return Vector2i( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + ) + } + + override fun unaryMinus(): Vector2i { + return Vector2i(-x, -y) + } + + override fun distanceSquared(other: Vector2i): Double { + val x = x.toDouble() - other.x.toDouble() + val y = y.toDouble() - other.y.toDouble() + + return x * x + y * y + } + + override fun wholeDistanceSquared(other: Vector2i): Long { + val x = x.toLong() - other.x.toLong() + val y = y.toLong() - other.y.toLong() + + return x * x + y * y + } + + override fun times(other: Int): Vector2i { + return Vector2i( + x * other, + y * other, + ) + } + + override fun div(other: Int): Vector2i { + return Vector2i( + x / other, + y / other, + ) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector2i + + if (x != other.x) return false + if (y != other.y) return false + + return true + } + + override fun hashCode(): Int { + var result = x + result = 31 * result + y + return result + } + + override fun toString(): String { + return "[${x}i ${y}i]" + } + + inline val xx get() = Vector2i(x, x) + inline val xy get() = Vector2i(x, y) + inline val yx get() = Vector2i(y, x) + inline val yy get() = Vector2i(y, y) + inline val xxx get() = Vector3i(x, x, x) + inline val xxy get() = Vector3i(x, x, y) + inline val xyx get() = Vector3i(x, y, x) + inline val xyy get() = Vector3i(x, y, y) + inline val yxx get() = Vector3i(y, x, x) + inline val yxy get() = Vector3i(y, x, y) + inline val yyx get() = Vector3i(y, y, x) + inline val yyy get() = Vector3i(y, y, y) + inline val xxxx get() = Vector4i(x, x, x, x) + inline val xxxy get() = Vector4i(x, x, x, y) + inline val xxyx get() = Vector4i(x, x, y, x) + inline val xxyy get() = Vector4i(x, x, y, y) + inline val xyxx get() = Vector4i(x, y, x, x) + inline val xyxy get() = Vector4i(x, y, x, y) + inline val xyyx get() = Vector4i(x, y, y, x) + inline val xyyy get() = Vector4i(x, y, y, y) + inline val yxxx get() = Vector4i(y, x, x, x) + inline val yxxy get() = Vector4i(y, x, x, y) + inline val yxyx get() = Vector4i(y, x, y, x) + inline val yxyy get() = Vector4i(y, x, y, y) + inline val yyxx get() = Vector4i(y, y, x, x) + inline val yyxy get() = Vector4i(y, y, x, y) + inline val yyyx get() = Vector4i(y, y, y, x) + inline val yyyy get() = Vector4i(y, y, y, y) + inline val rr get() = Vector2i(r, r) + inline val rg get() = Vector2i(r, g) + inline val gr get() = Vector2i(g, r) + inline val gg get() = Vector2i(g, g) + inline val rrr get() = Vector3i(r, r, r) + inline val rrg get() = Vector3i(r, r, g) + inline val rgr get() = Vector3i(r, g, r) + inline val rgg get() = Vector3i(r, g, g) + inline val grr get() = Vector3i(g, r, r) + inline val grg get() = Vector3i(g, r, g) + inline val ggr get() = Vector3i(g, g, r) + inline val ggg get() = Vector3i(g, g, g) + inline val rrrr get() = Vector4i(r, r, r, r) + inline val rrrg get() = Vector4i(r, r, r, g) + inline val rrgr get() = Vector4i(r, r, g, r) + inline val rrgg get() = Vector4i(r, r, g, g) + inline val rgrr get() = Vector4i(r, g, r, r) + inline val rgrg get() = Vector4i(r, g, r, g) + inline val rggr get() = Vector4i(r, g, g, r) + inline val rggg get() = Vector4i(r, g, g, g) + inline val grrr get() = Vector4i(g, r, r, r) + inline val grrg get() = Vector4i(g, r, r, g) + inline val grgr get() = Vector4i(g, r, g, r) + inline val grgg get() = Vector4i(g, r, g, g) + inline val ggrr get() = Vector4i(g, g, r, r) + inline val ggrg get() = Vector4i(g, g, r, g) + inline val gggr get() = Vector4i(g, g, g, r) + inline val gggg get() = Vector4i(g, g, g, g) + inline val ss get() = Vector2i(s, s) + inline val st get() = Vector2i(s, t) + inline val ts get() = Vector2i(t, s) + inline val tt get() = Vector2i(t, t) + inline val sss get() = Vector3i(s, s, s) + inline val sst get() = Vector3i(s, s, t) + inline val sts get() = Vector3i(s, t, s) + inline val stt get() = Vector3i(s, t, t) + inline val tss get() = Vector3i(t, s, s) + inline val tst get() = Vector3i(t, s, t) + inline val tts get() = Vector3i(t, t, s) + inline val ttt get() = Vector3i(t, t, t) + inline val ssss get() = Vector4i(s, s, s, s) + inline val ssst get() = Vector4i(s, s, s, t) + inline val ssts get() = Vector4i(s, s, t, s) + inline val sstt get() = Vector4i(s, s, t, t) + inline val stss get() = Vector4i(s, t, s, s) + inline val stst get() = Vector4i(s, t, s, t) + inline val stts get() = Vector4i(s, t, t, s) + inline val sttt get() = Vector4i(s, t, t, t) + inline val tsss get() = Vector4i(t, s, s, s) + inline val tsst get() = Vector4i(t, s, s, t) + inline val tsts get() = Vector4i(t, s, t, s) + inline val tstt get() = Vector4i(t, s, t, t) + inline val ttss get() = Vector4i(t, t, s, s) + inline val ttst get() = Vector4i(t, t, s, t) + inline val ttts get() = Vector4i(t, t, t, s) + inline val tttt get() = Vector4i(t, t, t, t) + + companion object { + @JvmField val ZERO = Vector2i() + @JvmField val POSITIVE_X = Vector2i(x = 1) + @JvmField val NEGATIVE_X = Vector2i(x = -1) + @JvmField val POSITIVE_Y = Vector2i(y = 1) + @JvmField val NEGATIVE_Y = Vector2i(y = -1) + } +} + +operator fun Int.times(other: Vector2i): Vector2i { + return Vector2i(this * other.x, this * other.y) +} + +operator fun Int.div(other: Vector2i): Vector2i { + return Vector2i(this / other.x, this / other.y) +} + +/** + * Mutable 2D Vector, representing two-dimensional coordinates as [Int]s + * + * It can be safely passed around to methods which expect immutable [Vector2i], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector2i( + override var x: Int = 0, + override var y: Int = 0, +) : Vector2i(x, y), IMutableIntVector, IMutableWholeVector, IMutableVector, IMatrixSetterInt { + constructor(input: IStruct2i) : this(input.component1(), input.component2()) + + override fun set(column: Int, row: Int, value: Int) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + + override var s by this::x + override var t by this::y + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector2i + + if (x != other.x) return false + if (y != other.y) return false + + return true + } + + override fun plusMut(other: Vector2i): MutableVector2i { + x += other.x + y += other.y + return this + } + + override fun minusMut(other: Vector2i): MutableVector2i { + x -= other.x + y -= other.y + return this + } + + override fun timesMut(other: Vector2i): MutableVector2i { + x *= other.x + y *= other.y + return this + } + + override fun divMut(other: Vector2i): MutableVector2i { + x /= other.x + y /= other.y + return this + } + + override fun timesMut(other: Int): MutableVector2i { + x *= other + y *= other + return this + } + + override fun divMut(other: Int): MutableVector2i { + x /= other + y /= other + return this + } +} diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector3i.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector3i.kt new file mode 100644 index 00000000..9b5bc575 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector3i.kt @@ -0,0 +1,632 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.nint + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 3D Vector, representing three-dimensional coordinates as [Int]s + */ +open class Vector3i( + open val x: Int = 0, + open val y: Int = 0, + open val z: Int = 0, +) : AbstractVector(), IWholeVector, IIntVector, IStruct3i, IMatrixGetterInt { + constructor(input: IStruct2i, z: Int = 0) : this(input.component1(), input.component2(), z) + constructor(x: Int, input: IStruct2i) : this(x, input.component1(), input.component2()) + constructor(input: IStruct3i) : this(input.component1(), input.component2(), input.component3()) + + override fun get(column: Int, row: Int): Int { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + 2 -> z + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + final override val rows: Int = 3 + + final override fun component1() = x + final override fun component2() = y + final override fun component3() = z + + open val r by this::x + open val g by this::y + open val b by this::z + + open val s by this::x + open val t by this::y + open val p by this::z + + final override val lengthSquared: Double + get() = (x.toLong() * x.toLong() + y.toLong() * y.toLong() + z.toLong() * z.toLong()).toDouble() + final override val isFinite: Boolean = true + final override val isNaN: Boolean = false + + override fun plus(other: Vector3i): Vector3i { + return Vector3i( + x + other.x, + y + other.y, + z + other.z, + ) + } + + override fun minus(other: Vector3i): Vector3i { + return Vector3i( + x - other.x, + y - other.y, + z - other.z, + ) + } + + override fun times(other: Vector3i): Vector3i { + return Vector3i( + x * other.x, + y * other.y, + z * other.z, + ) + } + + override fun div(other: Vector3i): Vector3i { + return Vector3i( + x / other.x, + y / other.y, + z / other.z, + ) + } + + override val absoluteValue: Vector3i + get() = Vector3i(x.absoluteValue, y.absoluteValue, z.absoluteValue) + + override fun coerceAtMost(maximal: Vector3i): Vector3i { + return Vector3i( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + z.coerceAtMost(maximal.z), + ) + } + + override fun coerceAtLeast(minimal: Vector3i): Vector3i { + return Vector3i( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + z.coerceAtLeast(minimal.z), + ) + } + + override fun clamp(minimal: Vector3i, maximal: Vector3i): Vector3i { + return Vector3i( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + z.coerceAtLeast(minimal.z).coerceAtMost(maximal.z), + ) + } + + override fun unaryMinus(): Vector3i { + return Vector3i(-x, -y, -z) + } + + override fun distanceSquared(other: Vector3i): Double { + val x = x.toDouble() - other.x.toDouble() + val y = y.toDouble() - other.y.toDouble() + val z = z.toDouble() - other.z.toDouble() + + return x * x + y * y + z * z + } + + override fun wholeDistanceSquared(other: Vector3i): Long { + val x = x.toLong() - other.x.toLong() + val y = y.toLong() - other.y.toLong() + val z = z.toLong() - other.z.toLong() + + return x * x + y * y + z * z + } + + override fun times(other: Int): Vector3i { + return Vector3i( + x * other, + y * other, + z * other, + ) + } + + override fun div(other: Int): Vector3i { + return Vector3i( + x / other, + y / other, + z / other, + ) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector3i + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + + return true + } + + override fun hashCode(): Int { + var result = x + result = 31 * result + y + result = 31 * result + z + return result + } + + override fun toString(): String { + return "[${x}i ${y}i ${z}i]" + } + inline val xx get() = Vector2i(x, x) + inline val xy get() = Vector2i(x, y) + inline val xz get() = Vector2i(x, z) + inline val yx get() = Vector2i(y, x) + inline val yy get() = Vector2i(y, y) + inline val yz get() = Vector2i(y, z) + inline val zx get() = Vector2i(z, x) + inline val zy get() = Vector2i(z, y) + inline val zz get() = Vector2i(z, z) + inline val xxx get() = Vector3i(x, x, x) + inline val xxy get() = Vector3i(x, x, y) + inline val xxz get() = Vector3i(x, x, z) + inline val xyx get() = Vector3i(x, y, x) + inline val xyy get() = Vector3i(x, y, y) + inline val xyz get() = Vector3i(x, y, z) + inline val xzx get() = Vector3i(x, z, x) + inline val xzy get() = Vector3i(x, z, y) + inline val xzz get() = Vector3i(x, z, z) + inline val yxx get() = Vector3i(y, x, x) + inline val yxy get() = Vector3i(y, x, y) + inline val yxz get() = Vector3i(y, x, z) + inline val yyx get() = Vector3i(y, y, x) + inline val yyy get() = Vector3i(y, y, y) + inline val yyz get() = Vector3i(y, y, z) + inline val yzx get() = Vector3i(y, z, x) + inline val yzy get() = Vector3i(y, z, y) + inline val yzz get() = Vector3i(y, z, z) + inline val zxx get() = Vector3i(z, x, x) + inline val zxy get() = Vector3i(z, x, y) + inline val zxz get() = Vector3i(z, x, z) + inline val zyx get() = Vector3i(z, y, x) + inline val zyy get() = Vector3i(z, y, y) + inline val zyz get() = Vector3i(z, y, z) + inline val zzx get() = Vector3i(z, z, x) + inline val zzy get() = Vector3i(z, z, y) + inline val zzz get() = Vector3i(z, z, z) + inline val xxxx get() = Vector4i(x, x, x, x) + inline val xxxy get() = Vector4i(x, x, x, y) + inline val xxxz get() = Vector4i(x, x, x, z) + inline val xxyx get() = Vector4i(x, x, y, x) + inline val xxyy get() = Vector4i(x, x, y, y) + inline val xxyz get() = Vector4i(x, x, y, z) + inline val xxzx get() = Vector4i(x, x, z, x) + inline val xxzy get() = Vector4i(x, x, z, y) + inline val xxzz get() = Vector4i(x, x, z, z) + inline val xyxx get() = Vector4i(x, y, x, x) + inline val xyxy get() = Vector4i(x, y, x, y) + inline val xyxz get() = Vector4i(x, y, x, z) + inline val xyyx get() = Vector4i(x, y, y, x) + inline val xyyy get() = Vector4i(x, y, y, y) + inline val xyyz get() = Vector4i(x, y, y, z) + inline val xyzx get() = Vector4i(x, y, z, x) + inline val xyzy get() = Vector4i(x, y, z, y) + inline val xyzz get() = Vector4i(x, y, z, z) + inline val xzxx get() = Vector4i(x, z, x, x) + inline val xzxy get() = Vector4i(x, z, x, y) + inline val xzxz get() = Vector4i(x, z, x, z) + inline val xzyx get() = Vector4i(x, z, y, x) + inline val xzyy get() = Vector4i(x, z, y, y) + inline val xzyz get() = Vector4i(x, z, y, z) + inline val xzzx get() = Vector4i(x, z, z, x) + inline val xzzy get() = Vector4i(x, z, z, y) + inline val xzzz get() = Vector4i(x, z, z, z) + inline val yxxx get() = Vector4i(y, x, x, x) + inline val yxxy get() = Vector4i(y, x, x, y) + inline val yxxz get() = Vector4i(y, x, x, z) + inline val yxyx get() = Vector4i(y, x, y, x) + inline val yxyy get() = Vector4i(y, x, y, y) + inline val yxyz get() = Vector4i(y, x, y, z) + inline val yxzx get() = Vector4i(y, x, z, x) + inline val yxzy get() = Vector4i(y, x, z, y) + inline val yxzz get() = Vector4i(y, x, z, z) + inline val yyxx get() = Vector4i(y, y, x, x) + inline val yyxy get() = Vector4i(y, y, x, y) + inline val yyxz get() = Vector4i(y, y, x, z) + inline val yyyx get() = Vector4i(y, y, y, x) + inline val yyyy get() = Vector4i(y, y, y, y) + inline val yyyz get() = Vector4i(y, y, y, z) + inline val yyzx get() = Vector4i(y, y, z, x) + inline val yyzy get() = Vector4i(y, y, z, y) + inline val yyzz get() = Vector4i(y, y, z, z) + inline val yzxx get() = Vector4i(y, z, x, x) + inline val yzxy get() = Vector4i(y, z, x, y) + inline val yzxz get() = Vector4i(y, z, x, z) + inline val yzyx get() = Vector4i(y, z, y, x) + inline val yzyy get() = Vector4i(y, z, y, y) + inline val yzyz get() = Vector4i(y, z, y, z) + inline val yzzx get() = Vector4i(y, z, z, x) + inline val yzzy get() = Vector4i(y, z, z, y) + inline val yzzz get() = Vector4i(y, z, z, z) + inline val zxxx get() = Vector4i(z, x, x, x) + inline val zxxy get() = Vector4i(z, x, x, y) + inline val zxxz get() = Vector4i(z, x, x, z) + inline val zxyx get() = Vector4i(z, x, y, x) + inline val zxyy get() = Vector4i(z, x, y, y) + inline val zxyz get() = Vector4i(z, x, y, z) + inline val zxzx get() = Vector4i(z, x, z, x) + inline val zxzy get() = Vector4i(z, x, z, y) + inline val zxzz get() = Vector4i(z, x, z, z) + inline val zyxx get() = Vector4i(z, y, x, x) + inline val zyxy get() = Vector4i(z, y, x, y) + inline val zyxz get() = Vector4i(z, y, x, z) + inline val zyyx get() = Vector4i(z, y, y, x) + inline val zyyy get() = Vector4i(z, y, y, y) + inline val zyyz get() = Vector4i(z, y, y, z) + inline val zyzx get() = Vector4i(z, y, z, x) + inline val zyzy get() = Vector4i(z, y, z, y) + inline val zyzz get() = Vector4i(z, y, z, z) + inline val zzxx get() = Vector4i(z, z, x, x) + inline val zzxy get() = Vector4i(z, z, x, y) + inline val zzxz get() = Vector4i(z, z, x, z) + inline val zzyx get() = Vector4i(z, z, y, x) + inline val zzyy get() = Vector4i(z, z, y, y) + inline val zzyz get() = Vector4i(z, z, y, z) + inline val zzzx get() = Vector4i(z, z, z, x) + inline val zzzy get() = Vector4i(z, z, z, y) + inline val zzzz get() = Vector4i(z, z, z, z) + inline val rr get() = Vector2i(r, r) + inline val rg get() = Vector2i(r, g) + inline val rb get() = Vector2i(r, b) + inline val gr get() = Vector2i(g, r) + inline val gg get() = Vector2i(g, g) + inline val gb get() = Vector2i(g, b) + inline val br get() = Vector2i(b, r) + inline val bg get() = Vector2i(b, g) + inline val bb get() = Vector2i(b, b) + inline val rrr get() = Vector3i(r, r, r) + inline val rrg get() = Vector3i(r, r, g) + inline val rrb get() = Vector3i(r, r, b) + inline val rgr get() = Vector3i(r, g, r) + inline val rgg get() = Vector3i(r, g, g) + inline val rgb get() = Vector3i(r, g, b) + inline val rbr get() = Vector3i(r, b, r) + inline val rbg get() = Vector3i(r, b, g) + inline val rbb get() = Vector3i(r, b, b) + inline val grr get() = Vector3i(g, r, r) + inline val grg get() = Vector3i(g, r, g) + inline val grb get() = Vector3i(g, r, b) + inline val ggr get() = Vector3i(g, g, r) + inline val ggg get() = Vector3i(g, g, g) + inline val ggb get() = Vector3i(g, g, b) + inline val gbr get() = Vector3i(g, b, r) + inline val gbg get() = Vector3i(g, b, g) + inline val gbb get() = Vector3i(g, b, b) + inline val brr get() = Vector3i(b, r, r) + inline val brg get() = Vector3i(b, r, g) + inline val brb get() = Vector3i(b, r, b) + inline val bgr get() = Vector3i(b, g, r) + inline val bgg get() = Vector3i(b, g, g) + inline val bgb get() = Vector3i(b, g, b) + inline val bbr get() = Vector3i(b, b, r) + inline val bbg get() = Vector3i(b, b, g) + inline val bbb get() = Vector3i(b, b, b) + inline val rrrr get() = Vector4i(r, r, r, r) + inline val rrrg get() = Vector4i(r, r, r, g) + inline val rrrb get() = Vector4i(r, r, r, b) + inline val rrgr get() = Vector4i(r, r, g, r) + inline val rrgg get() = Vector4i(r, r, g, g) + inline val rrgb get() = Vector4i(r, r, g, b) + inline val rrbr get() = Vector4i(r, r, b, r) + inline val rrbg get() = Vector4i(r, r, b, g) + inline val rrbb get() = Vector4i(r, r, b, b) + inline val rgrr get() = Vector4i(r, g, r, r) + inline val rgrg get() = Vector4i(r, g, r, g) + inline val rgrb get() = Vector4i(r, g, r, b) + inline val rggr get() = Vector4i(r, g, g, r) + inline val rggg get() = Vector4i(r, g, g, g) + inline val rggb get() = Vector4i(r, g, g, b) + inline val rgbr get() = Vector4i(r, g, b, r) + inline val rgbg get() = Vector4i(r, g, b, g) + inline val rgbb get() = Vector4i(r, g, b, b) + inline val rbrr get() = Vector4i(r, b, r, r) + inline val rbrg get() = Vector4i(r, b, r, g) + inline val rbrb get() = Vector4i(r, b, r, b) + inline val rbgr get() = Vector4i(r, b, g, r) + inline val rbgg get() = Vector4i(r, b, g, g) + inline val rbgb get() = Vector4i(r, b, g, b) + inline val rbbr get() = Vector4i(r, b, b, r) + inline val rbbg get() = Vector4i(r, b, b, g) + inline val rbbb get() = Vector4i(r, b, b, b) + inline val grrr get() = Vector4i(g, r, r, r) + inline val grrg get() = Vector4i(g, r, r, g) + inline val grrb get() = Vector4i(g, r, r, b) + inline val grgr get() = Vector4i(g, r, g, r) + inline val grgg get() = Vector4i(g, r, g, g) + inline val grgb get() = Vector4i(g, r, g, b) + inline val grbr get() = Vector4i(g, r, b, r) + inline val grbg get() = Vector4i(g, r, b, g) + inline val grbb get() = Vector4i(g, r, b, b) + inline val ggrr get() = Vector4i(g, g, r, r) + inline val ggrg get() = Vector4i(g, g, r, g) + inline val ggrb get() = Vector4i(g, g, r, b) + inline val gggr get() = Vector4i(g, g, g, r) + inline val gggg get() = Vector4i(g, g, g, g) + inline val gggb get() = Vector4i(g, g, g, b) + inline val ggbr get() = Vector4i(g, g, b, r) + inline val ggbg get() = Vector4i(g, g, b, g) + inline val ggbb get() = Vector4i(g, g, b, b) + inline val gbrr get() = Vector4i(g, b, r, r) + inline val gbrg get() = Vector4i(g, b, r, g) + inline val gbrb get() = Vector4i(g, b, r, b) + inline val gbgr get() = Vector4i(g, b, g, r) + inline val gbgg get() = Vector4i(g, b, g, g) + inline val gbgb get() = Vector4i(g, b, g, b) + inline val gbbr get() = Vector4i(g, b, b, r) + inline val gbbg get() = Vector4i(g, b, b, g) + inline val gbbb get() = Vector4i(g, b, b, b) + inline val brrr get() = Vector4i(b, r, r, r) + inline val brrg get() = Vector4i(b, r, r, g) + inline val brrb get() = Vector4i(b, r, r, b) + inline val brgr get() = Vector4i(b, r, g, r) + inline val brgg get() = Vector4i(b, r, g, g) + inline val brgb get() = Vector4i(b, r, g, b) + inline val brbr get() = Vector4i(b, r, b, r) + inline val brbg get() = Vector4i(b, r, b, g) + inline val brbb get() = Vector4i(b, r, b, b) + inline val bgrr get() = Vector4i(b, g, r, r) + inline val bgrg get() = Vector4i(b, g, r, g) + inline val bgrb get() = Vector4i(b, g, r, b) + inline val bggr get() = Vector4i(b, g, g, r) + inline val bggg get() = Vector4i(b, g, g, g) + inline val bggb get() = Vector4i(b, g, g, b) + inline val bgbr get() = Vector4i(b, g, b, r) + inline val bgbg get() = Vector4i(b, g, b, g) + inline val bgbb get() = Vector4i(b, g, b, b) + inline val bbrr get() = Vector4i(b, b, r, r) + inline val bbrg get() = Vector4i(b, b, r, g) + inline val bbrb get() = Vector4i(b, b, r, b) + inline val bbgr get() = Vector4i(b, b, g, r) + inline val bbgg get() = Vector4i(b, b, g, g) + inline val bbgb get() = Vector4i(b, b, g, b) + inline val bbbr get() = Vector4i(b, b, b, r) + inline val bbbg get() = Vector4i(b, b, b, g) + inline val bbbb get() = Vector4i(b, b, b, b) + inline val ss get() = Vector2i(s, s) + inline val st get() = Vector2i(s, t) + inline val sp get() = Vector2i(s, p) + inline val ts get() = Vector2i(t, s) + inline val tt get() = Vector2i(t, t) + inline val tp get() = Vector2i(t, p) + inline val ps get() = Vector2i(p, s) + inline val pt get() = Vector2i(p, t) + inline val pp get() = Vector2i(p, p) + inline val sss get() = Vector3i(s, s, s) + inline val sst get() = Vector3i(s, s, t) + inline val ssp get() = Vector3i(s, s, p) + inline val sts get() = Vector3i(s, t, s) + inline val stt get() = Vector3i(s, t, t) + inline val stp get() = Vector3i(s, t, p) + inline val sps get() = Vector3i(s, p, s) + inline val spt get() = Vector3i(s, p, t) + inline val spp get() = Vector3i(s, p, p) + inline val tss get() = Vector3i(t, s, s) + inline val tst get() = Vector3i(t, s, t) + inline val tsp get() = Vector3i(t, s, p) + inline val tts get() = Vector3i(t, t, s) + inline val ttt get() = Vector3i(t, t, t) + inline val ttp get() = Vector3i(t, t, p) + inline val tps get() = Vector3i(t, p, s) + inline val tpt get() = Vector3i(t, p, t) + inline val tpp get() = Vector3i(t, p, p) + inline val pss get() = Vector3i(p, s, s) + inline val pst get() = Vector3i(p, s, t) + inline val psp get() = Vector3i(p, s, p) + inline val pts get() = Vector3i(p, t, s) + inline val ptt get() = Vector3i(p, t, t) + inline val ptp get() = Vector3i(p, t, p) + inline val pps get() = Vector3i(p, p, s) + inline val ppt get() = Vector3i(p, p, t) + inline val ppp get() = Vector3i(p, p, p) + inline val ssss get() = Vector4i(s, s, s, s) + inline val ssst get() = Vector4i(s, s, s, t) + inline val sssp get() = Vector4i(s, s, s, p) + inline val ssts get() = Vector4i(s, s, t, s) + inline val sstt get() = Vector4i(s, s, t, t) + inline val sstp get() = Vector4i(s, s, t, p) + inline val ssps get() = Vector4i(s, s, p, s) + inline val sspt get() = Vector4i(s, s, p, t) + inline val sspp get() = Vector4i(s, s, p, p) + inline val stss get() = Vector4i(s, t, s, s) + inline val stst get() = Vector4i(s, t, s, t) + inline val stsp get() = Vector4i(s, t, s, p) + inline val stts get() = Vector4i(s, t, t, s) + inline val sttt get() = Vector4i(s, t, t, t) + inline val sttp get() = Vector4i(s, t, t, p) + inline val stps get() = Vector4i(s, t, p, s) + inline val stpt get() = Vector4i(s, t, p, t) + inline val stpp get() = Vector4i(s, t, p, p) + inline val spss get() = Vector4i(s, p, s, s) + inline val spst get() = Vector4i(s, p, s, t) + inline val spsp get() = Vector4i(s, p, s, p) + inline val spts get() = Vector4i(s, p, t, s) + inline val sptt get() = Vector4i(s, p, t, t) + inline val sptp get() = Vector4i(s, p, t, p) + inline val spps get() = Vector4i(s, p, p, s) + inline val sppt get() = Vector4i(s, p, p, t) + inline val sppp get() = Vector4i(s, p, p, p) + inline val tsss get() = Vector4i(t, s, s, s) + inline val tsst get() = Vector4i(t, s, s, t) + inline val tssp get() = Vector4i(t, s, s, p) + inline val tsts get() = Vector4i(t, s, t, s) + inline val tstt get() = Vector4i(t, s, t, t) + inline val tstp get() = Vector4i(t, s, t, p) + inline val tsps get() = Vector4i(t, s, p, s) + inline val tspt get() = Vector4i(t, s, p, t) + inline val tspp get() = Vector4i(t, s, p, p) + inline val ttss get() = Vector4i(t, t, s, s) + inline val ttst get() = Vector4i(t, t, s, t) + inline val ttsp get() = Vector4i(t, t, s, p) + inline val ttts get() = Vector4i(t, t, t, s) + inline val tttt get() = Vector4i(t, t, t, t) + inline val tttp get() = Vector4i(t, t, t, p) + inline val ttps get() = Vector4i(t, t, p, s) + inline val ttpt get() = Vector4i(t, t, p, t) + inline val ttpp get() = Vector4i(t, t, p, p) + inline val tpss get() = Vector4i(t, p, s, s) + inline val tpst get() = Vector4i(t, p, s, t) + inline val tpsp get() = Vector4i(t, p, s, p) + inline val tpts get() = Vector4i(t, p, t, s) + inline val tptt get() = Vector4i(t, p, t, t) + inline val tptp get() = Vector4i(t, p, t, p) + inline val tpps get() = Vector4i(t, p, p, s) + inline val tppt get() = Vector4i(t, p, p, t) + inline val tppp get() = Vector4i(t, p, p, p) + inline val psss get() = Vector4i(p, s, s, s) + inline val psst get() = Vector4i(p, s, s, t) + inline val pssp get() = Vector4i(p, s, s, p) + inline val psts get() = Vector4i(p, s, t, s) + inline val pstt get() = Vector4i(p, s, t, t) + inline val pstp get() = Vector4i(p, s, t, p) + inline val psps get() = Vector4i(p, s, p, s) + inline val pspt get() = Vector4i(p, s, p, t) + inline val pspp get() = Vector4i(p, s, p, p) + inline val ptss get() = Vector4i(p, t, s, s) + inline val ptst get() = Vector4i(p, t, s, t) + inline val ptsp get() = Vector4i(p, t, s, p) + inline val ptts get() = Vector4i(p, t, t, s) + inline val pttt get() = Vector4i(p, t, t, t) + inline val pttp get() = Vector4i(p, t, t, p) + inline val ptps get() = Vector4i(p, t, p, s) + inline val ptpt get() = Vector4i(p, t, p, t) + inline val ptpp get() = Vector4i(p, t, p, p) + inline val ppss get() = Vector4i(p, p, s, s) + inline val ppst get() = Vector4i(p, p, s, t) + inline val ppsp get() = Vector4i(p, p, s, p) + inline val ppts get() = Vector4i(p, p, t, s) + inline val pptt get() = Vector4i(p, p, t, t) + inline val pptp get() = Vector4i(p, p, t, p) + inline val ppps get() = Vector4i(p, p, p, s) + inline val pppt get() = Vector4i(p, p, p, t) + inline val pppp get() = Vector4i(p, p, p, p) + + companion object { + @JvmField val ZERO = Vector3i() + @JvmField val POSITIVE_X = Vector3i(x = 1) + @JvmField val NEGATIVE_X = Vector3i(x = -1) + @JvmField val POSITIVE_Y = Vector3i(y = 1) + @JvmField val NEGATIVE_Y = Vector3i(y = -1) + @JvmField val POSITIVE_Z = Vector3i(z = 1) + @JvmField val NEGATIVE_Z = Vector3i(z = -1) + } +} + +operator fun Int.times(other: Vector3i): Vector3i { + return Vector3i(this * other.x, this * other.y, this * other.z) +} + +operator fun Int.div(other: Vector3i): Vector3i { + return Vector3i(this / other.x, this / other.y, this / other.z) +} + +/** + * Mutable 3D Vector, representing three-dimensional coordinates as [Int]s + * + * It can be safely passed around to methods which expect immutable [Vector3i], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector3i( + override var x: Int = 0, + override var y: Int = 0, + override var z: Int = 0, +) : Vector3i(x, y, z), IMutableIntVector, IMutableWholeVector, IMutableVector, IMatrixSetterInt { + constructor(input: IStruct2i, z: Int = 0) : this(input.component1(), input.component2(), z) + constructor(x: Int, input: IStruct2i) : this(x, input.component1(), input.component2()) + constructor(input: IStruct3i) : this(input.component1(), input.component2(), input.component3()) + + override fun set(column: Int, row: Int, value: Int) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + 2 -> z = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override var r by this::x + override var g by this::y + override var b by this::z + + override var s by this::x + override var t by this::y + override var p by this::z + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector3i + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + + return true + } + + override fun plusMut(other: Vector3i): MutableVector3i { + x += other.x + y += other.y + z += other.z + return this + } + + override fun minusMut(other: Vector3i): MutableVector3i { + x -= other.x + y -= other.y + z -= other.z + return this + } + + override fun timesMut(other: Vector3i): MutableVector3i { + x *= other.x + y *= other.y + z *= other.z + return this + } + + override fun divMut(other: Vector3i): MutableVector3i { + x /= other.x + y /= other.y + z /= other.z + return this + } + + override fun timesMut(other: Int): MutableVector3i { + x *= other + y *= other + z *= other + return this + } + + override fun divMut(other: Int): MutableVector3i { + x /= other + y /= other + z /= other + return this + } +} \ No newline at end of file diff --git a/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector4i.kt b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector4i.kt new file mode 100644 index 00000000..be0c4299 --- /dev/null +++ b/src/kvector/kotlin/ru/dbotthepony/kvector/vector/nint/Vector4i.kt @@ -0,0 +1,1329 @@ + +@file:Suppress("nothing_to_inline", "unused") + +package ru.dbotthepony.kvector.vector.nint + +import ru.dbotthepony.kvector.api.* +import kotlin.math.absoluteValue + +/** + * 4D Vector, representing four-dimensional coordinates as [Int]s + */ +open class Vector4i( + open val x: Int = 0, + open val y: Int = 0, + open val z: Int = 0, + open val w: Int = 0, +) : AbstractVector(), IWholeVector, IIntVector, IStruct4i, IMatrixGetterInt { + constructor(input: IStruct2i, z: Int = 0, w: Int = 0) : this(input.component1(), input.component2(), z, w) + constructor(x: Int, input: IStruct2i, w: Int = 0) : this(x, input.component1(), input.component2(), w) + constructor(x: Int, y: Int, input: IStruct2i) : this(x, y, input.component1(), input.component2()) + + constructor(input: IStruct3i, w: Int = 0) : this(input.component1(), input.component2(), input.component3(), w) + constructor(x: Int, input: IStruct3i) : this(x, input.component1(), input.component2(), input.component3()) + constructor(input: IStruct4i) : this(input.component1(), input.component2(), input.component3(), input.component4()) + + override fun get(column: Int, row: Int): Int { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + return when (row) { + 0 -> x + 1 -> y + 2 -> z + 3 -> w + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + final override val rows: Int = 3 + + final override fun component1() = x + final override fun component2() = y + final override fun component3() = z + final override fun component4() = w + + open val r by this::x + open val g by this::y + open val b by this::z + open val a by this::w + + open val s by this::x + open val t by this::y + open val p by this::z + open val q by this::w + + final override val lengthSquared: Double + get() = (x.toLong() * x.toLong() + y.toLong() * y.toLong() + z.toLong() * z.toLong()).toDouble() + final override val isFinite: Boolean = true + final override val isNaN: Boolean = false + + override fun plus(other: Vector4i): Vector4i { + return Vector4i( + x + other.x, + y + other.y, + z + other.z, + w + other.w, + ) + } + + override fun minus(other: Vector4i): Vector4i { + return Vector4i( + x - other.x, + y - other.y, + z - other.z, + w - other.w, + ) + } + + override fun times(other: Vector4i): Vector4i { + return Vector4i( + x * other.x, + y * other.y, + z * other.z, + w * other.w, + ) + } + + override fun div(other: Vector4i): Vector4i { + return Vector4i( + x / other.x, + y / other.y, + z / other.z, + w / other.w, + ) + } + + override val absoluteValue: Vector4i + get() = Vector4i(x.absoluteValue, y.absoluteValue, z.absoluteValue, w.absoluteValue) + + override fun coerceAtMost(maximal: Vector4i): Vector4i { + return Vector4i( + x.coerceAtMost(maximal.x), + y.coerceAtMost(maximal.y), + z.coerceAtMost(maximal.z), + w.coerceAtMost(maximal.w), + ) + } + + override fun coerceAtLeast(minimal: Vector4i): Vector4i { + return Vector4i( + x.coerceAtLeast(minimal.x), + y.coerceAtLeast(minimal.y), + z.coerceAtLeast(minimal.z), + w.coerceAtLeast(minimal.w), + ) + } + + override fun clamp(minimal: Vector4i, maximal: Vector4i): Vector4i { + return Vector4i( + x.coerceAtLeast(minimal.x).coerceAtMost(maximal.x), + y.coerceAtLeast(minimal.y).coerceAtMost(maximal.y), + z.coerceAtLeast(minimal.z).coerceAtMost(maximal.z), + w.coerceAtLeast(minimal.w).coerceAtMost(maximal.w), + ) + } + + override fun unaryMinus(): Vector4i { + return Vector4i(-x, -y, -z, -w) + } + + override fun distanceSquared(other: Vector4i): Double { + val x = x.toDouble() - other.x.toDouble() + val y = y.toDouble() - other.y.toDouble() + val z = z.toDouble() - other.z.toDouble() + val w = w.toDouble() - other.w.toDouble() + + return x * x + y * y + z * z + w * w + } + + override fun wholeDistanceSquared(other: Vector4i): Long { + val x = x.toLong() - other.x.toLong() + val y = y.toLong() - other.y.toLong() + val z = z.toLong() - other.z.toLong() + val w = w.toLong() - other.w.toLong() + + return x * x + y * y + z * z + w * w + } + + override fun times(other: Int): Vector4i { + return Vector4i( + x * other, + y * other, + z * other, + w * other, + ) + } + + override fun div(other: Int): Vector4i { + return Vector4i( + x / other, + y / other, + z / other, + w / other, + ) + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as Vector4i + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + if (w != other.w) return false + + return true + } + + override fun hashCode(): Int { + var result = x + result = 31 * result + y + result = 31 * result + z + result = 31 * result + w + return result + } + + override fun toString(): String { + return "[${x}i ${y}i ${z}i ${w}i]" + } + + inline val xx get() = Vector2i(x, x) + inline val xy get() = Vector2i(x, y) + inline val xz get() = Vector2i(x, z) + inline val xw get() = Vector2i(x, w) + inline val yx get() = Vector2i(y, x) + inline val yy get() = Vector2i(y, y) + inline val yz get() = Vector2i(y, z) + inline val yw get() = Vector2i(y, w) + inline val zx get() = Vector2i(z, x) + inline val zy get() = Vector2i(z, y) + inline val zz get() = Vector2i(z, z) + inline val zw get() = Vector2i(z, w) + inline val wx get() = Vector2i(w, x) + inline val wy get() = Vector2i(w, y) + inline val wz get() = Vector2i(w, z) + inline val ww get() = Vector2i(w, w) + inline val xxx get() = Vector3i(x, x, x) + inline val xxy get() = Vector3i(x, x, y) + inline val xxz get() = Vector3i(x, x, z) + inline val xxw get() = Vector3i(x, x, w) + inline val xyx get() = Vector3i(x, y, x) + inline val xyy get() = Vector3i(x, y, y) + inline val xyz get() = Vector3i(x, y, z) + inline val xyw get() = Vector3i(x, y, w) + inline val xzx get() = Vector3i(x, z, x) + inline val xzy get() = Vector3i(x, z, y) + inline val xzz get() = Vector3i(x, z, z) + inline val xzw get() = Vector3i(x, z, w) + inline val xwx get() = Vector3i(x, w, x) + inline val xwy get() = Vector3i(x, w, y) + inline val xwz get() = Vector3i(x, w, z) + inline val xww get() = Vector3i(x, w, w) + inline val yxx get() = Vector3i(y, x, x) + inline val yxy get() = Vector3i(y, x, y) + inline val yxz get() = Vector3i(y, x, z) + inline val yxw get() = Vector3i(y, x, w) + inline val yyx get() = Vector3i(y, y, x) + inline val yyy get() = Vector3i(y, y, y) + inline val yyz get() = Vector3i(y, y, z) + inline val yyw get() = Vector3i(y, y, w) + inline val yzx get() = Vector3i(y, z, x) + inline val yzy get() = Vector3i(y, z, y) + inline val yzz get() = Vector3i(y, z, z) + inline val yzw get() = Vector3i(y, z, w) + inline val ywx get() = Vector3i(y, w, x) + inline val ywy get() = Vector3i(y, w, y) + inline val ywz get() = Vector3i(y, w, z) + inline val yww get() = Vector3i(y, w, w) + inline val zxx get() = Vector3i(z, x, x) + inline val zxy get() = Vector3i(z, x, y) + inline val zxz get() = Vector3i(z, x, z) + inline val zxw get() = Vector3i(z, x, w) + inline val zyx get() = Vector3i(z, y, x) + inline val zyy get() = Vector3i(z, y, y) + inline val zyz get() = Vector3i(z, y, z) + inline val zyw get() = Vector3i(z, y, w) + inline val zzx get() = Vector3i(z, z, x) + inline val zzy get() = Vector3i(z, z, y) + inline val zzz get() = Vector3i(z, z, z) + inline val zzw get() = Vector3i(z, z, w) + inline val zwx get() = Vector3i(z, w, x) + inline val zwy get() = Vector3i(z, w, y) + inline val zwz get() = Vector3i(z, w, z) + inline val zww get() = Vector3i(z, w, w) + inline val wxx get() = Vector3i(w, x, x) + inline val wxy get() = Vector3i(w, x, y) + inline val wxz get() = Vector3i(w, x, z) + inline val wxw get() = Vector3i(w, x, w) + inline val wyx get() = Vector3i(w, y, x) + inline val wyy get() = Vector3i(w, y, y) + inline val wyz get() = Vector3i(w, y, z) + inline val wyw get() = Vector3i(w, y, w) + inline val wzx get() = Vector3i(w, z, x) + inline val wzy get() = Vector3i(w, z, y) + inline val wzz get() = Vector3i(w, z, z) + inline val wzw get() = Vector3i(w, z, w) + inline val wwx get() = Vector3i(w, w, x) + inline val wwy get() = Vector3i(w, w, y) + inline val wwz get() = Vector3i(w, w, z) + inline val www get() = Vector3i(w, w, w) + inline val xxxx get() = Vector4i(x, x, x, x) + inline val xxxy get() = Vector4i(x, x, x, y) + inline val xxxz get() = Vector4i(x, x, x, z) + inline val xxxw get() = Vector4i(x, x, x, w) + inline val xxyx get() = Vector4i(x, x, y, x) + inline val xxyy get() = Vector4i(x, x, y, y) + inline val xxyz get() = Vector4i(x, x, y, z) + inline val xxyw get() = Vector4i(x, x, y, w) + inline val xxzx get() = Vector4i(x, x, z, x) + inline val xxzy get() = Vector4i(x, x, z, y) + inline val xxzz get() = Vector4i(x, x, z, z) + inline val xxzw get() = Vector4i(x, x, z, w) + inline val xxwx get() = Vector4i(x, x, w, x) + inline val xxwy get() = Vector4i(x, x, w, y) + inline val xxwz get() = Vector4i(x, x, w, z) + inline val xxww get() = Vector4i(x, x, w, w) + inline val xyxx get() = Vector4i(x, y, x, x) + inline val xyxy get() = Vector4i(x, y, x, y) + inline val xyxz get() = Vector4i(x, y, x, z) + inline val xyxw get() = Vector4i(x, y, x, w) + inline val xyyx get() = Vector4i(x, y, y, x) + inline val xyyy get() = Vector4i(x, y, y, y) + inline val xyyz get() = Vector4i(x, y, y, z) + inline val xyyw get() = Vector4i(x, y, y, w) + inline val xyzx get() = Vector4i(x, y, z, x) + inline val xyzy get() = Vector4i(x, y, z, y) + inline val xyzz get() = Vector4i(x, y, z, z) + inline val xyzw get() = Vector4i(x, y, z, w) + inline val xywx get() = Vector4i(x, y, w, x) + inline val xywy get() = Vector4i(x, y, w, y) + inline val xywz get() = Vector4i(x, y, w, z) + inline val xyww get() = Vector4i(x, y, w, w) + inline val xzxx get() = Vector4i(x, z, x, x) + inline val xzxy get() = Vector4i(x, z, x, y) + inline val xzxz get() = Vector4i(x, z, x, z) + inline val xzxw get() = Vector4i(x, z, x, w) + inline val xzyx get() = Vector4i(x, z, y, x) + inline val xzyy get() = Vector4i(x, z, y, y) + inline val xzyz get() = Vector4i(x, z, y, z) + inline val xzyw get() = Vector4i(x, z, y, w) + inline val xzzx get() = Vector4i(x, z, z, x) + inline val xzzy get() = Vector4i(x, z, z, y) + inline val xzzz get() = Vector4i(x, z, z, z) + inline val xzzw get() = Vector4i(x, z, z, w) + inline val xzwx get() = Vector4i(x, z, w, x) + inline val xzwy get() = Vector4i(x, z, w, y) + inline val xzwz get() = Vector4i(x, z, w, z) + inline val xzww get() = Vector4i(x, z, w, w) + inline val xwxx get() = Vector4i(x, w, x, x) + inline val xwxy get() = Vector4i(x, w, x, y) + inline val xwxz get() = Vector4i(x, w, x, z) + inline val xwxw get() = Vector4i(x, w, x, w) + inline val xwyx get() = Vector4i(x, w, y, x) + inline val xwyy get() = Vector4i(x, w, y, y) + inline val xwyz get() = Vector4i(x, w, y, z) + inline val xwyw get() = Vector4i(x, w, y, w) + inline val xwzx get() = Vector4i(x, w, z, x) + inline val xwzy get() = Vector4i(x, w, z, y) + inline val xwzz get() = Vector4i(x, w, z, z) + inline val xwzw get() = Vector4i(x, w, z, w) + inline val xwwx get() = Vector4i(x, w, w, x) + inline val xwwy get() = Vector4i(x, w, w, y) + inline val xwwz get() = Vector4i(x, w, w, z) + inline val xwww get() = Vector4i(x, w, w, w) + inline val yxxx get() = Vector4i(y, x, x, x) + inline val yxxy get() = Vector4i(y, x, x, y) + inline val yxxz get() = Vector4i(y, x, x, z) + inline val yxxw get() = Vector4i(y, x, x, w) + inline val yxyx get() = Vector4i(y, x, y, x) + inline val yxyy get() = Vector4i(y, x, y, y) + inline val yxyz get() = Vector4i(y, x, y, z) + inline val yxyw get() = Vector4i(y, x, y, w) + inline val yxzx get() = Vector4i(y, x, z, x) + inline val yxzy get() = Vector4i(y, x, z, y) + inline val yxzz get() = Vector4i(y, x, z, z) + inline val yxzw get() = Vector4i(y, x, z, w) + inline val yxwx get() = Vector4i(y, x, w, x) + inline val yxwy get() = Vector4i(y, x, w, y) + inline val yxwz get() = Vector4i(y, x, w, z) + inline val yxww get() = Vector4i(y, x, w, w) + inline val yyxx get() = Vector4i(y, y, x, x) + inline val yyxy get() = Vector4i(y, y, x, y) + inline val yyxz get() = Vector4i(y, y, x, z) + inline val yyxw get() = Vector4i(y, y, x, w) + inline val yyyx get() = Vector4i(y, y, y, x) + inline val yyyy get() = Vector4i(y, y, y, y) + inline val yyyz get() = Vector4i(y, y, y, z) + inline val yyyw get() = Vector4i(y, y, y, w) + inline val yyzx get() = Vector4i(y, y, z, x) + inline val yyzy get() = Vector4i(y, y, z, y) + inline val yyzz get() = Vector4i(y, y, z, z) + inline val yyzw get() = Vector4i(y, y, z, w) + inline val yywx get() = Vector4i(y, y, w, x) + inline val yywy get() = Vector4i(y, y, w, y) + inline val yywz get() = Vector4i(y, y, w, z) + inline val yyww get() = Vector4i(y, y, w, w) + inline val yzxx get() = Vector4i(y, z, x, x) + inline val yzxy get() = Vector4i(y, z, x, y) + inline val yzxz get() = Vector4i(y, z, x, z) + inline val yzxw get() = Vector4i(y, z, x, w) + inline val yzyx get() = Vector4i(y, z, y, x) + inline val yzyy get() = Vector4i(y, z, y, y) + inline val yzyz get() = Vector4i(y, z, y, z) + inline val yzyw get() = Vector4i(y, z, y, w) + inline val yzzx get() = Vector4i(y, z, z, x) + inline val yzzy get() = Vector4i(y, z, z, y) + inline val yzzz get() = Vector4i(y, z, z, z) + inline val yzzw get() = Vector4i(y, z, z, w) + inline val yzwx get() = Vector4i(y, z, w, x) + inline val yzwy get() = Vector4i(y, z, w, y) + inline val yzwz get() = Vector4i(y, z, w, z) + inline val yzww get() = Vector4i(y, z, w, w) + inline val ywxx get() = Vector4i(y, w, x, x) + inline val ywxy get() = Vector4i(y, w, x, y) + inline val ywxz get() = Vector4i(y, w, x, z) + inline val ywxw get() = Vector4i(y, w, x, w) + inline val ywyx get() = Vector4i(y, w, y, x) + inline val ywyy get() = Vector4i(y, w, y, y) + inline val ywyz get() = Vector4i(y, w, y, z) + inline val ywyw get() = Vector4i(y, w, y, w) + inline val ywzx get() = Vector4i(y, w, z, x) + inline val ywzy get() = Vector4i(y, w, z, y) + inline val ywzz get() = Vector4i(y, w, z, z) + inline val ywzw get() = Vector4i(y, w, z, w) + inline val ywwx get() = Vector4i(y, w, w, x) + inline val ywwy get() = Vector4i(y, w, w, y) + inline val ywwz get() = Vector4i(y, w, w, z) + inline val ywww get() = Vector4i(y, w, w, w) + inline val zxxx get() = Vector4i(z, x, x, x) + inline val zxxy get() = Vector4i(z, x, x, y) + inline val zxxz get() = Vector4i(z, x, x, z) + inline val zxxw get() = Vector4i(z, x, x, w) + inline val zxyx get() = Vector4i(z, x, y, x) + inline val zxyy get() = Vector4i(z, x, y, y) + inline val zxyz get() = Vector4i(z, x, y, z) + inline val zxyw get() = Vector4i(z, x, y, w) + inline val zxzx get() = Vector4i(z, x, z, x) + inline val zxzy get() = Vector4i(z, x, z, y) + inline val zxzz get() = Vector4i(z, x, z, z) + inline val zxzw get() = Vector4i(z, x, z, w) + inline val zxwx get() = Vector4i(z, x, w, x) + inline val zxwy get() = Vector4i(z, x, w, y) + inline val zxwz get() = Vector4i(z, x, w, z) + inline val zxww get() = Vector4i(z, x, w, w) + inline val zyxx get() = Vector4i(z, y, x, x) + inline val zyxy get() = Vector4i(z, y, x, y) + inline val zyxz get() = Vector4i(z, y, x, z) + inline val zyxw get() = Vector4i(z, y, x, w) + inline val zyyx get() = Vector4i(z, y, y, x) + inline val zyyy get() = Vector4i(z, y, y, y) + inline val zyyz get() = Vector4i(z, y, y, z) + inline val zyyw get() = Vector4i(z, y, y, w) + inline val zyzx get() = Vector4i(z, y, z, x) + inline val zyzy get() = Vector4i(z, y, z, y) + inline val zyzz get() = Vector4i(z, y, z, z) + inline val zyzw get() = Vector4i(z, y, z, w) + inline val zywx get() = Vector4i(z, y, w, x) + inline val zywy get() = Vector4i(z, y, w, y) + inline val zywz get() = Vector4i(z, y, w, z) + inline val zyww get() = Vector4i(z, y, w, w) + inline val zzxx get() = Vector4i(z, z, x, x) + inline val zzxy get() = Vector4i(z, z, x, y) + inline val zzxz get() = Vector4i(z, z, x, z) + inline val zzxw get() = Vector4i(z, z, x, w) + inline val zzyx get() = Vector4i(z, z, y, x) + inline val zzyy get() = Vector4i(z, z, y, y) + inline val zzyz get() = Vector4i(z, z, y, z) + inline val zzyw get() = Vector4i(z, z, y, w) + inline val zzzx get() = Vector4i(z, z, z, x) + inline val zzzy get() = Vector4i(z, z, z, y) + inline val zzzz get() = Vector4i(z, z, z, z) + inline val zzzw get() = Vector4i(z, z, z, w) + inline val zzwx get() = Vector4i(z, z, w, x) + inline val zzwy get() = Vector4i(z, z, w, y) + inline val zzwz get() = Vector4i(z, z, w, z) + inline val zzww get() = Vector4i(z, z, w, w) + inline val zwxx get() = Vector4i(z, w, x, x) + inline val zwxy get() = Vector4i(z, w, x, y) + inline val zwxz get() = Vector4i(z, w, x, z) + inline val zwxw get() = Vector4i(z, w, x, w) + inline val zwyx get() = Vector4i(z, w, y, x) + inline val zwyy get() = Vector4i(z, w, y, y) + inline val zwyz get() = Vector4i(z, w, y, z) + inline val zwyw get() = Vector4i(z, w, y, w) + inline val zwzx get() = Vector4i(z, w, z, x) + inline val zwzy get() = Vector4i(z, w, z, y) + inline val zwzz get() = Vector4i(z, w, z, z) + inline val zwzw get() = Vector4i(z, w, z, w) + inline val zwwx get() = Vector4i(z, w, w, x) + inline val zwwy get() = Vector4i(z, w, w, y) + inline val zwwz get() = Vector4i(z, w, w, z) + inline val zwww get() = Vector4i(z, w, w, w) + inline val wxxx get() = Vector4i(w, x, x, x) + inline val wxxy get() = Vector4i(w, x, x, y) + inline val wxxz get() = Vector4i(w, x, x, z) + inline val wxxw get() = Vector4i(w, x, x, w) + inline val wxyx get() = Vector4i(w, x, y, x) + inline val wxyy get() = Vector4i(w, x, y, y) + inline val wxyz get() = Vector4i(w, x, y, z) + inline val wxyw get() = Vector4i(w, x, y, w) + inline val wxzx get() = Vector4i(w, x, z, x) + inline val wxzy get() = Vector4i(w, x, z, y) + inline val wxzz get() = Vector4i(w, x, z, z) + inline val wxzw get() = Vector4i(w, x, z, w) + inline val wxwx get() = Vector4i(w, x, w, x) + inline val wxwy get() = Vector4i(w, x, w, y) + inline val wxwz get() = Vector4i(w, x, w, z) + inline val wxww get() = Vector4i(w, x, w, w) + inline val wyxx get() = Vector4i(w, y, x, x) + inline val wyxy get() = Vector4i(w, y, x, y) + inline val wyxz get() = Vector4i(w, y, x, z) + inline val wyxw get() = Vector4i(w, y, x, w) + inline val wyyx get() = Vector4i(w, y, y, x) + inline val wyyy get() = Vector4i(w, y, y, y) + inline val wyyz get() = Vector4i(w, y, y, z) + inline val wyyw get() = Vector4i(w, y, y, w) + inline val wyzx get() = Vector4i(w, y, z, x) + inline val wyzy get() = Vector4i(w, y, z, y) + inline val wyzz get() = Vector4i(w, y, z, z) + inline val wyzw get() = Vector4i(w, y, z, w) + inline val wywx get() = Vector4i(w, y, w, x) + inline val wywy get() = Vector4i(w, y, w, y) + inline val wywz get() = Vector4i(w, y, w, z) + inline val wyww get() = Vector4i(w, y, w, w) + inline val wzxx get() = Vector4i(w, z, x, x) + inline val wzxy get() = Vector4i(w, z, x, y) + inline val wzxz get() = Vector4i(w, z, x, z) + inline val wzxw get() = Vector4i(w, z, x, w) + inline val wzyx get() = Vector4i(w, z, y, x) + inline val wzyy get() = Vector4i(w, z, y, y) + inline val wzyz get() = Vector4i(w, z, y, z) + inline val wzyw get() = Vector4i(w, z, y, w) + inline val wzzx get() = Vector4i(w, z, z, x) + inline val wzzy get() = Vector4i(w, z, z, y) + inline val wzzz get() = Vector4i(w, z, z, z) + inline val wzzw get() = Vector4i(w, z, z, w) + inline val wzwx get() = Vector4i(w, z, w, x) + inline val wzwy get() = Vector4i(w, z, w, y) + inline val wzwz get() = Vector4i(w, z, w, z) + inline val wzww get() = Vector4i(w, z, w, w) + inline val wwxx get() = Vector4i(w, w, x, x) + inline val wwxy get() = Vector4i(w, w, x, y) + inline val wwxz get() = Vector4i(w, w, x, z) + inline val wwxw get() = Vector4i(w, w, x, w) + inline val wwyx get() = Vector4i(w, w, y, x) + inline val wwyy get() = Vector4i(w, w, y, y) + inline val wwyz get() = Vector4i(w, w, y, z) + inline val wwyw get() = Vector4i(w, w, y, w) + inline val wwzx get() = Vector4i(w, w, z, x) + inline val wwzy get() = Vector4i(w, w, z, y) + inline val wwzz get() = Vector4i(w, w, z, z) + inline val wwzw get() = Vector4i(w, w, z, w) + inline val wwwx get() = Vector4i(w, w, w, x) + inline val wwwy get() = Vector4i(w, w, w, y) + inline val wwwz get() = Vector4i(w, w, w, z) + inline val wwww get() = Vector4i(w, w, w, w) + inline val rr get() = Vector2i(r, r) + inline val rg get() = Vector2i(r, g) + inline val rb get() = Vector2i(r, b) + inline val ra get() = Vector2i(r, a) + inline val gr get() = Vector2i(g, r) + inline val gg get() = Vector2i(g, g) + inline val gb get() = Vector2i(g, b) + inline val ga get() = Vector2i(g, a) + inline val br get() = Vector2i(b, r) + inline val bg get() = Vector2i(b, g) + inline val bb get() = Vector2i(b, b) + inline val ba get() = Vector2i(b, a) + inline val ar get() = Vector2i(a, r) + inline val ag get() = Vector2i(a, g) + inline val ab get() = Vector2i(a, b) + inline val aa get() = Vector2i(a, a) + inline val rrr get() = Vector3i(r, r, r) + inline val rrg get() = Vector3i(r, r, g) + inline val rrb get() = Vector3i(r, r, b) + inline val rra get() = Vector3i(r, r, a) + inline val rgr get() = Vector3i(r, g, r) + inline val rgg get() = Vector3i(r, g, g) + inline val rgb get() = Vector3i(r, g, b) + inline val rga get() = Vector3i(r, g, a) + inline val rbr get() = Vector3i(r, b, r) + inline val rbg get() = Vector3i(r, b, g) + inline val rbb get() = Vector3i(r, b, b) + inline val rba get() = Vector3i(r, b, a) + inline val rar get() = Vector3i(r, a, r) + inline val rag get() = Vector3i(r, a, g) + inline val rab get() = Vector3i(r, a, b) + inline val raa get() = Vector3i(r, a, a) + inline val grr get() = Vector3i(g, r, r) + inline val grg get() = Vector3i(g, r, g) + inline val grb get() = Vector3i(g, r, b) + inline val gra get() = Vector3i(g, r, a) + inline val ggr get() = Vector3i(g, g, r) + inline val ggg get() = Vector3i(g, g, g) + inline val ggb get() = Vector3i(g, g, b) + inline val gga get() = Vector3i(g, g, a) + inline val gbr get() = Vector3i(g, b, r) + inline val gbg get() = Vector3i(g, b, g) + inline val gbb get() = Vector3i(g, b, b) + inline val gba get() = Vector3i(g, b, a) + inline val gar get() = Vector3i(g, a, r) + inline val gag get() = Vector3i(g, a, g) + inline val gab get() = Vector3i(g, a, b) + inline val gaa get() = Vector3i(g, a, a) + inline val brr get() = Vector3i(b, r, r) + inline val brg get() = Vector3i(b, r, g) + inline val brb get() = Vector3i(b, r, b) + inline val bra get() = Vector3i(b, r, a) + inline val bgr get() = Vector3i(b, g, r) + inline val bgg get() = Vector3i(b, g, g) + inline val bgb get() = Vector3i(b, g, b) + inline val bga get() = Vector3i(b, g, a) + inline val bbr get() = Vector3i(b, b, r) + inline val bbg get() = Vector3i(b, b, g) + inline val bbb get() = Vector3i(b, b, b) + inline val bba get() = Vector3i(b, b, a) + inline val bar get() = Vector3i(b, a, r) + inline val bag get() = Vector3i(b, a, g) + inline val bab get() = Vector3i(b, a, b) + inline val baa get() = Vector3i(b, a, a) + inline val arr get() = Vector3i(a, r, r) + inline val arg get() = Vector3i(a, r, g) + inline val arb get() = Vector3i(a, r, b) + inline val ara get() = Vector3i(a, r, a) + inline val agr get() = Vector3i(a, g, r) + inline val agg get() = Vector3i(a, g, g) + inline val agb get() = Vector3i(a, g, b) + inline val aga get() = Vector3i(a, g, a) + inline val abr get() = Vector3i(a, b, r) + inline val abg get() = Vector3i(a, b, g) + inline val abb get() = Vector3i(a, b, b) + inline val aba get() = Vector3i(a, b, a) + inline val aar get() = Vector3i(a, a, r) + inline val aag get() = Vector3i(a, a, g) + inline val aab get() = Vector3i(a, a, b) + inline val aaa get() = Vector3i(a, a, a) + inline val rrrr get() = Vector4i(r, r, r, r) + inline val rrrg get() = Vector4i(r, r, r, g) + inline val rrrb get() = Vector4i(r, r, r, b) + inline val rrra get() = Vector4i(r, r, r, a) + inline val rrgr get() = Vector4i(r, r, g, r) + inline val rrgg get() = Vector4i(r, r, g, g) + inline val rrgb get() = Vector4i(r, r, g, b) + inline val rrga get() = Vector4i(r, r, g, a) + inline val rrbr get() = Vector4i(r, r, b, r) + inline val rrbg get() = Vector4i(r, r, b, g) + inline val rrbb get() = Vector4i(r, r, b, b) + inline val rrba get() = Vector4i(r, r, b, a) + inline val rrar get() = Vector4i(r, r, a, r) + inline val rrag get() = Vector4i(r, r, a, g) + inline val rrab get() = Vector4i(r, r, a, b) + inline val rraa get() = Vector4i(r, r, a, a) + inline val rgrr get() = Vector4i(r, g, r, r) + inline val rgrg get() = Vector4i(r, g, r, g) + inline val rgrb get() = Vector4i(r, g, r, b) + inline val rgra get() = Vector4i(r, g, r, a) + inline val rggr get() = Vector4i(r, g, g, r) + inline val rggg get() = Vector4i(r, g, g, g) + inline val rggb get() = Vector4i(r, g, g, b) + inline val rgga get() = Vector4i(r, g, g, a) + inline val rgbr get() = Vector4i(r, g, b, r) + inline val rgbg get() = Vector4i(r, g, b, g) + inline val rgbb get() = Vector4i(r, g, b, b) + inline val rgba get() = Vector4i(r, g, b, a) + inline val rgar get() = Vector4i(r, g, a, r) + inline val rgag get() = Vector4i(r, g, a, g) + inline val rgab get() = Vector4i(r, g, a, b) + inline val rgaa get() = Vector4i(r, g, a, a) + inline val rbrr get() = Vector4i(r, b, r, r) + inline val rbrg get() = Vector4i(r, b, r, g) + inline val rbrb get() = Vector4i(r, b, r, b) + inline val rbra get() = Vector4i(r, b, r, a) + inline val rbgr get() = Vector4i(r, b, g, r) + inline val rbgg get() = Vector4i(r, b, g, g) + inline val rbgb get() = Vector4i(r, b, g, b) + inline val rbga get() = Vector4i(r, b, g, a) + inline val rbbr get() = Vector4i(r, b, b, r) + inline val rbbg get() = Vector4i(r, b, b, g) + inline val rbbb get() = Vector4i(r, b, b, b) + inline val rbba get() = Vector4i(r, b, b, a) + inline val rbar get() = Vector4i(r, b, a, r) + inline val rbag get() = Vector4i(r, b, a, g) + inline val rbab get() = Vector4i(r, b, a, b) + inline val rbaa get() = Vector4i(r, b, a, a) + inline val rarr get() = Vector4i(r, a, r, r) + inline val rarg get() = Vector4i(r, a, r, g) + inline val rarb get() = Vector4i(r, a, r, b) + inline val rara get() = Vector4i(r, a, r, a) + inline val ragr get() = Vector4i(r, a, g, r) + inline val ragg get() = Vector4i(r, a, g, g) + inline val ragb get() = Vector4i(r, a, g, b) + inline val raga get() = Vector4i(r, a, g, a) + inline val rabr get() = Vector4i(r, a, b, r) + inline val rabg get() = Vector4i(r, a, b, g) + inline val rabb get() = Vector4i(r, a, b, b) + inline val raba get() = Vector4i(r, a, b, a) + inline val raar get() = Vector4i(r, a, a, r) + inline val raag get() = Vector4i(r, a, a, g) + inline val raab get() = Vector4i(r, a, a, b) + inline val raaa get() = Vector4i(r, a, a, a) + inline val grrr get() = Vector4i(g, r, r, r) + inline val grrg get() = Vector4i(g, r, r, g) + inline val grrb get() = Vector4i(g, r, r, b) + inline val grra get() = Vector4i(g, r, r, a) + inline val grgr get() = Vector4i(g, r, g, r) + inline val grgg get() = Vector4i(g, r, g, g) + inline val grgb get() = Vector4i(g, r, g, b) + inline val grga get() = Vector4i(g, r, g, a) + inline val grbr get() = Vector4i(g, r, b, r) + inline val grbg get() = Vector4i(g, r, b, g) + inline val grbb get() = Vector4i(g, r, b, b) + inline val grba get() = Vector4i(g, r, b, a) + inline val grar get() = Vector4i(g, r, a, r) + inline val grag get() = Vector4i(g, r, a, g) + inline val grab get() = Vector4i(g, r, a, b) + inline val graa get() = Vector4i(g, r, a, a) + inline val ggrr get() = Vector4i(g, g, r, r) + inline val ggrg get() = Vector4i(g, g, r, g) + inline val ggrb get() = Vector4i(g, g, r, b) + inline val ggra get() = Vector4i(g, g, r, a) + inline val gggr get() = Vector4i(g, g, g, r) + inline val gggg get() = Vector4i(g, g, g, g) + inline val gggb get() = Vector4i(g, g, g, b) + inline val ggga get() = Vector4i(g, g, g, a) + inline val ggbr get() = Vector4i(g, g, b, r) + inline val ggbg get() = Vector4i(g, g, b, g) + inline val ggbb get() = Vector4i(g, g, b, b) + inline val ggba get() = Vector4i(g, g, b, a) + inline val ggar get() = Vector4i(g, g, a, r) + inline val ggag get() = Vector4i(g, g, a, g) + inline val ggab get() = Vector4i(g, g, a, b) + inline val ggaa get() = Vector4i(g, g, a, a) + inline val gbrr get() = Vector4i(g, b, r, r) + inline val gbrg get() = Vector4i(g, b, r, g) + inline val gbrb get() = Vector4i(g, b, r, b) + inline val gbra get() = Vector4i(g, b, r, a) + inline val gbgr get() = Vector4i(g, b, g, r) + inline val gbgg get() = Vector4i(g, b, g, g) + inline val gbgb get() = Vector4i(g, b, g, b) + inline val gbga get() = Vector4i(g, b, g, a) + inline val gbbr get() = Vector4i(g, b, b, r) + inline val gbbg get() = Vector4i(g, b, b, g) + inline val gbbb get() = Vector4i(g, b, b, b) + inline val gbba get() = Vector4i(g, b, b, a) + inline val gbar get() = Vector4i(g, b, a, r) + inline val gbag get() = Vector4i(g, b, a, g) + inline val gbab get() = Vector4i(g, b, a, b) + inline val gbaa get() = Vector4i(g, b, a, a) + inline val garr get() = Vector4i(g, a, r, r) + inline val garg get() = Vector4i(g, a, r, g) + inline val garb get() = Vector4i(g, a, r, b) + inline val gara get() = Vector4i(g, a, r, a) + inline val gagr get() = Vector4i(g, a, g, r) + inline val gagg get() = Vector4i(g, a, g, g) + inline val gagb get() = Vector4i(g, a, g, b) + inline val gaga get() = Vector4i(g, a, g, a) + inline val gabr get() = Vector4i(g, a, b, r) + inline val gabg get() = Vector4i(g, a, b, g) + inline val gabb get() = Vector4i(g, a, b, b) + inline val gaba get() = Vector4i(g, a, b, a) + inline val gaar get() = Vector4i(g, a, a, r) + inline val gaag get() = Vector4i(g, a, a, g) + inline val gaab get() = Vector4i(g, a, a, b) + inline val gaaa get() = Vector4i(g, a, a, a) + inline val brrr get() = Vector4i(b, r, r, r) + inline val brrg get() = Vector4i(b, r, r, g) + inline val brrb get() = Vector4i(b, r, r, b) + inline val brra get() = Vector4i(b, r, r, a) + inline val brgr get() = Vector4i(b, r, g, r) + inline val brgg get() = Vector4i(b, r, g, g) + inline val brgb get() = Vector4i(b, r, g, b) + inline val brga get() = Vector4i(b, r, g, a) + inline val brbr get() = Vector4i(b, r, b, r) + inline val brbg get() = Vector4i(b, r, b, g) + inline val brbb get() = Vector4i(b, r, b, b) + inline val brba get() = Vector4i(b, r, b, a) + inline val brar get() = Vector4i(b, r, a, r) + inline val brag get() = Vector4i(b, r, a, g) + inline val brab get() = Vector4i(b, r, a, b) + inline val braa get() = Vector4i(b, r, a, a) + inline val bgrr get() = Vector4i(b, g, r, r) + inline val bgrg get() = Vector4i(b, g, r, g) + inline val bgrb get() = Vector4i(b, g, r, b) + inline val bgra get() = Vector4i(b, g, r, a) + inline val bggr get() = Vector4i(b, g, g, r) + inline val bggg get() = Vector4i(b, g, g, g) + inline val bggb get() = Vector4i(b, g, g, b) + inline val bgga get() = Vector4i(b, g, g, a) + inline val bgbr get() = Vector4i(b, g, b, r) + inline val bgbg get() = Vector4i(b, g, b, g) + inline val bgbb get() = Vector4i(b, g, b, b) + inline val bgba get() = Vector4i(b, g, b, a) + inline val bgar get() = Vector4i(b, g, a, r) + inline val bgag get() = Vector4i(b, g, a, g) + inline val bgab get() = Vector4i(b, g, a, b) + inline val bgaa get() = Vector4i(b, g, a, a) + inline val bbrr get() = Vector4i(b, b, r, r) + inline val bbrg get() = Vector4i(b, b, r, g) + inline val bbrb get() = Vector4i(b, b, r, b) + inline val bbra get() = Vector4i(b, b, r, a) + inline val bbgr get() = Vector4i(b, b, g, r) + inline val bbgg get() = Vector4i(b, b, g, g) + inline val bbgb get() = Vector4i(b, b, g, b) + inline val bbga get() = Vector4i(b, b, g, a) + inline val bbbr get() = Vector4i(b, b, b, r) + inline val bbbg get() = Vector4i(b, b, b, g) + inline val bbbb get() = Vector4i(b, b, b, b) + inline val bbba get() = Vector4i(b, b, b, a) + inline val bbar get() = Vector4i(b, b, a, r) + inline val bbag get() = Vector4i(b, b, a, g) + inline val bbab get() = Vector4i(b, b, a, b) + inline val bbaa get() = Vector4i(b, b, a, a) + inline val barr get() = Vector4i(b, a, r, r) + inline val barg get() = Vector4i(b, a, r, g) + inline val barb get() = Vector4i(b, a, r, b) + inline val bara get() = Vector4i(b, a, r, a) + inline val bagr get() = Vector4i(b, a, g, r) + inline val bagg get() = Vector4i(b, a, g, g) + inline val bagb get() = Vector4i(b, a, g, b) + inline val baga get() = Vector4i(b, a, g, a) + inline val babr get() = Vector4i(b, a, b, r) + inline val babg get() = Vector4i(b, a, b, g) + inline val babb get() = Vector4i(b, a, b, b) + inline val baba get() = Vector4i(b, a, b, a) + inline val baar get() = Vector4i(b, a, a, r) + inline val baag get() = Vector4i(b, a, a, g) + inline val baab get() = Vector4i(b, a, a, b) + inline val baaa get() = Vector4i(b, a, a, a) + inline val arrr get() = Vector4i(a, r, r, r) + inline val arrg get() = Vector4i(a, r, r, g) + inline val arrb get() = Vector4i(a, r, r, b) + inline val arra get() = Vector4i(a, r, r, a) + inline val argr get() = Vector4i(a, r, g, r) + inline val argg get() = Vector4i(a, r, g, g) + inline val argb get() = Vector4i(a, r, g, b) + inline val arga get() = Vector4i(a, r, g, a) + inline val arbr get() = Vector4i(a, r, b, r) + inline val arbg get() = Vector4i(a, r, b, g) + inline val arbb get() = Vector4i(a, r, b, b) + inline val arba get() = Vector4i(a, r, b, a) + inline val arar get() = Vector4i(a, r, a, r) + inline val arag get() = Vector4i(a, r, a, g) + inline val arab get() = Vector4i(a, r, a, b) + inline val araa get() = Vector4i(a, r, a, a) + inline val agrr get() = Vector4i(a, g, r, r) + inline val agrg get() = Vector4i(a, g, r, g) + inline val agrb get() = Vector4i(a, g, r, b) + inline val agra get() = Vector4i(a, g, r, a) + inline val aggr get() = Vector4i(a, g, g, r) + inline val aggg get() = Vector4i(a, g, g, g) + inline val aggb get() = Vector4i(a, g, g, b) + inline val agga get() = Vector4i(a, g, g, a) + inline val agbr get() = Vector4i(a, g, b, r) + inline val agbg get() = Vector4i(a, g, b, g) + inline val agbb get() = Vector4i(a, g, b, b) + inline val agba get() = Vector4i(a, g, b, a) + inline val agar get() = Vector4i(a, g, a, r) + inline val agag get() = Vector4i(a, g, a, g) + inline val agab get() = Vector4i(a, g, a, b) + inline val agaa get() = Vector4i(a, g, a, a) + inline val abrr get() = Vector4i(a, b, r, r) + inline val abrg get() = Vector4i(a, b, r, g) + inline val abrb get() = Vector4i(a, b, r, b) + inline val abra get() = Vector4i(a, b, r, a) + inline val abgr get() = Vector4i(a, b, g, r) + inline val abgg get() = Vector4i(a, b, g, g) + inline val abgb get() = Vector4i(a, b, g, b) + inline val abga get() = Vector4i(a, b, g, a) + inline val abbr get() = Vector4i(a, b, b, r) + inline val abbg get() = Vector4i(a, b, b, g) + inline val abbb get() = Vector4i(a, b, b, b) + inline val abba get() = Vector4i(a, b, b, a) + inline val abar get() = Vector4i(a, b, a, r) + inline val abag get() = Vector4i(a, b, a, g) + inline val abab get() = Vector4i(a, b, a, b) + inline val abaa get() = Vector4i(a, b, a, a) + inline val aarr get() = Vector4i(a, a, r, r) + inline val aarg get() = Vector4i(a, a, r, g) + inline val aarb get() = Vector4i(a, a, r, b) + inline val aara get() = Vector4i(a, a, r, a) + inline val aagr get() = Vector4i(a, a, g, r) + inline val aagg get() = Vector4i(a, a, g, g) + inline val aagb get() = Vector4i(a, a, g, b) + inline val aaga get() = Vector4i(a, a, g, a) + inline val aabr get() = Vector4i(a, a, b, r) + inline val aabg get() = Vector4i(a, a, b, g) + inline val aabb get() = Vector4i(a, a, b, b) + inline val aaba get() = Vector4i(a, a, b, a) + inline val aaar get() = Vector4i(a, a, a, r) + inline val aaag get() = Vector4i(a, a, a, g) + inline val aaab get() = Vector4i(a, a, a, b) + inline val aaaa get() = Vector4i(a, a, a, a) + inline val ss get() = Vector2i(s, s) + inline val st get() = Vector2i(s, t) + inline val sp get() = Vector2i(s, p) + inline val sq get() = Vector2i(s, q) + inline val ts get() = Vector2i(t, s) + inline val tt get() = Vector2i(t, t) + inline val tp get() = Vector2i(t, p) + inline val tq get() = Vector2i(t, q) + inline val ps get() = Vector2i(p, s) + inline val pt get() = Vector2i(p, t) + inline val pp get() = Vector2i(p, p) + inline val pq get() = Vector2i(p, q) + inline val qs get() = Vector2i(q, s) + inline val qt get() = Vector2i(q, t) + inline val qp get() = Vector2i(q, p) + inline val qq get() = Vector2i(q, q) + inline val sss get() = Vector3i(s, s, s) + inline val sst get() = Vector3i(s, s, t) + inline val ssp get() = Vector3i(s, s, p) + inline val ssq get() = Vector3i(s, s, q) + inline val sts get() = Vector3i(s, t, s) + inline val stt get() = Vector3i(s, t, t) + inline val stp get() = Vector3i(s, t, p) + inline val stq get() = Vector3i(s, t, q) + inline val sps get() = Vector3i(s, p, s) + inline val spt get() = Vector3i(s, p, t) + inline val spp get() = Vector3i(s, p, p) + inline val spq get() = Vector3i(s, p, q) + inline val sqs get() = Vector3i(s, q, s) + inline val sqt get() = Vector3i(s, q, t) + inline val sqp get() = Vector3i(s, q, p) + inline val sqq get() = Vector3i(s, q, q) + inline val tss get() = Vector3i(t, s, s) + inline val tst get() = Vector3i(t, s, t) + inline val tsp get() = Vector3i(t, s, p) + inline val tsq get() = Vector3i(t, s, q) + inline val tts get() = Vector3i(t, t, s) + inline val ttt get() = Vector3i(t, t, t) + inline val ttp get() = Vector3i(t, t, p) + inline val ttq get() = Vector3i(t, t, q) + inline val tps get() = Vector3i(t, p, s) + inline val tpt get() = Vector3i(t, p, t) + inline val tpp get() = Vector3i(t, p, p) + inline val tpq get() = Vector3i(t, p, q) + inline val tqs get() = Vector3i(t, q, s) + inline val tqt get() = Vector3i(t, q, t) + inline val tqp get() = Vector3i(t, q, p) + inline val tqq get() = Vector3i(t, q, q) + inline val pss get() = Vector3i(p, s, s) + inline val pst get() = Vector3i(p, s, t) + inline val psp get() = Vector3i(p, s, p) + inline val psq get() = Vector3i(p, s, q) + inline val pts get() = Vector3i(p, t, s) + inline val ptt get() = Vector3i(p, t, t) + inline val ptp get() = Vector3i(p, t, p) + inline val ptq get() = Vector3i(p, t, q) + inline val pps get() = Vector3i(p, p, s) + inline val ppt get() = Vector3i(p, p, t) + inline val ppp get() = Vector3i(p, p, p) + inline val ppq get() = Vector3i(p, p, q) + inline val pqs get() = Vector3i(p, q, s) + inline val pqt get() = Vector3i(p, q, t) + inline val pqp get() = Vector3i(p, q, p) + inline val pqq get() = Vector3i(p, q, q) + inline val qss get() = Vector3i(q, s, s) + inline val qst get() = Vector3i(q, s, t) + inline val qsp get() = Vector3i(q, s, p) + inline val qsq get() = Vector3i(q, s, q) + inline val qts get() = Vector3i(q, t, s) + inline val qtt get() = Vector3i(q, t, t) + inline val qtp get() = Vector3i(q, t, p) + inline val qtq get() = Vector3i(q, t, q) + inline val qps get() = Vector3i(q, p, s) + inline val qpt get() = Vector3i(q, p, t) + inline val qpp get() = Vector3i(q, p, p) + inline val qpq get() = Vector3i(q, p, q) + inline val qqs get() = Vector3i(q, q, s) + inline val qqt get() = Vector3i(q, q, t) + inline val qqp get() = Vector3i(q, q, p) + inline val qqq get() = Vector3i(q, q, q) + inline val ssss get() = Vector4i(s, s, s, s) + inline val ssst get() = Vector4i(s, s, s, t) + inline val sssp get() = Vector4i(s, s, s, p) + inline val sssq get() = Vector4i(s, s, s, q) + inline val ssts get() = Vector4i(s, s, t, s) + inline val sstt get() = Vector4i(s, s, t, t) + inline val sstp get() = Vector4i(s, s, t, p) + inline val sstq get() = Vector4i(s, s, t, q) + inline val ssps get() = Vector4i(s, s, p, s) + inline val sspt get() = Vector4i(s, s, p, t) + inline val sspp get() = Vector4i(s, s, p, p) + inline val sspq get() = Vector4i(s, s, p, q) + inline val ssqs get() = Vector4i(s, s, q, s) + inline val ssqt get() = Vector4i(s, s, q, t) + inline val ssqp get() = Vector4i(s, s, q, p) + inline val ssqq get() = Vector4i(s, s, q, q) + inline val stss get() = Vector4i(s, t, s, s) + inline val stst get() = Vector4i(s, t, s, t) + inline val stsp get() = Vector4i(s, t, s, p) + inline val stsq get() = Vector4i(s, t, s, q) + inline val stts get() = Vector4i(s, t, t, s) + inline val sttt get() = Vector4i(s, t, t, t) + inline val sttp get() = Vector4i(s, t, t, p) + inline val sttq get() = Vector4i(s, t, t, q) + inline val stps get() = Vector4i(s, t, p, s) + inline val stpt get() = Vector4i(s, t, p, t) + inline val stpp get() = Vector4i(s, t, p, p) + inline val stpq get() = Vector4i(s, t, p, q) + inline val stqs get() = Vector4i(s, t, q, s) + inline val stqt get() = Vector4i(s, t, q, t) + inline val stqp get() = Vector4i(s, t, q, p) + inline val stqq get() = Vector4i(s, t, q, q) + inline val spss get() = Vector4i(s, p, s, s) + inline val spst get() = Vector4i(s, p, s, t) + inline val spsp get() = Vector4i(s, p, s, p) + inline val spsq get() = Vector4i(s, p, s, q) + inline val spts get() = Vector4i(s, p, t, s) + inline val sptt get() = Vector4i(s, p, t, t) + inline val sptp get() = Vector4i(s, p, t, p) + inline val sptq get() = Vector4i(s, p, t, q) + inline val spps get() = Vector4i(s, p, p, s) + inline val sppt get() = Vector4i(s, p, p, t) + inline val sppp get() = Vector4i(s, p, p, p) + inline val sppq get() = Vector4i(s, p, p, q) + inline val spqs get() = Vector4i(s, p, q, s) + inline val spqt get() = Vector4i(s, p, q, t) + inline val spqp get() = Vector4i(s, p, q, p) + inline val spqq get() = Vector4i(s, p, q, q) + inline val sqss get() = Vector4i(s, q, s, s) + inline val sqst get() = Vector4i(s, q, s, t) + inline val sqsp get() = Vector4i(s, q, s, p) + inline val sqsq get() = Vector4i(s, q, s, q) + inline val sqts get() = Vector4i(s, q, t, s) + inline val sqtt get() = Vector4i(s, q, t, t) + inline val sqtp get() = Vector4i(s, q, t, p) + inline val sqtq get() = Vector4i(s, q, t, q) + inline val sqps get() = Vector4i(s, q, p, s) + inline val sqpt get() = Vector4i(s, q, p, t) + inline val sqpp get() = Vector4i(s, q, p, p) + inline val sqpq get() = Vector4i(s, q, p, q) + inline val sqqs get() = Vector4i(s, q, q, s) + inline val sqqt get() = Vector4i(s, q, q, t) + inline val sqqp get() = Vector4i(s, q, q, p) + inline val sqqq get() = Vector4i(s, q, q, q) + inline val tsss get() = Vector4i(t, s, s, s) + inline val tsst get() = Vector4i(t, s, s, t) + inline val tssp get() = Vector4i(t, s, s, p) + inline val tssq get() = Vector4i(t, s, s, q) + inline val tsts get() = Vector4i(t, s, t, s) + inline val tstt get() = Vector4i(t, s, t, t) + inline val tstp get() = Vector4i(t, s, t, p) + inline val tstq get() = Vector4i(t, s, t, q) + inline val tsps get() = Vector4i(t, s, p, s) + inline val tspt get() = Vector4i(t, s, p, t) + inline val tspp get() = Vector4i(t, s, p, p) + inline val tspq get() = Vector4i(t, s, p, q) + inline val tsqs get() = Vector4i(t, s, q, s) + inline val tsqt get() = Vector4i(t, s, q, t) + inline val tsqp get() = Vector4i(t, s, q, p) + inline val tsqq get() = Vector4i(t, s, q, q) + inline val ttss get() = Vector4i(t, t, s, s) + inline val ttst get() = Vector4i(t, t, s, t) + inline val ttsp get() = Vector4i(t, t, s, p) + inline val ttsq get() = Vector4i(t, t, s, q) + inline val ttts get() = Vector4i(t, t, t, s) + inline val tttt get() = Vector4i(t, t, t, t) + inline val tttp get() = Vector4i(t, t, t, p) + inline val tttq get() = Vector4i(t, t, t, q) + inline val ttps get() = Vector4i(t, t, p, s) + inline val ttpt get() = Vector4i(t, t, p, t) + inline val ttpp get() = Vector4i(t, t, p, p) + inline val ttpq get() = Vector4i(t, t, p, q) + inline val ttqs get() = Vector4i(t, t, q, s) + inline val ttqt get() = Vector4i(t, t, q, t) + inline val ttqp get() = Vector4i(t, t, q, p) + inline val ttqq get() = Vector4i(t, t, q, q) + inline val tpss get() = Vector4i(t, p, s, s) + inline val tpst get() = Vector4i(t, p, s, t) + inline val tpsp get() = Vector4i(t, p, s, p) + inline val tpsq get() = Vector4i(t, p, s, q) + inline val tpts get() = Vector4i(t, p, t, s) + inline val tptt get() = Vector4i(t, p, t, t) + inline val tptp get() = Vector4i(t, p, t, p) + inline val tptq get() = Vector4i(t, p, t, q) + inline val tpps get() = Vector4i(t, p, p, s) + inline val tppt get() = Vector4i(t, p, p, t) + inline val tppp get() = Vector4i(t, p, p, p) + inline val tppq get() = Vector4i(t, p, p, q) + inline val tpqs get() = Vector4i(t, p, q, s) + inline val tpqt get() = Vector4i(t, p, q, t) + inline val tpqp get() = Vector4i(t, p, q, p) + inline val tpqq get() = Vector4i(t, p, q, q) + inline val tqss get() = Vector4i(t, q, s, s) + inline val tqst get() = Vector4i(t, q, s, t) + inline val tqsp get() = Vector4i(t, q, s, p) + inline val tqsq get() = Vector4i(t, q, s, q) + inline val tqts get() = Vector4i(t, q, t, s) + inline val tqtt get() = Vector4i(t, q, t, t) + inline val tqtp get() = Vector4i(t, q, t, p) + inline val tqtq get() = Vector4i(t, q, t, q) + inline val tqps get() = Vector4i(t, q, p, s) + inline val tqpt get() = Vector4i(t, q, p, t) + inline val tqpp get() = Vector4i(t, q, p, p) + inline val tqpq get() = Vector4i(t, q, p, q) + inline val tqqs get() = Vector4i(t, q, q, s) + inline val tqqt get() = Vector4i(t, q, q, t) + inline val tqqp get() = Vector4i(t, q, q, p) + inline val tqqq get() = Vector4i(t, q, q, q) + inline val psss get() = Vector4i(p, s, s, s) + inline val psst get() = Vector4i(p, s, s, t) + inline val pssp get() = Vector4i(p, s, s, p) + inline val pssq get() = Vector4i(p, s, s, q) + inline val psts get() = Vector4i(p, s, t, s) + inline val pstt get() = Vector4i(p, s, t, t) + inline val pstp get() = Vector4i(p, s, t, p) + inline val pstq get() = Vector4i(p, s, t, q) + inline val psps get() = Vector4i(p, s, p, s) + inline val pspt get() = Vector4i(p, s, p, t) + inline val pspp get() = Vector4i(p, s, p, p) + inline val pspq get() = Vector4i(p, s, p, q) + inline val psqs get() = Vector4i(p, s, q, s) + inline val psqt get() = Vector4i(p, s, q, t) + inline val psqp get() = Vector4i(p, s, q, p) + inline val psqq get() = Vector4i(p, s, q, q) + inline val ptss get() = Vector4i(p, t, s, s) + inline val ptst get() = Vector4i(p, t, s, t) + inline val ptsp get() = Vector4i(p, t, s, p) + inline val ptsq get() = Vector4i(p, t, s, q) + inline val ptts get() = Vector4i(p, t, t, s) + inline val pttt get() = Vector4i(p, t, t, t) + inline val pttp get() = Vector4i(p, t, t, p) + inline val pttq get() = Vector4i(p, t, t, q) + inline val ptps get() = Vector4i(p, t, p, s) + inline val ptpt get() = Vector4i(p, t, p, t) + inline val ptpp get() = Vector4i(p, t, p, p) + inline val ptpq get() = Vector4i(p, t, p, q) + inline val ptqs get() = Vector4i(p, t, q, s) + inline val ptqt get() = Vector4i(p, t, q, t) + inline val ptqp get() = Vector4i(p, t, q, p) + inline val ptqq get() = Vector4i(p, t, q, q) + inline val ppss get() = Vector4i(p, p, s, s) + inline val ppst get() = Vector4i(p, p, s, t) + inline val ppsp get() = Vector4i(p, p, s, p) + inline val ppsq get() = Vector4i(p, p, s, q) + inline val ppts get() = Vector4i(p, p, t, s) + inline val pptt get() = Vector4i(p, p, t, t) + inline val pptp get() = Vector4i(p, p, t, p) + inline val pptq get() = Vector4i(p, p, t, q) + inline val ppps get() = Vector4i(p, p, p, s) + inline val pppt get() = Vector4i(p, p, p, t) + inline val pppp get() = Vector4i(p, p, p, p) + inline val pppq get() = Vector4i(p, p, p, q) + inline val ppqs get() = Vector4i(p, p, q, s) + inline val ppqt get() = Vector4i(p, p, q, t) + inline val ppqp get() = Vector4i(p, p, q, p) + inline val ppqq get() = Vector4i(p, p, q, q) + inline val pqss get() = Vector4i(p, q, s, s) + inline val pqst get() = Vector4i(p, q, s, t) + inline val pqsp get() = Vector4i(p, q, s, p) + inline val pqsq get() = Vector4i(p, q, s, q) + inline val pqts get() = Vector4i(p, q, t, s) + inline val pqtt get() = Vector4i(p, q, t, t) + inline val pqtp get() = Vector4i(p, q, t, p) + inline val pqtq get() = Vector4i(p, q, t, q) + inline val pqps get() = Vector4i(p, q, p, s) + inline val pqpt get() = Vector4i(p, q, p, t) + inline val pqpp get() = Vector4i(p, q, p, p) + inline val pqpq get() = Vector4i(p, q, p, q) + inline val pqqs get() = Vector4i(p, q, q, s) + inline val pqqt get() = Vector4i(p, q, q, t) + inline val pqqp get() = Vector4i(p, q, q, p) + inline val pqqq get() = Vector4i(p, q, q, q) + inline val qsss get() = Vector4i(q, s, s, s) + inline val qsst get() = Vector4i(q, s, s, t) + inline val qssp get() = Vector4i(q, s, s, p) + inline val qssq get() = Vector4i(q, s, s, q) + inline val qsts get() = Vector4i(q, s, t, s) + inline val qstt get() = Vector4i(q, s, t, t) + inline val qstp get() = Vector4i(q, s, t, p) + inline val qstq get() = Vector4i(q, s, t, q) + inline val qsps get() = Vector4i(q, s, p, s) + inline val qspt get() = Vector4i(q, s, p, t) + inline val qspp get() = Vector4i(q, s, p, p) + inline val qspq get() = Vector4i(q, s, p, q) + inline val qsqs get() = Vector4i(q, s, q, s) + inline val qsqt get() = Vector4i(q, s, q, t) + inline val qsqp get() = Vector4i(q, s, q, p) + inline val qsqq get() = Vector4i(q, s, q, q) + inline val qtss get() = Vector4i(q, t, s, s) + inline val qtst get() = Vector4i(q, t, s, t) + inline val qtsp get() = Vector4i(q, t, s, p) + inline val qtsq get() = Vector4i(q, t, s, q) + inline val qtts get() = Vector4i(q, t, t, s) + inline val qttt get() = Vector4i(q, t, t, t) + inline val qttp get() = Vector4i(q, t, t, p) + inline val qttq get() = Vector4i(q, t, t, q) + inline val qtps get() = Vector4i(q, t, p, s) + inline val qtpt get() = Vector4i(q, t, p, t) + inline val qtpp get() = Vector4i(q, t, p, p) + inline val qtpq get() = Vector4i(q, t, p, q) + inline val qtqs get() = Vector4i(q, t, q, s) + inline val qtqt get() = Vector4i(q, t, q, t) + inline val qtqp get() = Vector4i(q, t, q, p) + inline val qtqq get() = Vector4i(q, t, q, q) + inline val qpss get() = Vector4i(q, p, s, s) + inline val qpst get() = Vector4i(q, p, s, t) + inline val qpsp get() = Vector4i(q, p, s, p) + inline val qpsq get() = Vector4i(q, p, s, q) + inline val qpts get() = Vector4i(q, p, t, s) + inline val qptt get() = Vector4i(q, p, t, t) + inline val qptp get() = Vector4i(q, p, t, p) + inline val qptq get() = Vector4i(q, p, t, q) + inline val qpps get() = Vector4i(q, p, p, s) + inline val qppt get() = Vector4i(q, p, p, t) + inline val qppp get() = Vector4i(q, p, p, p) + inline val qppq get() = Vector4i(q, p, p, q) + inline val qpqs get() = Vector4i(q, p, q, s) + inline val qpqt get() = Vector4i(q, p, q, t) + inline val qpqp get() = Vector4i(q, p, q, p) + inline val qpqq get() = Vector4i(q, p, q, q) + inline val qqss get() = Vector4i(q, q, s, s) + inline val qqst get() = Vector4i(q, q, s, t) + inline val qqsp get() = Vector4i(q, q, s, p) + inline val qqsq get() = Vector4i(q, q, s, q) + inline val qqts get() = Vector4i(q, q, t, s) + inline val qqtt get() = Vector4i(q, q, t, t) + inline val qqtp get() = Vector4i(q, q, t, p) + inline val qqtq get() = Vector4i(q, q, t, q) + inline val qqps get() = Vector4i(q, q, p, s) + inline val qqpt get() = Vector4i(q, q, p, t) + inline val qqpp get() = Vector4i(q, q, p, p) + inline val qqpq get() = Vector4i(q, q, p, q) + inline val qqqs get() = Vector4i(q, q, q, s) + inline val qqqt get() = Vector4i(q, q, q, t) + inline val qqqp get() = Vector4i(q, q, q, p) + inline val qqqq get() = Vector4i(q, q, q, q) + + companion object { + @JvmField val ZERO = Vector4i() + @JvmField val POSITIVE_X = Vector4i(x = 1) + @JvmField val NEGATIVE_X = Vector4i(x = -1) + @JvmField val POSITIVE_Y = Vector4i(y = 1) + @JvmField val NEGATIVE_Y = Vector4i(y = -1) + @JvmField val POSITIVE_Z = Vector4i(z = 1) + @JvmField val NEGATIVE_Z = Vector4i(z = -1) + @JvmField val POSITIVE_W = Vector4i(w = 1) + @JvmField val NEGATIVE_W = Vector4i(w = -1) + } +} + +operator fun Int.times(other: Vector4i): Vector4i { + return Vector4i(this * other.x, this * other.y, this * other.z, this * other.w) +} + +operator fun Int.div(other: Vector4i): Vector4i { + return Vector4i(this / other.x, this / other.y, this / other.z, this / other.w) +} + +/** + * Mutable 3D Vector, representing three-dimensional coordinates as [Int]s + * + * It can be safely passed around to methods which expect immutable [Vector4i], **AND** do not store it, + * as mutable operations are separated from immutable ones + */ +open class MutableVector4i( + override var x: Int = 0, + override var y: Int = 0, + override var z: Int = 0, + override var w: Int = 0, +) : Vector4i(x, y, z, w), IMutableIntVector, IMutableWholeVector, IMutableVector, IMatrixSetterInt { + constructor(input: IStruct2i, z: Int = 0, w: Int = 0) : this(input.component1(), input.component2(), z, w) + constructor(x: Int, input: IStruct2i, w: Int = 0) : this(x, input.component1(), input.component2(), w) + constructor(x: Int, y: Int, input: IStruct2i) : this(x, y, input.component1(), input.component2()) + + constructor(input: IStruct3i, w: Int = 0) : this(input.component1(), input.component2(), input.component3(), w) + constructor(x: Int, input: IStruct3i) : this(x, input.component1(), input.component2(), input.component3()) + constructor(input: IStruct4i) : this(input.component1(), input.component2(), input.component3(), input.component4()) + + override fun set(column: Int, row: Int, value: Int) { + if (column != 0) { + throw IndexOutOfBoundsException("Vectors are 1 column matrices ($column given)") + } + + when (row) { + 0 -> x = value + 1 -> y = value + 2 -> z = value + 3 -> w = value + else -> throw IndexOutOfBoundsException("Row out of bounds: $row") + } + } + + override fun equals(other: Any?): Boolean { + if (this === other) return true + if (javaClass != other?.javaClass) return false + + other as MutableVector4i + + if (x != other.x) return false + if (y != other.y) return false + if (z != other.z) return false + if (w != other.w) return false + + return true + } + + override var r by this::x + override var g by this::y + override var b by this::z + override var a by this::w + + override var s by this::x + override var t by this::y + override var p by this::z + override var q by this::w + + override fun plusMut(other: Vector4i): MutableVector4i { + x += other.x + y += other.y + z += other.z + z += other.z + return this + } + + override fun minusMut(other: Vector4i): MutableVector4i { + x -= other.x + y -= other.y + z -= other.z + z -= other.z + return this + } + + override fun timesMut(other: Vector4i): MutableVector4i { + x *= other.x + y *= other.y + z *= other.z + z *= other.z + return this + } + + override fun divMut(other: Vector4i): MutableVector4i { + x /= other.x + y /= other.y + z /= other.z + z /= other.z + return this + } + + override fun timesMut(other: Int): MutableVector4i { + x *= other + y *= other + z *= other + z *= other + return this + } + + override fun divMut(other: Int): MutableVector4i { + x /= other + y /= other + z /= other + z /= other + return this + } +} diff --git a/src/test/kotlin/ru/dbotthepony/kstarbound/test/MathTests.kt b/src/test/kotlin/ru/dbotthepony/kstarbound/test/MathTests.kt index 9a9611ad..603058ec 100644 --- a/src/test/kotlin/ru/dbotthepony/kstarbound/test/MathTests.kt +++ b/src/test/kotlin/ru/dbotthepony/kstarbound/test/MathTests.kt @@ -7,6 +7,10 @@ import ru.dbotthepony.kstarbound.world.CHUNK_SIZE import ru.dbotthepony.kstarbound.world.CHUNK_SIZE_FF import ru.dbotthepony.kstarbound.world.CHUNK_SIZEd import ru.dbotthepony.kstarbound.world.ChunkPos +import ru.dbotthepony.kvector.matrix.matrixDeterminant +import ru.dbotthepony.kvector.matrix.multiplyMatrix +import ru.dbotthepony.kvector.matrix.generated.* +import ru.dbotthepony.kvector.narray.Double2Dimensional object MathTests { @Test @@ -109,4 +113,72 @@ object MathTests { check(ChunkPos.fromTilePosition(0, -CHUNK_SIZE_FF) == ChunkPos(0, -1)) { ChunkPos.fromTilePosition(0, -CHUNK_SIZE_FF) } check(ChunkPos.fromTilePosition(0, -CHUNK_SIZE) == ChunkPos(0, -2)) { ChunkPos.fromTilePosition(0, -CHUNK_SIZE) } } + + @Test + fun testMatrixMult() { + val matrix1 = Double2Dimensional(4, 2) + val matrix2 = Double2Dimensional(3, 4) + + matrix1[0, 0] = 3.0 + matrix1[1, 0] = 2.0 + matrix1[2, 0] = 1.0 + matrix1[3, 0] = 5.0 + + matrix1[0, 1] = 9.0 + matrix1[1, 1] = 1.0 + matrix1[2, 1] = 3.0 + matrix1[3, 1] = 0.0 + + matrix2[0, 0] = 2.0 + matrix2[1, 0] = 9.0 + matrix2[2, 0] = 0.0 + + matrix2[0, 1] = 1.0 + matrix2[1, 1] = 3.0 + matrix2[2, 1] = 5.0 + + matrix2[0, 2] = 2.0 + matrix2[1, 2] = 4.0 + matrix2[2, 2] = 7.0 + + matrix2[0, 3] = 8.0 + matrix2[1, 3] = 1.0 + matrix2[2, 3] = 5.0 + + val product = multiplyMatrix(matrix1, matrix2) + + check(product[0, 0] == 50.0) + check(product[1, 0] == 42.0) + check(product[2, 0] == 42.0) + + check(product[0, 1] == 25.0) + check(product[1, 1] == 96.0) + check(product[2, 1] == 26.0) + } + + @Test + fun testAlloc() { + System.gc() + + var t = System.currentTimeMillis() + var escape2 = 0.0 + + for (i in 0 .. 8000000) { + val matrix = Matrix4d() + escape2 += matrix[2, 3] + } + + println(System.currentTimeMillis() - t) + System.gc() + t = System.currentTimeMillis() + var escape = 0.0 + + for (i in 0 .. 8000000) { + val matrix = Double2Dimensional(4, 4) + escape += matrix[2, 3] + } + + println(System.currentTimeMillis() - t) + println(escape) + } }