entry-macro.S
上传用户:szlgq88
上传日期:2009-04-28
资源大小:48287k
文件大小:2k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * include/asm-arm/arch-lh7a40x/entry-macro.S
  3.  *
  4.  * Low-level IRQ helper macros for LH7A40x 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. # if defined (CONFIG_ARCH_LH7A400) && defined (CONFIG_ARCH_LH7A404)
  11. #  error "LH7A400 and LH7A404 are mutually exclusive"
  12. # endif
  13. # if defined (CONFIG_ARCH_LH7A400)
  14. .macro disable_fiq
  15. .endm
  16. .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
  17. mov irqnr, #0
  18. mov base, #io_p2v(0x80000000) @ APB registers
  19. ldr irqstat, [base, #0x500] @ PIC INTSR
  20. 1001: movs irqstat, irqstat, lsr #1 @ Shift into carry
  21. bcs 1008f @ Bit set; irq found
  22. add irqnr, irqnr, #1
  23. bne 1001b @ Until no bits
  24. b 1009f @ Nothing?  Hmm.
  25. 1008: movs irqstat, #1 @ Force !Z
  26. 1009:
  27.                .endm
  28. #elif defined(CONFIG_ARCH_LH7A404)
  29. .macro disable_fiq
  30. .endm
  31. .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
  32. mov irqnr, #0 @ VIC1 irq base
  33. mov base, #io_p2v(0x80000000) @ APB registers
  34. add base, base, #0x8000
  35. ldr tmp, [base, #0x0030] @ VIC1_VECTADDR
  36. tst tmp, #VA_VECTORED @ Direct vectored
  37. bne 1002f
  38. tst tmp, #VA_VIC1DEFAULT @ Default vectored VIC1
  39. ldrne irqstat, [base, #0] @ VIC1_IRQSTATUS
  40. bne 1001f
  41. add base, base, #(0xa000 - 0x8000)
  42. ldr tmp, [base, #0x0030] @ VIC2_VECTADDR
  43. tst tmp, #VA_VECTORED @ Direct vectored
  44. bne 1002f
  45. ldr irqstat, [base, #0] @ VIC2_IRQSTATUS
  46. mov irqnr, #32 @ VIC2 irq base
  47. 1001: movs irqstat, irqstat, lsr #1 @ Shift into carry
  48. bcs 1008f @ Bit set; irq found
  49. add irqnr, irqnr, #1
  50. bne 1001b @ Until no bits
  51. b 1009f @ Nothing?  Hmm.
  52. 1002: and irqnr, tmp, #0x3f @ Mask for valid bits
  53. 1008: movs irqstat, #1 @ Force !Z
  54. str tmp, [base, #0x0030] @ Clear vector
  55. 1009:
  56.                .endm
  57. #endif