entry-macro.S 2.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576
  1. /*****************************************************************************
  2. * Copyright 2006 - 2008 Broadcom Corporation. All rights reserved.
  3. *
  4. * Unless you and Broadcom execute a separate written software license
  5. * agreement governing use of this software, this software is licensed to you
  6. * under the terms of the GNU General Public License version 2, available at
  7. * http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
  8. *
  9. * Notwithstanding the above, under no circumstances may you combine this
  10. * software in any way with any other Broadcom software provided under a
  11. * license other than the GPL, without Broadcom's express prior written
  12. * consent.
  13. *****************************************************************************/
  14. /*
  15. *
  16. * Low-level IRQ helper macros for BCMRing-based platforms
  17. *
  18. */
  19. #include <mach/irqs.h>
  20. #include <mach/hardware.h>
  21. #include <mach/csp/mm_io.h>
  22. .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
  23. ldr \base, =(MM_IO_BASE_INTC0)
  24. ldr \irqstat, [\base, #0] @ get status
  25. ldr \irqnr, [\base, #0x10] @ mask with enable register
  26. ands \irqstat, \irqstat, \irqnr
  27. mov \irqnr, #IRQ_INTC0_START
  28. cmp \irqstat, #0
  29. bne 1001f
  30. ldr \base, =(MM_IO_BASE_INTC1)
  31. ldr \irqstat, [\base, #0] @ get status
  32. ldr \irqnr, [\base, #0x10] @ mask with enable register
  33. ands \irqstat, \irqstat, \irqnr
  34. mov \irqnr, #IRQ_INTC1_START
  35. cmp \irqstat, #0
  36. bne 1001f
  37. ldr \base, =(MM_IO_BASE_SINTC)
  38. ldr \irqstat, [\base, #0] @ get status
  39. ldr \irqnr, [\base, #0x10] @ mask with enable register
  40. ands \irqstat, \irqstat, \irqnr
  41. mov \irqnr, #0xffffffff @ code meaning no interrupt bits set
  42. cmp \irqstat, #0
  43. beq 1002f
  44. mov \irqnr, #IRQ_SINTC_START @ something is set, so fixup return value
  45. 1001:
  46. movs \tmp, \irqstat, lsl #16
  47. movne \irqstat, \tmp
  48. addeq \irqnr, \irqnr, #16
  49. movs \tmp, \irqstat, lsl #8
  50. movne \irqstat, \tmp
  51. addeq \irqnr, \irqnr, #8
  52. movs \tmp, \irqstat, lsl #4
  53. movne \irqstat, \tmp
  54. addeq \irqnr, \irqnr, #4
  55. movs \tmp, \irqstat, lsl #2
  56. movne \irqstat, \tmp
  57. addeq \irqnr, \irqnr, #2
  58. movs \tmp, \irqstat, lsl #1
  59. addeq \irqnr, \irqnr, #1
  60. orrs \base, \base, #1
  61. 1002: @ irqnr will be set to 0xffffffff if no irq bits are set
  62. .endm
  63. .macro get_irqnr_preamble, base, tmp
  64. .endm