delay-loop.S 1.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162
  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/delay.h>
  13. .text
  14. .LC0: .word loops_per_jiffy
  15. .LC1: .word UDELAY_MULT
  16. /*
  17. * loops = r0 * HZ * loops_per_jiffy / 1000000
  18. *
  19. * r0 <= 2000
  20. * HZ <= 1000
  21. */
  22. ENTRY(__loop_udelay)
  23. ldr r2, .LC1
  24. mul r0, r2, r0 @ r0 = delay_us * UDELAY_MULT
  25. ENTRY(__loop_const_udelay) @ 0 <= r0 <= 0xfffffaf0
  26. ldr r2, .LC0
  27. ldr r2, [r2]
  28. umull r1, r0, r2, r0 @ r0-r1 = r0 * loops_per_jiffy
  29. adds r1, r1, #0xffffffff @ rounding up ...
  30. adcs r0, r0, r0 @ and right shift by 31
  31. reteq lr
  32. .align 3
  33. @ Delay routine
  34. ENTRY(__loop_delay)
  35. subs r0, r0, #1
  36. #if 0
  37. retls lr
  38. subs r0, r0, #1
  39. retls lr
  40. subs r0, r0, #1
  41. retls lr
  42. subs r0, r0, #1
  43. retls lr
  44. subs r0, r0, #1
  45. retls lr
  46. subs r0, r0, #1
  47. retls lr
  48. subs r0, r0, #1
  49. retls lr
  50. subs r0, r0, #1
  51. #endif
  52. bhi __loop_delay
  53. ret lr
  54. ENDPROC(__loop_udelay)
  55. ENDPROC(__loop_const_udelay)
  56. ENDPROC(__loop_delay)