blob: f3fe1a688f7ecb90519351b7b0ee899b6f976522 [file] [log] [blame]
Richard Weinberger22e9b912011-07-25 17:12:46 -07001/*
2 * Copyright (C) 2011 Richard Weinberger <richrd@nod.at>
3 * Mostly copied from arch/x86/lib/delay.c
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 */
9
Jeff Dike060e3522005-05-20 13:59:08 -070010#include <linux/module.h>
11#include <linux/kernel.h>
12#include <linux/delay.h>
13#include <asm/param.h>
Bodo Stroesser5fd861b2005-05-05 16:15:37 -070014
Richard Weinberger22e9b912011-07-25 17:12:46 -070015void __delay(unsigned long loops)
Linus Torvalds1da177e2005-04-16 15:20:36 -070016{
Richard Weinberger22e9b912011-07-25 17:12:46 -070017 asm volatile(
18 "test %0,%0\n"
19 "jz 3f\n"
20 "jmp 1f\n"
21
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 ".align 16\n"
Richard Weinberger22e9b912011-07-25 17:12:46 -070023 "1: jmp 2f\n"
24
Linus Torvalds1da177e2005-04-16 15:20:36 -070025 ".align 16\n"
Richard Weinberger22e9b912011-07-25 17:12:46 -070026 "2: dec %0\n"
27 " jnz 2b\n"
28 "3: dec %0\n"
29
30 : /* we don't need output */
31 : "a" (loops)
32 );
Linus Torvalds1da177e2005-04-16 15:20:36 -070033}
Richard Weinberger22e9b912011-07-25 17:12:46 -070034EXPORT_SYMBOL(__delay);
35
36inline void __const_udelay(unsigned long xloops)
37{
38 int d0;
39
40 xloops *= 4;
41 asm("mull %%edx"
42 : "=d" (xloops), "=&a" (d0)
43 : "1" (xloops), "0"
44 (loops_per_jiffy * (HZ/4)));
45
46 __delay(++xloops);
47}
48EXPORT_SYMBOL(__const_udelay);
Linus Torvalds1da177e2005-04-16 15:20:36 -070049
Bodo Stroesser5fd861b2005-05-05 16:15:37 -070050void __udelay(unsigned long usecs)
51{
Richard Weinberger22e9b912011-07-25 17:12:46 -070052 __const_udelay(usecs * 0x000010c7); /* 2**32 / 1000000 (rounded up) */
Bodo Stroesser5fd861b2005-05-05 16:15:37 -070053}
Jeff Dike060e3522005-05-20 13:59:08 -070054EXPORT_SYMBOL(__udelay);
Richard Weinberger22e9b912011-07-25 17:12:46 -070055
56void __ndelay(unsigned long nsecs)
57{
58 __const_udelay(nsecs * 0x00005); /* 2**32 / 1000000000 (rounded up) */
59}
60EXPORT_SYMBOL(__ndelay);