mirror of
				https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
				synced 2025-11-01 00:28:51 +01:00 
			
		
		
		
	
		
			
				
	
	
		
			119 lines
		
	
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			119 lines
		
	
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #ifndef _M68K_DELAY_H
 | |
| #define _M68K_DELAY_H
 | |
| 
 | |
| #include <asm/param.h>
 | |
| 
 | |
| /*
 | |
|  * Copyright (C) 1994 Hamish Macdonald
 | |
|  * Copyright (C) 2004 Greg Ungerer <gerg@uclinux.com>
 | |
|  *
 | |
|  * Delay routines, using a pre-computed "loops_per_jiffy" value.
 | |
|  */
 | |
| 
 | |
| #if defined(CONFIG_COLDFIRE)
 | |
| /*
 | |
|  * The ColdFire runs the delay loop at significantly different speeds
 | |
|  * depending upon long word alignment or not.  We'll pad it to
 | |
|  * long word alignment which is the faster version.
 | |
|  * The 0x4a8e is of course a 'tstl %fp' instruction.  This is better
 | |
|  * than using a NOP (0x4e71) instruction because it executes in one
 | |
|  * cycle not three and doesn't allow for an arbitrary delay waiting
 | |
|  * for bus cycles to finish.  Also fp/a6 isn't likely to cause a
 | |
|  * stall waiting for the register to become valid if such is added
 | |
|  * to the coldfire at some stage.
 | |
|  */
 | |
| #define	DELAY_ALIGN	".balignw 4, 0x4a8e\n\t"
 | |
| #else
 | |
| /*
 | |
|  * No instruction alignment required for other m68k types.
 | |
|  */
 | |
| #define	DELAY_ALIGN
 | |
| #endif
 | |
| 
 | |
| static inline void __delay(unsigned long loops)
 | |
| {
 | |
| 	__asm__ __volatile__ (
 | |
| 		DELAY_ALIGN
 | |
| 		"1: subql #1,%0\n\t"
 | |
| 		"jcc 1b"
 | |
| 		: "=d" (loops)
 | |
| 		: "0" (loops));
 | |
| }
 | |
| 
 | |
| extern void __bad_udelay(void);
 | |
| 
 | |
| 
 | |
| #ifdef CONFIG_CPU_HAS_NO_MULDIV64
 | |
| /*
 | |
|  * The simpler m68k and ColdFire processors do not have a 32*32->64
 | |
|  * multiply instruction. So we need to handle them a little differently.
 | |
|  * We use a bit of shifting and a single 32*32->32 multiply to get close.
 | |
|  * This is a macro so that the const version can factor out the first
 | |
|  * multiply and shift.
 | |
|  */
 | |
| #define	HZSCALE		(268435456 / (1000000 / HZ))
 | |
| 
 | |
| #define	__const_udelay(u) \
 | |
| 	__delay(((((u) * HZSCALE) >> 11) * (loops_per_jiffy >> 11)) >> 6)
 | |
| 
 | |
| #else
 | |
| 
 | |
| static inline void __xdelay(unsigned long xloops)
 | |
| {
 | |
| 	unsigned long tmp;
 | |
| 
 | |
| 	__asm__ ("mulul %2,%0:%1"
 | |
| 		: "=d" (xloops), "=d" (tmp)
 | |
| 		: "d" (xloops), "1" (loops_per_jiffy));
 | |
| 	__delay(xloops * HZ);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * The definition of __const_udelay is specifically made a macro so that
 | |
|  * the const factor (4295 = 2**32 / 1000000) can be optimized out when
 | |
|  * the delay is a const.
 | |
|  */
 | |
| #define	__const_udelay(n)	(__xdelay((n) * 4295))
 | |
| 
 | |
| #endif
 | |
| 
 | |
| static inline void __udelay(unsigned long usecs)
 | |
| {
 | |
| 	__const_udelay(usecs);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Use only for very small delays ( < 1 msec).  Should probably use a
 | |
|  * lookup table, really, as the multiplications take much too long with
 | |
|  * short delays.  This is a "reasonable" implementation, though (and the
 | |
|  * first constant multiplications gets optimized away if the delay is
 | |
|  * a constant)
 | |
|  */
 | |
| #define udelay(n) (__builtin_constant_p(n) ? \
 | |
| 	((n) > 20000 ? __bad_udelay() : __const_udelay(n)) : __udelay(n))
 | |
| 
 | |
| /*
 | |
|  * nanosecond delay:
 | |
|  *
 | |
|  * ((((HZSCALE) >> 11) * (loops_per_jiffy >> 11)) >> 6) is the number of loops
 | |
|  * per microsecond
 | |
|  *
 | |
|  * 1000 / ((((HZSCALE) >> 11) * (loops_per_jiffy >> 11)) >> 6) is the number of
 | |
|  * nanoseconds per loop
 | |
|  *
 | |
|  * So n / ( 1000 / ((((HZSCALE) >> 11) * (loops_per_jiffy >> 11)) >> 6) ) would
 | |
|  * be the number of loops for n nanoseconds
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * The simpler m68k and ColdFire processors do not have a 32*32->64
 | |
|  * multiply instruction. So we need to handle them a little differently.
 | |
|  * We use a bit of shifting and a single 32*32->32 multiply to get close.
 | |
|  * This is a macro so that the const version can factor out the first
 | |
|  * multiply and shift.
 | |
|  */
 | |
| #define	HZSCALE		(268435456 / (1000000 / HZ))
 | |
| 
 | |
| #define ndelay(n) __delay(DIV_ROUND_UP((n) * ((((HZSCALE) >> 11) * (loops_per_jiffy >> 11)) >> 6), 1000));
 | |
| 
 | |
| #endif /* defined(_M68K_DELAY_H) */
 | 
