Add blind-{,un}premultiply, blind-{dot,cross,quaternion}-product, and blind-vector-projection

Signed-off-by: Mattias Andrée <maandree@kth.se>

1 files changed, 62 insertions, 0 deletions

diff --git a/src/blind-quaternion-product.c b/src/blind-quaternion-product.c
new file mode 100644
index 0000000..6d24e24
--- /dev/null
+++ b/src/blind-quaternion-product.c
@@ -0,0 +1,62 @@
+/* See LICENSE file for copyright and license details. */
+#include "common.h"
+
+USAGE("right-hand-stream")
+
+#if defined(__GNUC__) && !defined(__clang__)
+# pragma GCC diagnostic push
+# pragma GCC diagnostic ignored "-Wunsafe-loop-optimizations"
+#endif
+
+#define PROCESS(TYPE, SUFFIX)\
+	static void\
+	process_##SUFFIX(struct stream *left, struct stream *right, size_t n)\
+	{\
+		size_t i;\
+		TYPE *lx, *ly, *lz, *la, *rx, *ry, *rz, *ra, x, y, z, a;\
+		for (i = 0; i < n; i += 4 * sizeof(TYPE)) {\
+			lx = ((TYPE *)(left->buf + i)) + 0, rx = ((TYPE *)(right->buf + i)) + 0;\
+			ly = ((TYPE *)(left->buf + i)) + 1, ry = ((TYPE *)(right->buf + i)) + 1;\
+			lz = ((TYPE *)(left->buf + i)) + 2, rz = ((TYPE *)(right->buf + i)) + 2;\
+			la = ((TYPE *)(left->buf + i)) + 3, ra = ((TYPE *)(right->buf + i)) + 3;\
+			x = *lx * *rx - *ly * *ry - *lz * *rz - *la * *ra;\
+			y = *lz * *ra - *la * *rz + *lx * *ry + *ly * *rx;\
+			z = *la * *ry - *ly * *rz + *lx * *rz + *lz * *rx;\
+			a = *ly * *rz - *lz * *rz + *lx * *ra + *la * *rx;\
+			*lx = x;\
+			*ly = y;\
+			*lz = z;\
+			*la = a;\
+		}\
+	}
+
+PROCESS(double, lf)
+PROCESS(float, f)
+
+#if defined(__GNUC__) && !defined(__clang__)
+# pragma GCC diagnostic pop
+#endif
+
+int
+main(int argc, char *argv[])
+{
+	struct stream left, right;
+	void (*process)(struct stream *left, struct stream *right, size_t n);
+
+	UNOFLAGS(argc != 2);
+
+	eopen_stream(&left, NULL);
+	eopen_stream(&right, argv[1]);
+
+	if (!strcmp(left.pixfmt, "xyza"))
+		process = process_lf;
+	else if (!strcmp(left.pixfmt, "xyza f"))
+		process = process_f;
+	else
+		eprintf("pixel format %s is not supported, try xyza\n", left.pixfmt);
+
+	fprint_stream_head(stdout, &left);
+	efflush(stdout, "<stdout>");
+	process_two_streams(&left, &right, STDOUT_FILENO, "<stdout>", process);
+	return 0;
+}