aboutsummaryrefslogtreecommitdiffstats
path: root/src/zadd.c
blob: 73e5b42f87389eb5db173c40ee65b4db31f637aa (plain) (blame)
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
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
/* See LICENSE file for copyright and license details. */
#include "internals.h"


void
zadd_unsigned(z_t a, z_t b, z_t c)
{
	size_t i, size, n;
	uint32_t carry[] = {0, 0};
	zahl_char_t *addend;

	if (a == c) {
		zadd_unsigned(a, c, b);
		return;
	}

	size = MAX(b->used, c->used);
	ENSURE_SIZE(a, size + 1);
	a->chars[size] = 0;

	n = b->used + c->used - size;
	if (a == b) {
		if (a->used < c->used) {
			n = c->used;
			zmemset(a->chars + a->used, 0, n - a->used);
		}
		addend = c->chars;
	} else if (a == c) {
		if (a->used < b->used) {
			n = b->used;
			zmemset(a->chars + a->used, 0, n - a->used);
		}
		addend = b->chars;
	} else if (b->used > c->used) {
		zmemcpy(a->chars, b->chars, b->used);
		a->used = b->used;
		addend = c->chars;
	} else {
		zmemcpy(a->chars, c->chars, c->used);
		a->used = c->used;
		addend = b->chars;
	}

	for (i = 0; i < n; i++) {
		if (carry[i & 1])
			carry[~i & 1] = (ZAHL_CHAR_MAX - a->chars[i] <= addend[i]);
		else
			carry[~i & 1] = (ZAHL_CHAR_MAX - a->chars[i] < addend[i]);
		a->chars[i] += addend[i] + carry[i & 1];
	}

	while (carry[i & 1]) {
		carry[~i & 1] = a->chars[i] == ZAHL_CHAR_MAX;
		a->chars[i++] += 1;
	}

	if (a->used < i)
		a->used = i;
	SET_SIGNUM(a, !zzero(b) | !zzero(c));
}


void
zadd(z_t a, z_t b, z_t c)
{
	if (zzero(b)) {
		SET(a, c);
	} else if (zzero(c)) {
		SET(a, b);
	} else if (b == c) {
		zlsh(a, b, 1);
	} else if ((zsignum(b) | zsignum(c)) < 0) {
		if (zsignum(b) < 0) {
			if (zsignum(c) < 0) {
				zadd_unsigned(a, b, c);
				SET_SIGNUM(a, -zsignum(a));
			} else {
				zsub_unsigned(a, c, b);
			}
		} else {
			zsub_unsigned(a, b, c);
		}
	} else {
		zadd_unsigned(a, b, c);
	}
}