55 lines
		
	
	
	
		
			1.1 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			55 lines
		
	
	
	
		
			1.1 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * Copyright (C) 1993, 2000 Linus Torvalds | ||
|  |  * | ||
|  |  * Delay routines, using a pre-computed "loops_per_jiffy" value. | ||
|  |  */ | ||
|  | 
 | ||
|  | #include <linux/module.h>
 | ||
|  | #include <linux/sched.h> /* for udelay's use of smp_processor_id */
 | ||
|  | #include <asm/param.h>
 | ||
|  | #include <asm/smp.h>
 | ||
|  | #include <linux/delay.h>
 | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Use only for very small delays (< 1 msec).  | ||
|  |  * | ||
|  |  * The active part of our cycle counter is only 32-bits wide, and | ||
|  |  * we're treating the difference between two marks as signed.  On | ||
|  |  * a 1GHz box, that's about 2 seconds. | ||
|  |  */ | ||
|  | 
 | ||
|  | void | ||
|  | __delay(int loops) | ||
|  | { | ||
|  | 	int tmp; | ||
|  | 	__asm__ __volatile__( | ||
|  | 		"	rpcc %0\n" | ||
|  | 		"	addl %1,%0,%1\n" | ||
|  | 		"1:	rpcc %0\n" | ||
|  | 		"	subl %1,%0,%0\n" | ||
|  | 		"	bgt %0,1b" | ||
|  | 		: "=&r" (tmp), "=r" (loops) : "1"(loops)); | ||
|  | } | ||
|  | 
 | ||
|  | #ifdef CONFIG_SMP
 | ||
|  | #define LPJ	 cpu_data[smp_processor_id()].loops_per_jiffy
 | ||
|  | #else
 | ||
|  | #define LPJ	 loops_per_jiffy
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | void | ||
|  | udelay(unsigned long usecs) | ||
|  | { | ||
|  | 	usecs *= (((unsigned long)HZ << 32) / 1000000) * LPJ; | ||
|  | 	__delay((long)usecs >> 32); | ||
|  | } | ||
|  | EXPORT_SYMBOL(udelay); | ||
|  | 
 | ||
|  | void | ||
|  | ndelay(unsigned long nsecs) | ||
|  | { | ||
|  | 	nsecs *= (((unsigned long)HZ << 32) / 1000000000) * LPJ; | ||
|  | 	__delay((long)nsecs >> 32); | ||
|  | } | ||
|  | EXPORT_SYMBOL(ndelay); |