1 /*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
5 *
6 * Copyright (C) 1994 by Waldorf Electronics
7 * Copyright (C) 1995 - 2000, 01, 03 by Ralf Baechle
8 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
9 * Copyright (C) 2007, 2014 Maciej W. Rozycki
10 */
11 #include <linux/delay.h>
12 #include <linux/export.h>
13 #include <linux/param.h>
14 #include <linux/smp.h>
15 #include <linux/stringify.h>
16
17 #include <asm/asm.h>
18 #include <asm/compiler.h>
19
20 #ifndef CONFIG_CPU_DADDI_WORKAROUNDS
21 #define GCC_DADDI_IMM_ASM() "I"
22 #else
23 #define GCC_DADDI_IMM_ASM() "r"
24 #endif
25
26 #ifndef CONFIG_HAVE_PLAT_DELAY
27
__delay(unsigned long loops)28 void __delay(unsigned long loops)
29 {
30 __asm__ __volatile__ (
31 " .set noreorder \n"
32 " .align 3 \n"
33 "1: bnez %0, 1b \n"
34 " " __stringify(LONG_SUBU) " %0, %1 \n"
35 " .set reorder \n"
36 : "=r" (loops)
37 : GCC_DADDI_IMM_ASM() (1), "0" (loops));
38 }
39 EXPORT_SYMBOL(__delay);
40
41 /*
42 * Division by multiplication: you don't have to worry about
43 * loss of precision.
44 *
45 * Use only for very small delays ( < 1 msec). Should probably use a
46 * lookup table, really, as the multiplications take much too long with
47 * short delays. This is a "reasonable" implementation, though (and the
48 * first constant multiplications gets optimized away if the delay is
49 * a constant)
50 */
51
__udelay(unsigned long us)52 void __udelay(unsigned long us)
53 {
54 unsigned int lpj = raw_current_cpu_data.udelay_val;
55
56 __delay((us * 0x000010c7ull * HZ * lpj) >> 32);
57 }
58 EXPORT_SYMBOL(__udelay);
59
__ndelay(unsigned long ns)60 void __ndelay(unsigned long ns)
61 {
62 unsigned int lpj = raw_current_cpu_data.udelay_val;
63
64 __delay((ns * 0x00000005ull * HZ * lpj) >> 32);
65 }
66 EXPORT_SYMBOL(__ndelay);
67
68 #endif
69