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, 55 insertions, 0 deletions

diff --git a/src/blind-dot-product.c b/src/blind-dot-product.c
new file mode 100644
index 0000000..044b7bf
--- /dev/null
+++ b/src/blind-dot-product.c
@@ -0,0 +1,55 @@
+/* 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;\
+		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;\
+			*lx = *ly = *lz = *la = *lx * *rx + *ly * *ry + *lz * *rz + *la * *ra;\
+		}\
+	}
+
+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;
+}