1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
|
/* 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
|