blob: 54980f07e95a3fb45c70c4372f7f42eb1c53f4b6 (
plain)
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
|
#include <klibc/diverr.h>
#include <stdint.h>
uint32_t __udivmodsi4(uint32_t num, uint32_t den, uint32_t * rem_p)
{
uint32_t quot = 0, qbit = 1;
if (den == 0) {
__divide_error();
return 0; /* If trap returns... */
}
/* Left-justify denominator and count shift */
while ((int32_t) den >= 0) {
den <<= 1;
qbit <<= 1;
}
while (qbit) {
if (den <= num) {
num -= den;
quot += qbit;
}
den >>= 1;
qbit >>= 1;
}
if (rem_p)
*rem_p = num;
return quot;
}
|