__umodsi3.c 888 字节
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
/*
 * File      : __umodsi3.c
 * This file is part of RT-Thread RTOS
 * COPYRIGHT (C) 2006, RT-Thread Develop Team
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 * http://openlab.rt-thread.com/license/LICENSE
 *
 * Change Logs:
 * Date           Author       Notes
 * 2006-10-09     Bernard      the first version for i386
 */

#include <rtthread.h>

typedef rt_uint32_t uint32_t;
S
ssslady 已提交
18
typedef rt_int32_t int32_t;
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

uint32_t __umodsi3(uint32_t num, uint32_t den)
{
	register uint32_t quot = 0, qbit = 1;

	if (den == 0)
	{
		asm volatile ("int $0");
		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;
	}

	return num;
}