/* See LICENSE file for copyright and license details. */
#ifndef TYPE
#include "common.h"

USAGE("right-hand-stream")

#define FILE "blind-quaternion-product.c"
#include "define-functions.h"

int
main(int argc, char *argv[])
{
	struct stream left, right;
	void (*process)(struct stream *left, struct stream *right, size_t n);

	UNOFLAGS(argc != 1);

	eopen_stream(&left, NULL);
	eopen_stream(&right, argv[0]);

	SELECT_PROCESS_FUNCTION(&left);
	CHECK_ALPHA_CHAN(&left);
	CHECK_N_CHAN(&left, 4, 4);

	fprint_stream_head(stdout, &left);
	efflush(stdout, "<stdout>");
	process_two_streams(&left, &right, STDOUT_FILENO, "<stdout>", process);
	return 0;
}

#else

static void
PROCESS(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;
	}
}

#endif