entry-macro.S 1.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051
  1. /*
  2. * arch/arm/mach-pxa/include/mach/entry-macro.S
  3. *
  4. * Low-level IRQ helper macros for PXA-based platforms
  5. *
  6. * This file is licensed under the terms of the GNU General Public
  7. * License version 2. This program is licensed "as is" without any
  8. * warranty of any kind, whether express or implied.
  9. */
  10. #include <mach/hardware.h>
  11. #include <mach/irqs.h>
  12. .macro disable_fiq
  13. .endm
  14. .macro get_irqnr_preamble, base, tmp
  15. .endm
  16. .macro arch_ret_to_user, tmp1, tmp2
  17. .endm
  18. .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
  19. mrc p15, 0, \tmp, c0, c0, 0 @ CPUID
  20. mov \tmp, \tmp, lsr #13
  21. and \tmp, \tmp, #0x7 @ Core G
  22. cmp \tmp, #1
  23. bhi 1002f
  24. @ Core Generation 1 (PXA25x)
  25. mov \base, #io_p2v(0x40000000) @ IIR Ctl = 0x40d00000
  26. add \base, \base, #0x00d00000
  27. ldr \irqstat, [\base, #0] @ ICIP
  28. ldr \irqnr, [\base, #4] @ ICMR
  29. ands \irqnr, \irqstat, \irqnr
  30. beq 1001f
  31. rsb \irqstat, \irqnr, #0
  32. and \irqstat, \irqstat, \irqnr
  33. clz \irqnr, \irqstat
  34. rsb \irqnr, \irqnr, #(31 + PXA_IRQ(0))
  35. b 1001f
  36. 1002:
  37. @ Core Generation 2 (PXA27x) or Core Generation 3 (PXA3xx)
  38. mrc p6, 0, \irqstat, c5, c0, 0 @ ICHP
  39. tst \irqstat, #0x80000000
  40. beq 1001f
  41. bic \irqstat, \irqstat, #0x80000000
  42. mov \irqnr, \irqstat, lsr #16
  43. add \irqnr, \irqnr, #(PXA_IRQ(0))
  44. 1001:
  45. .endm