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#include <stdlib.h>
27#include <stdint.h>
28#include "host-utils.h"
29
30
31
32
33#if !defined(__x86_64__)
34static void add128 (uint64_t *plow, uint64_t *phigh, uint64_t a, uint64_t b)
35{
36 *plow += a;
37
38 if (*plow < a)
39 (*phigh)++;
40 *phigh += b;
41}
42
43static void neg128 (uint64_t *plow, uint64_t *phigh)
44{
45 *plow = ~*plow;
46 *phigh = ~*phigh;
47 add128(plow, phigh, 1, 0);
48}
49
50static void mul64 (uint64_t *plow, uint64_t *phigh, uint64_t a, uint64_t b)
51{
52 uint32_t a0, a1, b0, b1;
53 uint64_t v;
54
55 a0 = a;
56 a1 = a >> 32;
57
58 b0 = b;
59 b1 = b >> 32;
60
61 v = (uint64_t)a0 * (uint64_t)b0;
62 *plow = v;
63 *phigh = 0;
64
65 v = (uint64_t)a0 * (uint64_t)b1;
66 add128(plow, phigh, v << 32, v >> 32);
67
68 v = (uint64_t)a1 * (uint64_t)b0;
69 add128(plow, phigh, v << 32, v >> 32);
70
71 v = (uint64_t)a1 * (uint64_t)b1;
72 *phigh += v;
73}
74
75
76void mulu64 (uint64_t *plow, uint64_t *phigh, uint64_t a, uint64_t b)
77{
78 mul64(plow, phigh, a, b);
79#if defined(DEBUG_MULDIV)
80 printf("mulu64: 0x%016llx * 0x%016llx = 0x%016llx%016llx\n",
81 a, b, *phigh, *plow);
82#endif
83}
84
85
86void muls64 (uint64_t *plow, uint64_t *phigh, int64_t a, int64_t b)
87{
88 int sa, sb;
89
90 sa = (a < 0);
91 if (sa)
92 a = -a;
93 sb = (b < 0);
94 if (sb)
95 b = -b;
96 mul64(plow, phigh, a, b);
97 if (sa ^ sb) {
98 neg128(plow, phigh);
99 }
100#if defined(DEBUG_MULDIV)
101 printf("muls64: 0x%016llx * 0x%016llx = 0x%016llx%016llx\n",
102 a, b, *phigh, *plow);
103#endif
104}
105#endif
106