delay.S 1.3 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970
  1. /*
  2. * linux/arch/arm/lib/delay.S
  3. *
  4. * Copyright (C) 1995, 1996 Russell King
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <linux/linkage.h>
  11. #include <asm/assembler.h>
  12. #include <asm/param.h>
  13. .text
  14. .LC0: .word loops_per_jiffy
  15. .LC1: .word (2199023*HZ)>>11
  16. /*
  17. * r0 <= 2000
  18. * lpj <= 0x01ffffff (max. 3355 bogomips)
  19. * HZ <= 1000
  20. */
  21. ENTRY(__udelay)
  22. ldr r2, .LC1
  23. mul r0, r2, r0
  24. ENTRY(__const_udelay) @ 0 <= r0 <= 0x7fffff06
  25. mov r1, #-1
  26. ldr r2, .LC0
  27. ldr r2, [r2] @ max = 0x01ffffff
  28. add r0, r0, r1, lsr #32-14
  29. mov r0, r0, lsr #14 @ max = 0x0001ffff
  30. add r2, r2, r1, lsr #32-10
  31. mov r2, r2, lsr #10 @ max = 0x00007fff
  32. mul r0, r2, r0 @ max = 2^32-1
  33. add r0, r0, r1, lsr #32-6
  34. movs r0, r0, lsr #6
  35. moveq pc, lr
  36. /*
  37. * loops = r0 * HZ * loops_per_jiffy / 1000000
  38. *
  39. * Oh, if only we had a cycle counter...
  40. */
  41. @ Delay routine
  42. ENTRY(__delay)
  43. subs r0, r0, #1
  44. #if 0
  45. movls pc, lr
  46. subs r0, r0, #1
  47. movls pc, lr
  48. subs r0, r0, #1
  49. movls pc, lr
  50. subs r0, r0, #1
  51. movls pc, lr
  52. subs r0, r0, #1
  53. movls pc, lr
  54. subs r0, r0, #1
  55. movls pc, lr
  56. subs r0, r0, #1
  57. movls pc, lr
  58. subs r0, r0, #1
  59. #endif
  60. bhi __delay
  61. mov pc, lr
  62. ENDPROC(__udelay)
  63. ENDPROC(__const_udelay)
  64. ENDPROC(__delay)