1 // SPDX-License-Identifier: GPL-2.0 1 // SPDX-License-Identifier: GPL-2.0
2 /* 2 /*
3 * Copyright (C) 2003 Bernardo Innocenti <bern 3 * Copyright (C) 2003 Bernardo Innocenti <bernie@develer.com>
4 * 4 *
5 * Based on former do_div() implementation fro 5 * Based on former do_div() implementation from asm-parisc/div64.h:
6 * Copyright (C) 1999 Hewlett-Packard Co 6 * Copyright (C) 1999 Hewlett-Packard Co
7 * Copyright (C) 1999 David Mosberger-Tan 7 * Copyright (C) 1999 David Mosberger-Tang <davidm@hpl.hp.com>
8 * 8 *
9 * 9 *
10 * Generic C version of 64bit/32bit division a 10 * Generic C version of 64bit/32bit division and modulo, with
11 * 64bit result and 32bit remainder. 11 * 64bit result and 32bit remainder.
12 * 12 *
13 * The fast case for (n>>32 == 0) is handled i 13 * The fast case for (n>>32 == 0) is handled inline by do_div().
14 * 14 *
15 * Code generated for this function might be v 15 * Code generated for this function might be very inefficient
16 * for some CPUs. __div64_32() can be overridd 16 * for some CPUs. __div64_32() can be overridden by linking arch-specific
17 * assembly versions such as arch/ppc/lib/div6 17 * assembly versions such as arch/ppc/lib/div64.S and arch/sh/lib/div64.S
18 * or by defining a preprocessor macro in arch 18 * or by defining a preprocessor macro in arch/include/asm/div64.h.
19 */ 19 */
20 20
21 #include <linux/bitops.h> <<
22 #include <linux/export.h> 21 #include <linux/export.h>
23 #include <linux/math.h> !! 22 #include <linux/kernel.h>
24 #include <linux/math64.h> 23 #include <linux/math64.h>
25 #include <linux/minmax.h> <<
26 #include <linux/log2.h> <<
27 24
28 /* Not needed on 64bit architectures */ 25 /* Not needed on 64bit architectures */
29 #if BITS_PER_LONG == 32 26 #if BITS_PER_LONG == 32
30 27
31 #ifndef __div64_32 28 #ifndef __div64_32
32 uint32_t __attribute__((weak)) __div64_32(uint 29 uint32_t __attribute__((weak)) __div64_32(uint64_t *n, uint32_t base)
33 { 30 {
34 uint64_t rem = *n; 31 uint64_t rem = *n;
35 uint64_t b = base; 32 uint64_t b = base;
36 uint64_t res, d = 1; 33 uint64_t res, d = 1;
37 uint32_t high = rem >> 32; 34 uint32_t high = rem >> 32;
38 35
39 /* Reduce the thing a bit first */ 36 /* Reduce the thing a bit first */
40 res = 0; 37 res = 0;
41 if (high >= base) { 38 if (high >= base) {
42 high /= base; 39 high /= base;
43 res = (uint64_t) high << 32; 40 res = (uint64_t) high << 32;
44 rem -= (uint64_t) (high*base) 41 rem -= (uint64_t) (high*base) << 32;
45 } 42 }
46 43
47 while ((int64_t)b > 0 && b < rem) { 44 while ((int64_t)b > 0 && b < rem) {
48 b = b+b; 45 b = b+b;
49 d = d+d; 46 d = d+d;
50 } 47 }
51 48
52 do { 49 do {
53 if (rem >= b) { 50 if (rem >= b) {
54 rem -= b; 51 rem -= b;
55 res += d; 52 res += d;
56 } 53 }
57 b >>= 1; 54 b >>= 1;
58 d >>= 1; 55 d >>= 1;
59 } while (d); 56 } while (d);
60 57
61 *n = res; 58 *n = res;
62 return rem; 59 return rem;
63 } 60 }
64 EXPORT_SYMBOL(__div64_32); 61 EXPORT_SYMBOL(__div64_32);
65 #endif 62 #endif
66 63
>> 64 /**
>> 65 * div_s64_rem - signed 64bit divide with 64bit divisor and remainder
>> 66 * @dividend: 64bit dividend
>> 67 * @divisor: 64bit divisor
>> 68 * @remainder: 64bit remainder
>> 69 */
67 #ifndef div_s64_rem 70 #ifndef div_s64_rem
68 s64 div_s64_rem(s64 dividend, s32 divisor, s32 71 s64 div_s64_rem(s64 dividend, s32 divisor, s32 *remainder)
69 { 72 {
70 u64 quotient; 73 u64 quotient;
71 74
72 if (dividend < 0) { 75 if (dividend < 0) {
73 quotient = div_u64_rem(-divide 76 quotient = div_u64_rem(-dividend, abs(divisor), (u32 *)remainder);
74 *remainder = -*remainder; 77 *remainder = -*remainder;
75 if (divisor > 0) 78 if (divisor > 0)
76 quotient = -quotient; 79 quotient = -quotient;
77 } else { 80 } else {
78 quotient = div_u64_rem(dividen 81 quotient = div_u64_rem(dividend, abs(divisor), (u32 *)remainder);
79 if (divisor < 0) 82 if (divisor < 0)
80 quotient = -quotient; 83 quotient = -quotient;
81 } 84 }
82 return quotient; 85 return quotient;
83 } 86 }
84 EXPORT_SYMBOL(div_s64_rem); 87 EXPORT_SYMBOL(div_s64_rem);
85 #endif 88 #endif
86 89
87 /* !! 90 /**
88 * div64_u64_rem - unsigned 64bit divide with 91 * div64_u64_rem - unsigned 64bit divide with 64bit divisor and remainder
89 * @dividend: 64bit dividend 92 * @dividend: 64bit dividend
90 * @divisor: 64bit divisor 93 * @divisor: 64bit divisor
91 * @remainder: 64bit remainder 94 * @remainder: 64bit remainder
92 * 95 *
93 * This implementation is a comparable to algo 96 * This implementation is a comparable to algorithm used by div64_u64.
94 * But this operation, which includes math for 97 * But this operation, which includes math for calculating the remainder,
95 * is kept distinct to avoid slowing down the 98 * is kept distinct to avoid slowing down the div64_u64 operation on 32bit
96 * systems. 99 * systems.
97 */ 100 */
98 #ifndef div64_u64_rem 101 #ifndef div64_u64_rem
99 u64 div64_u64_rem(u64 dividend, u64 divisor, u 102 u64 div64_u64_rem(u64 dividend, u64 divisor, u64 *remainder)
100 { 103 {
101 u32 high = divisor >> 32; 104 u32 high = divisor >> 32;
102 u64 quot; 105 u64 quot;
103 106
104 if (high == 0) { 107 if (high == 0) {
105 u32 rem32; 108 u32 rem32;
106 quot = div_u64_rem(dividend, d 109 quot = div_u64_rem(dividend, divisor, &rem32);
107 *remainder = rem32; 110 *remainder = rem32;
108 } else { 111 } else {
109 int n = fls(high); 112 int n = fls(high);
110 quot = div_u64(dividend >> n, 113 quot = div_u64(dividend >> n, divisor >> n);
111 114
112 if (quot != 0) 115 if (quot != 0)
113 quot--; 116 quot--;
114 117
115 *remainder = dividend - quot * 118 *remainder = dividend - quot * divisor;
116 if (*remainder >= divisor) { 119 if (*remainder >= divisor) {
117 quot++; 120 quot++;
118 *remainder -= divisor; 121 *remainder -= divisor;
119 } 122 }
120 } 123 }
121 124
122 return quot; 125 return quot;
123 } 126 }
124 EXPORT_SYMBOL(div64_u64_rem); 127 EXPORT_SYMBOL(div64_u64_rem);
125 #endif 128 #endif
126 129
127 /* !! 130 /**
128 * div64_u64 - unsigned 64bit divide with 64bi 131 * div64_u64 - unsigned 64bit divide with 64bit divisor
129 * @dividend: 64bit dividend 132 * @dividend: 64bit dividend
130 * @divisor: 64bit divisor 133 * @divisor: 64bit divisor
131 * 134 *
132 * This implementation is a modified version o 135 * This implementation is a modified version of the algorithm proposed
133 * by the book 'Hacker's Delight'. The origin 136 * by the book 'Hacker's Delight'. The original source and full proof
134 * can be found here and is available for use 137 * can be found here and is available for use without restriction.
135 * 138 *
136 * 'http://www.hackersdelight.org/hdcodetxt/di 139 * 'http://www.hackersdelight.org/hdcodetxt/divDouble.c.txt'
137 */ 140 */
138 #ifndef div64_u64 141 #ifndef div64_u64
139 u64 div64_u64(u64 dividend, u64 divisor) 142 u64 div64_u64(u64 dividend, u64 divisor)
140 { 143 {
141 u32 high = divisor >> 32; 144 u32 high = divisor >> 32;
142 u64 quot; 145 u64 quot;
143 146
144 if (high == 0) { 147 if (high == 0) {
145 quot = div_u64(dividend, divis 148 quot = div_u64(dividend, divisor);
146 } else { 149 } else {
147 int n = fls(high); 150 int n = fls(high);
148 quot = div_u64(dividend >> n, 151 quot = div_u64(dividend >> n, divisor >> n);
149 152
150 if (quot != 0) 153 if (quot != 0)
151 quot--; 154 quot--;
152 if ((dividend - quot * divisor 155 if ((dividend - quot * divisor) >= divisor)
153 quot++; 156 quot++;
154 } 157 }
155 158
156 return quot; 159 return quot;
157 } 160 }
158 EXPORT_SYMBOL(div64_u64); 161 EXPORT_SYMBOL(div64_u64);
159 #endif 162 #endif
160 163
>> 164 /**
>> 165 * div64_s64 - signed 64bit divide with 64bit divisor
>> 166 * @dividend: 64bit dividend
>> 167 * @divisor: 64bit divisor
>> 168 */
161 #ifndef div64_s64 169 #ifndef div64_s64
162 s64 div64_s64(s64 dividend, s64 divisor) 170 s64 div64_s64(s64 dividend, s64 divisor)
163 { 171 {
164 s64 quot, t; 172 s64 quot, t;
165 173
166 quot = div64_u64(abs(dividend), abs(di 174 quot = div64_u64(abs(dividend), abs(divisor));
167 t = (dividend ^ divisor) >> 63; 175 t = (dividend ^ divisor) >> 63;
168 176
169 return (quot ^ t) - t; 177 return (quot ^ t) - t;
170 } 178 }
171 EXPORT_SYMBOL(div64_s64); 179 EXPORT_SYMBOL(div64_s64);
172 #endif 180 #endif
173 181
174 #endif /* BITS_PER_LONG == 32 */ 182 #endif /* BITS_PER_LONG == 32 */
175 183
176 /* 184 /*
177 * Iterative div/mod for use when dividend is 185 * Iterative div/mod for use when dividend is not expected to be much
178 * bigger than divisor. 186 * bigger than divisor.
179 */ 187 */
180 u32 iter_div_u64_rem(u64 dividend, u32 divisor 188 u32 iter_div_u64_rem(u64 dividend, u32 divisor, u64 *remainder)
181 { 189 {
182 return __iter_div_u64_rem(dividend, di 190 return __iter_div_u64_rem(dividend, divisor, remainder);
183 } 191 }
184 EXPORT_SYMBOL(iter_div_u64_rem); 192 EXPORT_SYMBOL(iter_div_u64_rem);
185 193
186 #ifndef mul_u64_u64_div_u64 194 #ifndef mul_u64_u64_div_u64
187 u64 mul_u64_u64_div_u64(u64 a, u64 b, u64 c) 195 u64 mul_u64_u64_div_u64(u64 a, u64 b, u64 c)
188 { 196 {
189 u64 res = 0, div, rem; 197 u64 res = 0, div, rem;
190 int shift; 198 int shift;
191 199
192 /* can a * b overflow ? */ 200 /* can a * b overflow ? */
193 if (ilog2(a) + ilog2(b) > 62) { 201 if (ilog2(a) + ilog2(b) > 62) {
194 /* 202 /*
195 * Note that the algorithm aft <<
196 * some precision and the resu <<
197 * exchange a and b if a is bi <<
198 * <<
199 * For example with a = 439804 <<
200 * the below calculation doesn <<
201 * and then shift becomes 45 + <<
202 * becomes 4398035251080. Howe <<
203 * result is calculated (i.e. <<
204 */ <<
205 if (a > b) <<
206 swap(a, b); <<
207 <<
208 /* <<
209 * (b * a) / c is equal to 203 * (b * a) / c is equal to
210 * 204 *
211 * (b / c) * a + 205 * (b / c) * a +
212 * (b % c) * a / c 206 * (b % c) * a / c
213 * 207 *
214 * if nothing overflows. Can t 208 * if nothing overflows. Can the 1st multiplication
215 * overflow? Yes, but we do no 209 * overflow? Yes, but we do not care: this can only
216 * happen if the end result ca 210 * happen if the end result can't fit in u64 anyway.
217 * 211 *
218 * So the code below does 212 * So the code below does
219 * 213 *
220 * res = (b / c) * a; 214 * res = (b / c) * a;
221 * b = b % c; 215 * b = b % c;
222 */ 216 */
223 div = div64_u64_rem(b, c, &rem 217 div = div64_u64_rem(b, c, &rem);
224 res = div * a; 218 res = div * a;
225 b = rem; 219 b = rem;
226 220
227 shift = ilog2(a) + ilog2(b) - 221 shift = ilog2(a) + ilog2(b) - 62;
228 if (shift > 0) { 222 if (shift > 0) {
229 /* drop precision */ 223 /* drop precision */
230 b >>= shift; 224 b >>= shift;
231 c >>= shift; 225 c >>= shift;
232 if (!c) 226 if (!c)
233 return res; 227 return res;
234 } 228 }
235 } 229 }
236 230
237 return res + div64_u64(a * b, c); 231 return res + div64_u64(a * b, c);
238 } 232 }
239 EXPORT_SYMBOL(mul_u64_u64_div_u64); <<
240 #endif 233 #endif
241 234
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.