entry-macro.S 1.3 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253
  1. /*
  2. * arch/arm/mach-ks8695/include/mach/entry-macro.S
  3. *
  4. * Copyright (C) 2006 Ben Dooks <ben@simtec.co.uk>
  5. * Copyright (C) 2006 Simtec Electronics
  6. *
  7. * Low-level IRQ helper macros for KS8695
  8. *
  9. * This file is licensed under the terms of the GNU General Public
  10. * License version 2. This program is licensed "as is" without any
  11. * warranty of any kind, whether express or implied.
  12. */
  13. #include <mach/hardware.h>
  14. #include <mach/regs-irq.h>
  15. .macro disable_fiq
  16. .endm
  17. .macro get_irqnr_preamble, base, tmp
  18. ldr \base, =KS8695_IRQ_VA @ Base address of interrupt controller
  19. .endm
  20. .macro arch_ret_to_user, tmp1, tmp2
  21. .endm
  22. .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
  23. ldr \irqstat, [\base, #KS8695_INTMS] @ Mask Status register
  24. teq \irqstat, #0
  25. beq 1001f
  26. mov \irqnr, #0
  27. tst \irqstat, #0xff
  28. moveq \irqstat, \irqstat, lsr #8
  29. addeq \irqnr, \irqnr, #8
  30. tsteq \irqstat, #0xff
  31. moveq \irqstat, \irqstat, lsr #8
  32. addeq \irqnr, \irqnr, #8
  33. tsteq \irqstat, #0xff
  34. moveq \irqstat, \irqstat, lsr #8
  35. addeq \irqnr, \irqnr, #8
  36. tst \irqstat, #0x0f
  37. moveq \irqstat, \irqstat, lsr #4
  38. addeq \irqnr, \irqnr, #4
  39. tst \irqstat, #0x03
  40. moveq \irqstat, \irqstat, lsr #2
  41. addeq \irqnr, \irqnr, #2
  42. tst \irqstat, #0x01
  43. addeqs \irqnr, \irqnr, #1
  44. 1001:
  45. .endm