summaryrefslogtreecommitdiffstats
path: root/usr/klibc/libgcc/__udivmodsi4.c
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;
}