aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorCedric BAIL <cedric@osg.samsung.com>2015-06-24 18:57:46 +0200
committerCedric BAIL <cedric@osg.samsung.com>2015-08-21 16:40:31 +0200
commitbb926e2dc72740a5c6eac9954be91f1d12bc492a (patch)
treea3aaef8878dfa39372812939e26ab7da136a985d
parenteina: test eina_matrix4_normalized. (diff)
downloadefl-bb926e2dc72740a5c6eac9954be91f1d12bc492a.tar.gz
eina: add eina_matrix4_inverse.
-rw-r--r--src/lib/eina/eina_matrix.c163
-rw-r--r--src/lib/eina/eina_matrix.h10
2 files changed, 173 insertions, 0 deletions
diff --git a/src/lib/eina/eina_matrix.c b/src/lib/eina/eina_matrix.c
index a43c5b294f..62190041cf 100644
--- a/src/lib/eina/eina_matrix.c
+++ b/src/lib/eina/eina_matrix.c
@@ -752,3 +752,166 @@ eina_matrix4_normalized(Eina_Matrix4 *out, const Eina_Matrix4 *in)
return EINA_TRUE;
}
+
+EAPI Eina_Bool
+eina_matrix4_inverse(Eina_Matrix4 *out, const Eina_Matrix4 *in)
+{
+ double det;
+
+ MATRIX_XX(out) =
+ MATRIX_YY(in) * MATRIX_ZZ(in) * MATRIX_WW(in)
+ - MATRIX_YY(in) * MATRIX_ZW(in) * MATRIX_WZ(in)
+ - MATRIX_ZY(in) * MATRIX_YZ(in) * MATRIX_WW(in)
+ + MATRIX_ZY(in) * MATRIX_YW(in) * MATRIX_WZ(in)
+ + MATRIX_WY(in) * MATRIX_YZ(in) * MATRIX_ZW(in)
+ - MATRIX_WY(in) * MATRIX_YW(in) * MATRIX_ZZ(in);
+
+ MATRIX_YX(out) =
+ - MATRIX_YX(in) * MATRIX_ZZ(in) * MATRIX_WW(in)
+ + MATRIX_YX(in) * MATRIX_ZW(in) * MATRIX_WZ(in)
+ + MATRIX_ZX(in) * MATRIX_YZ(in) * MATRIX_WW(in)
+ - MATRIX_ZX(in) * MATRIX_YW(in) * MATRIX_WZ(in)
+ - MATRIX_WX(in) * MATRIX_YZ(in) * MATRIX_ZW(in)
+ + MATRIX_WX(in) * MATRIX_YW(in) * MATRIX_ZZ(in);
+
+ MATRIX_ZX(out) =
+ MATRIX_YX(in) * MATRIX_ZY(in) * MATRIX_WW(in)
+ - MATRIX_YX(in) * MATRIX_ZW(in) * MATRIX_WY(in)
+ - MATRIX_ZX(in) * MATRIX_YY(in) * MATRIX_WW(in)
+ + MATRIX_ZX(in) * MATRIX_YW(in) * MATRIX_WY(in)
+ + MATRIX_WX(in) * MATRIX_YY(in) * MATRIX_ZW(in)
+ - MATRIX_WX(in) * MATRIX_YW(in) * MATRIX_ZY(in);
+
+ MATRIX_WX(out) =
+ - MATRIX_YX(in) * MATRIX_ZY(in) * MATRIX_WZ(in)
+ + MATRIX_YX(in) * MATRIX_ZZ(in) * MATRIX_WY(in)
+ + MATRIX_ZX(in) * MATRIX_YY(in) * MATRIX_WZ(in)
+ - MATRIX_ZX(in) * MATRIX_YZ(in) * MATRIX_WY(in)
+ - MATRIX_WX(in) * MATRIX_YY(in) * MATRIX_ZZ(in)
+ + MATRIX_WX(in) * MATRIX_YZ(in) * MATRIX_ZY(in);
+
+ MATRIX_XY(out) =
+ - MATRIX_XY(in) * MATRIX_ZZ(in) * MATRIX_WW(in)
+ + MATRIX_XY(in) * MATRIX_ZW(in) * MATRIX_WZ(in)
+ + MATRIX_ZY(in) * MATRIX_XZ(in) * MATRIX_WW(in)
+ - MATRIX_ZY(in) * MATRIX_XW(in) * MATRIX_WZ(in)
+ - MATRIX_WY(in) * MATRIX_XZ(in) * MATRIX_ZW(in)
+ + MATRIX_WY(in) * MATRIX_XW(in) * MATRIX_ZZ(in);
+
+ MATRIX_YY(out) =
+ MATRIX_XX(in) * MATRIX_ZZ(in) * MATRIX_WW(in)
+ - MATRIX_XX(in) * MATRIX_ZW(in) * MATRIX_WZ(in)
+ - MATRIX_ZX(in) * MATRIX_XZ(in) * MATRIX_WW(in)
+ + MATRIX_ZX(in) * MATRIX_XW(in) * MATRIX_WZ(in)
+ + MATRIX_WX(in) * MATRIX_XZ(in) * MATRIX_ZW(in)
+ - MATRIX_WX(in) * MATRIX_XW(in) * MATRIX_ZZ(in);
+
+ MATRIX_ZY(out) =
+ - MATRIX_XX(in) * MATRIX_ZY(in) * MATRIX_WW(in)
+ + MATRIX_XX(in) * MATRIX_ZW(in) * MATRIX_WY(in)
+ + MATRIX_ZX(in) * MATRIX_XY(in) * MATRIX_WW(in)
+ - MATRIX_ZX(in) * MATRIX_XW(in) * MATRIX_WY(in)
+ - MATRIX_WX(in) * MATRIX_XY(in) * MATRIX_ZW(in)
+ + MATRIX_WX(in) * MATRIX_XW(in) * MATRIX_ZY(in);
+
+ MATRIX_WY(out) =
+ MATRIX_XX(in) * MATRIX_ZY(in) * MATRIX_WZ(in)
+ - MATRIX_XX(in) * MATRIX_ZZ(in) * MATRIX_WY(in)
+ - MATRIX_ZX(in) * MATRIX_XY(in) * MATRIX_WZ(in)
+ + MATRIX_ZX(in) * MATRIX_XZ(in) * MATRIX_WY(in)
+ + MATRIX_WX(in) * MATRIX_XY(in) * MATRIX_ZZ(in)
+ - MATRIX_WX(in) * MATRIX_XZ(in) * MATRIX_ZY(in);
+
+ MATRIX_XZ(out) =
+ MATRIX_XY(in) * MATRIX_YZ(in) * MATRIX_WW(in)
+ - MATRIX_XY(in) * MATRIX_YW(in) * MATRIX_WZ(in)
+ - MATRIX_YY(in) * MATRIX_XZ(in) * MATRIX_WW(in)
+ + MATRIX_YY(in) * MATRIX_XW(in) * MATRIX_WZ(in)
+ + MATRIX_WY(in) * MATRIX_XZ(in) * MATRIX_YW(in)
+ - MATRIX_WY(in) * MATRIX_XW(in) * MATRIX_YZ(in);
+
+ MATRIX_YZ(out) =
+ - MATRIX_XX(in) * MATRIX_YZ(in) * MATRIX_WW(in)
+ + MATRIX_XX(in) * MATRIX_YW(in) * MATRIX_WZ(in)
+ + MATRIX_YX(in) * MATRIX_XZ(in) * MATRIX_WW(in)
+ - MATRIX_YX(in) * MATRIX_XW(in) * MATRIX_WZ(in)
+ - MATRIX_WX(in) * MATRIX_XZ(in) * MATRIX_YW(in)
+ + MATRIX_WX(in) * MATRIX_XW(in) * MATRIX_YZ(in);
+
+ MATRIX_ZZ(out) =
+ MATRIX_XX(in) * MATRIX_YY(in) * MATRIX_WW(in)
+ - MATRIX_XX(in) * MATRIX_YW(in) * MATRIX_WY(in)
+ - MATRIX_YX(in) * MATRIX_XY(in) * MATRIX_WW(in)
+ + MATRIX_YX(in) * MATRIX_XW(in) * MATRIX_WY(in)
+ + MATRIX_WX(in) * MATRIX_XY(in) * MATRIX_YW(in)
+ - MATRIX_WX(in) * MATRIX_XW(in) * MATRIX_YY(in);
+
+ MATRIX_WZ(out) =
+ - MATRIX_XX(in) * MATRIX_YY(in) * MATRIX_WZ(in)
+ + MATRIX_XX(in) * MATRIX_YZ(in) * MATRIX_WY(in)
+ + MATRIX_YX(in) * MATRIX_XY(in) * MATRIX_WZ(in)
+ - MATRIX_YX(in) * MATRIX_XZ(in) * MATRIX_WY(in)
+ - MATRIX_WX(in) * MATRIX_XY(in) * MATRIX_YZ(in)
+ + MATRIX_WX(in) * MATRIX_XZ(in) * MATRIX_YY(in);
+
+ MATRIX_XW(out) =
+ - MATRIX_XY(in) * MATRIX_YZ(in) * MATRIX_ZW(in)
+ + MATRIX_XY(in) * MATRIX_YW(in) * MATRIX_ZZ(in)
+ + MATRIX_YY(in) * MATRIX_XZ(in) * MATRIX_ZW(in)
+ - MATRIX_YY(in) * MATRIX_XW(in) * MATRIX_ZZ(in)
+ - MATRIX_ZY(in) * MATRIX_XZ(in) * MATRIX_YW(in)
+ + MATRIX_ZY(in) * MATRIX_XW(in) * MATRIX_YZ(in);
+
+ MATRIX_YW(out) =
+ MATRIX_XX(in) * MATRIX_YZ(in) * MATRIX_ZW(in)
+ - MATRIX_XX(in) * MATRIX_YW(in) * MATRIX_ZZ(in)
+ - MATRIX_YX(in) * MATRIX_XZ(in) * MATRIX_ZW(in)
+ + MATRIX_YX(in) * MATRIX_XW(in) * MATRIX_ZZ(in)
+ + MATRIX_ZX(in) * MATRIX_XZ(in) * MATRIX_YW(in)
+ - MATRIX_ZX(in) * MATRIX_XW(in) * MATRIX_YZ(in);
+
+ MATRIX_ZW(out) =
+ - MATRIX_XX(in) * MATRIX_YY(in) * MATRIX_ZW(in)
+ + MATRIX_XX(in) * MATRIX_YW(in) * MATRIX_ZY(in)
+ + MATRIX_YX(in) * MATRIX_XY(in) * MATRIX_ZW(in)
+ - MATRIX_YX(in) * MATRIX_XW(in) * MATRIX_ZY(in)
+ - MATRIX_ZX(in) * MATRIX_XY(in) * MATRIX_YW(in)
+ + MATRIX_ZX(in) * MATRIX_XW(in) * MATRIX_YY(in);
+
+ MATRIX_WW(out) =
+ MATRIX_XX(in) * MATRIX_YY(in) * MATRIX_ZZ(in)
+ - MATRIX_XX(in) * MATRIX_YZ(in) * MATRIX_ZY(in)
+ - MATRIX_YX(in) * MATRIX_XY(in) * MATRIX_ZZ(in)
+ + MATRIX_YX(in) * MATRIX_XZ(in) * MATRIX_ZY(in)
+ + MATRIX_ZX(in) * MATRIX_XY(in) * MATRIX_YZ(in)
+ - MATRIX_ZX(in) * MATRIX_XZ(in) * MATRIX_YY(in);
+
+ det =
+ MATRIX_XX(in) * MATRIX_XX(out)
+ + MATRIX_XY(in) * MATRIX_YX(out)
+ + MATRIX_XZ(in) * MATRIX_ZX(out)
+ + MATRIX_XW(in) * MATRIX_WX(out);
+
+ if (fabs(det) < DBL_EPSILON) return EINA_FALSE;
+
+ det = 1.0 / det;
+
+ MATRIX_XX(out) = MATRIX_XX(out) * det;
+ MATRIX_XY(out) = MATRIX_XY(out) * det;
+ MATRIX_XZ(out) = MATRIX_XZ(out) * det;
+ MATRIX_XW(out) = MATRIX_XW(out) * det;
+ MATRIX_YX(out) = MATRIX_YX(out) * det;
+ MATRIX_YY(out) = MATRIX_YY(out) * det;
+ MATRIX_YZ(out) = MATRIX_YZ(out) * det;
+ MATRIX_YW(out) = MATRIX_YW(out) * det;
+ MATRIX_ZX(out) = MATRIX_ZX(out) * det;
+ MATRIX_ZY(out) = MATRIX_ZY(out) * det;
+ MATRIX_ZZ(out) = MATRIX_ZZ(out) * det;
+ MATRIX_ZW(out) = MATRIX_ZW(out) * det;
+ MATRIX_WX(out) = MATRIX_WX(out) * det;
+ MATRIX_WY(out) = MATRIX_WY(out) * det;
+ MATRIX_WZ(out) = MATRIX_WZ(out) * det;
+ MATRIX_WW(out) = MATRIX_WW(out) * det;
+
+ return EINA_TRUE;
+}
diff --git a/src/lib/eina/eina_matrix.h b/src/lib/eina/eina_matrix.h
index bf02f17b5b..1f11be35ce 100644
--- a/src/lib/eina/eina_matrix.h
+++ b/src/lib/eina/eina_matrix.h
@@ -538,6 +538,16 @@ EAPI double eina_matrix4_determinant(const Eina_Matrix4 *m);
EAPI Eina_Bool eina_matrix4_normalized(Eina_Matrix4 *out,
const Eina_Matrix4 *in);
+/**
+ * @brief Return the inverse of the given matrix.
+ *
+ * @param out The inverse matrix
+ * @param in The matrix.
+ * @return @c EINA_TRUE on success, @c EINA_FALSE otherwise.
+ *
+ * @since 1.15
+ */
+EAPI Eina_Bool eina_matrix4_inverse(Eina_Matrix4 *out, const Eina_Matrix4 *in);
/**
* @brief Convert an Eina_Matrix4 into an Eina_Matrix3.