101 lines
		
	
	
		
			2.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			101 lines
		
	
	
		
			2.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* MN10300 64-bit division
 | |
|  *
 | |
|  * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
 | |
|  * Written by David Howells (dhowells@redhat.com)
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or
 | |
|  * modify it under the terms of the GNU General Public Licence
 | |
|  * as published by the Free Software Foundation; either version
 | |
|  * 2 of the Licence, or (at your option) any later version.
 | |
|  */
 | |
| #ifndef _ASM_DIV64
 | |
| #define _ASM_DIV64
 | |
| 
 | |
| #include <linux/types.h>
 | |
| 
 | |
| extern void ____unhandled_size_in_do_div___(void);
 | |
| 
 | |
| /*
 | |
|  * divide n by base, leaving the result in n and returning the remainder
 | |
|  * - we can do this quite efficiently on the MN10300 by cascading the divides
 | |
|  *   through the MDR register
 | |
|  */
 | |
| #define do_div(n, base)							\
 | |
| ({									\
 | |
| 	unsigned __rem = 0;						\
 | |
| 	if (sizeof(n) <= 4) {						\
 | |
| 		asm("mov	%1,mdr	\n"				\
 | |
| 		    "divu	%2,%0	\n"				\
 | |
| 		    "mov	mdr,%1	\n"				\
 | |
| 		    : "+r"(n), "=d"(__rem)				\
 | |
| 		    : "r"(base), "1"(__rem)				\
 | |
| 		    : "cc"						\
 | |
| 		    );							\
 | |
| 	} else if (sizeof(n) <= 8) {					\
 | |
| 		union {							\
 | |
| 			unsigned long long l;				\
 | |
| 			u32 w[2];					\
 | |
| 		} __quot;						\
 | |
| 		__quot.l = n;						\
 | |
| 		asm("mov	%0,mdr	\n"	/* MDR = 0 */		\
 | |
| 		    "divu	%3,%1	\n"				\
 | |
| 		    /* __quot.MSL = __div.MSL / base, */		\
 | |
| 		    /* MDR = MDR:__div.MSL % base */			\
 | |
| 		    "divu	%3,%2	\n"				\
 | |
| 		    /* __quot.LSL = MDR:__div.LSL / base, */		\
 | |
| 		    /* MDR = MDR:__div.LSL % base */			\
 | |
| 		    "mov	mdr,%0	\n"				\
 | |
| 		    : "=d"(__rem), "=r"(__quot.w[1]), "=r"(__quot.w[0])	\
 | |
| 		    : "r"(base), "0"(__rem), "1"(__quot.w[1]),		\
 | |
| 		      "2"(__quot.w[0])					\
 | |
| 		    : "cc"						\
 | |
| 		    );							\
 | |
| 		n = __quot.l;						\
 | |
| 	} else {							\
 | |
| 		____unhandled_size_in_do_div___();			\
 | |
| 	}								\
 | |
| 	__rem;								\
 | |
| })
 | |
| 
 | |
| /*
 | |
|  * do an unsigned 32-bit multiply and divide with intermediate 64-bit product
 | |
|  * so as not to lose accuracy
 | |
|  * - we use the MDR register to hold the MSW of the product
 | |
|  */
 | |
| static inline __attribute__((const))
 | |
| unsigned __muldiv64u(unsigned val, unsigned mult, unsigned div)
 | |
| {
 | |
| 	unsigned result;
 | |
| 
 | |
| 	asm("mulu	%2,%0	\n"	/* MDR:val = val*mult */
 | |
| 	    "divu	%3,%0	\n"	/* val = MDR:val/div;
 | |
| 					 * MDR = MDR:val%div */
 | |
| 	    : "=r"(result)
 | |
| 	    : "0"(val), "ir"(mult), "r"(div)
 | |
| 	    );
 | |
| 
 | |
| 	return result;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * do a signed 32-bit multiply and divide with intermediate 64-bit product so
 | |
|  * as not to lose accuracy
 | |
|  * - we use the MDR register to hold the MSW of the product
 | |
|  */
 | |
| static inline __attribute__((const))
 | |
| signed __muldiv64s(signed val, signed mult, signed div)
 | |
| {
 | |
| 	signed result;
 | |
| 
 | |
| 	asm("mul	%2,%0	\n"	/* MDR:val = val*mult */
 | |
| 	    "div	%3,%0	\n"	/* val = MDR:val/div;
 | |
| 					 * MDR = MDR:val%div */
 | |
| 	    : "=r"(result)
 | |
| 	    : "0"(val), "ir"(mult), "r"(div)
 | |
| 	    );
 | |
| 
 | |
| 	return result;
 | |
| }
 | |
| 
 | |
| #endif /* _ASM_DIV64 */
 |