delay.c 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768
  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. #include <asm/asm.h>
  17. #include <asm/compiler.h>
  18. #ifndef CONFIG_CPU_DADDI_WORKAROUNDS
  19. #define GCC_DADDI_IMM_ASM() "I"
  20. #else
  21. #define GCC_DADDI_IMM_ASM() "r"
  22. #endif
  23. #ifndef CONFIG_HAVE_PLAT_DELAY
  24. void __delay(unsigned long loops)
  25. {
  26. __asm__ __volatile__ (
  27. " .set noreorder \n"
  28. " .align 3 \n"
  29. "1: bnez %0, 1b \n"
  30. " " __stringify(LONG_SUBU) " %0, %1 \n"
  31. " .set reorder \n"
  32. : "=r" (loops)
  33. : GCC_DADDI_IMM_ASM() (1), "0" (loops));
  34. }
  35. EXPORT_SYMBOL(__delay);
  36. /*
  37. * Division by multiplication: you don't have to worry about
  38. * loss of precision.
  39. *
  40. * Use only for very small delays ( < 1 msec). Should probably use a
  41. * lookup table, really, as the multiplications take much too long with
  42. * short delays. This is a "reasonable" implementation, though (and the
  43. * first constant multiplications gets optimized away if the delay is
  44. * a constant)
  45. */
  46. void __udelay(unsigned long us)
  47. {
  48. unsigned int lpj = raw_current_cpu_data.udelay_val;
  49. __delay((us * 0x000010c7ull * HZ * lpj) >> 32);
  50. }
  51. EXPORT_SYMBOL(__udelay);
  52. void __ndelay(unsigned long ns)
  53. {
  54. unsigned int lpj = raw_current_cpu_data.udelay_val;
  55. __delay((ns * 0x00000005ull * HZ * lpj) >> 32);
  56. }
  57. EXPORT_SYMBOL(__ndelay);
  58. #endif