blob: f3fe1a688f7ecb90519351b7b0ee899b6f976522 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Richard Weinberger22e9b912011-07-25 17:12:46 -07002 * Copyright (C) 2011 Richard Weinberger <richrd@nod.at>
3 * Mostly copied from arch/x86/lib/delay.c
Linus Torvalds1da177e2005-04-16 15:20:36 -07004 *
Richard Weinberger22e9b912011-07-25 17:12:46 -07005 * 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.
Linus Torvalds1da177e2005-04-16 15:20:36 -07008 */
9
Jeff Dike060e3522005-05-20 13:59:08 -070010#include <linux/module.h>
Richard Weinberger22e9b912011-07-25 17:12:46 -070011#include <linux/kernel.h>
Jeff Dike060e3522005-05-20 13:59:08 -070012#include <linux/delay.h>
Jeff Dike060e3522005-05-20 13:59:08 -070013#include <asm/param.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014
15void __delay(unsigned long loops)
16{
Richard Weinberger22e9b912011-07-25 17:12:46 -070017 asm volatile(
18 "test %0,%0\n"
19 "jz 3f\n"
20 "jmp 1f\n"
Linus Torvalds1da177e2005-04-16 15:20:36 -070021
Richard Weinberger22e9b912011-07-25 17:12:46 -070022 ".align 16\n"
23 "1: jmp 2f\n"
24
25 ".align 16\n"
26 "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);