blob: 8d510ceb43fbfcbd62c104102512cdc70782d114 [file] [log] [blame]
Thomas Gleixnerd2912cb2019-06-04 10:11:33 +02001// SPDX-License-Identifier: GPL-2.0-only
Richard Weinberger22e9b912011-07-25 17:12:46 -07002/*
3 * Copyright (C) 2011 Richard Weinberger <richrd@nod.at>
4 * Mostly copied from arch/x86/lib/delay.c
Richard Weinberger22e9b912011-07-25 17:12:46 -07005 */
6
Paul Gortmakereb008eb2016-07-13 20:19:01 -04007#include <linux/export.h>
Jeff Dike060e3522005-05-20 13:59:08 -07008#include <linux/kernel.h>
9#include <linux/delay.h>
10#include <asm/param.h>
Bodo Stroesser5fd861b2005-05-05 16:15:37 -070011
Richard Weinberger22e9b912011-07-25 17:12:46 -070012void __delay(unsigned long loops)
Linus Torvalds1da177e2005-04-16 15:20:36 -070013{
Richard Weinberger22e9b912011-07-25 17:12:46 -070014 asm volatile(
15 "test %0,%0\n"
16 "jz 3f\n"
17 "jmp 1f\n"
18
Linus Torvalds1da177e2005-04-16 15:20:36 -070019 ".align 16\n"
Richard Weinberger22e9b912011-07-25 17:12:46 -070020 "1: jmp 2f\n"
21
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 ".align 16\n"
Richard Weinberger22e9b912011-07-25 17:12:46 -070023 "2: dec %0\n"
24 " jnz 2b\n"
25 "3: dec %0\n"
26
27 : /* we don't need output */
28 : "a" (loops)
29 );
Linus Torvalds1da177e2005-04-16 15:20:36 -070030}
Richard Weinberger22e9b912011-07-25 17:12:46 -070031EXPORT_SYMBOL(__delay);
32
33inline void __const_udelay(unsigned long xloops)
34{
35 int d0;
36
37 xloops *= 4;
38 asm("mull %%edx"
39 : "=d" (xloops), "=&a" (d0)
40 : "1" (xloops), "0"
41 (loops_per_jiffy * (HZ/4)));
42
43 __delay(++xloops);
44}
45EXPORT_SYMBOL(__const_udelay);
Linus Torvalds1da177e2005-04-16 15:20:36 -070046
Bodo Stroesser5fd861b2005-05-05 16:15:37 -070047void __udelay(unsigned long usecs)
48{
Richard Weinberger22e9b912011-07-25 17:12:46 -070049 __const_udelay(usecs * 0x000010c7); /* 2**32 / 1000000 (rounded up) */
Bodo Stroesser5fd861b2005-05-05 16:15:37 -070050}
Jeff Dike060e3522005-05-20 13:59:08 -070051EXPORT_SYMBOL(__udelay);
Richard Weinberger22e9b912011-07-25 17:12:46 -070052
53void __ndelay(unsigned long nsecs)
54{
55 __const_udelay(nsecs * 0x00005); /* 2**32 / 1000000000 (rounded up) */
56}
57EXPORT_SYMBOL(__ndelay);