2011-07-26 04:12:46 +04:00
/*
* Copyright ( C ) 2011 Richard Weinberger < richrd @ nod . at >
* Mostly copied from arch / x86 / lib / delay . c
*
* This program is free software ; you can redistribute it and / or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation .
*/
2016-07-14 03:19:01 +03:00
# include <linux/export.h>
2005-05-21 00:59:08 +04:00
# include <linux/kernel.h>
# include <linux/delay.h>
# include <asm/param.h>
2005-05-06 03:15:37 +04:00
2011-07-26 04:12:46 +04:00
void __delay ( unsigned long loops )
2005-04-17 02:20:36 +04:00
{
2011-07-26 04:12:46 +04:00
asm volatile (
" test %0,%0 \n "
" jz 3f \n "
" jmp 1f \n "
2005-04-17 02:20:36 +04:00
" .align 16 \n "
2011-07-26 04:12:46 +04:00
" 1: jmp 2f \n "
2005-04-17 02:20:36 +04:00
" .align 16 \n "
2011-07-26 04:12:46 +04:00
" 2: dec %0 \n "
" jnz 2b \n "
" 3: dec %0 \n "
: /* we don't need output */
: " a " ( loops )
) ;
2005-04-17 02:20:36 +04:00
}
2011-07-26 04:12:46 +04:00
EXPORT_SYMBOL ( __delay ) ;
2005-04-17 02:20:36 +04:00
2011-07-26 04:12:46 +04:00
inline void __const_udelay ( unsigned long xloops )
2005-05-06 03:15:37 +04:00
{
2011-07-26 04:12:46 +04:00
int d0 ;
2005-05-06 03:15:37 +04:00
2011-07-26 04:12:46 +04:00
xloops * = 4 ;
asm ( " mull %%edx "
: " =d " ( xloops ) , " =&a " ( d0 )
: " 1 " ( xloops ) , " 0 "
( loops_per_jiffy * ( HZ / 4 ) ) ) ;
__delay ( + + xloops ) ;
2005-05-06 03:15:37 +04:00
}
2011-07-26 04:12:46 +04:00
EXPORT_SYMBOL ( __const_udelay ) ;
2005-05-06 03:15:37 +04:00
2011-07-26 04:12:46 +04:00
void __udelay ( unsigned long usecs )
{
__const_udelay ( usecs * 0x000010c7 ) ; /* 2**32 / 1000000 (rounded up) */
}
2005-05-21 00:59:08 +04:00
EXPORT_SYMBOL ( __udelay ) ;
2011-07-26 04:12:46 +04:00
void __ndelay ( unsigned long nsecs )
{
__const_udelay ( nsecs * 0x00005 ) ; /* 2**32 / 1000000000 (rounded up) */
}
EXPORT_SYMBOL ( __ndelay ) ;