arch/arm/mach-lh7a40x/include/mach/entry-macro.S

   1 /*
   2  * arch/arm/mach-lh7a40x/include/mach/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 #include <mach/hardware.h>
  11 #include <mach/irqs.h>
  12
  13 /* In order to allow there to be support for both of the processor
  14    classes at the same time, we make a hack here that isn't very
  15    pretty.  At startup, the link pointed to with the
  16    branch_irq_lh7a400 symbol is replaced with a NOP when the CPU is
  17    detected as a lh7a404.
  18
  19    *** FIXME: we should clean this up so that there is only one
  20               implementation for each CPU's design.
  21
  22 */
  23
  24 #if defined (CONFIG_ARCH_LH7A400) && defined (CONFIG_ARCH_LH7A404)
  25
  26                 .macro  disable_fiq
  27                 .endm
  28
  29                 .macro  get_irqnr_preamble, base, tmp
  30                 .endm
  31
  32                 .macro  arch_ret_to_user, tmp1, tmp2
  33                 .endm
  34
  35                 .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
  36
  37 branch_irq_lh7a400: b 1000f
  38
  39 @ Implementation of the LH7A404 get_irqnr_and_base.
  40
  41                 mov     \irqnr, #0                      @ VIC1 irq base
  42                 mov     \base, #io_p2v(0x80000000)      @ APB registers
  43                 add     \base, \base, #0x8000
  44                 ldr     \tmp, [\base, #0x0030]          @ VIC1_VECTADDR
  45                 tst     \tmp, #VA_VECTORED              @ Direct vectored
  46                 bne     1002f
  47                 tst     \tmp, #VA_VIC1DEFAULT           @ Default vectored VIC1
  48                 ldrne   \irqstat, [\base, #0]           @ VIC1_IRQSTATUS
  49                 bne     1001f
  50                 add     \base, \base, #(0xa000 - 0x8000)
  51                 ldr     \tmp, [\base, #0x0030]          @ VIC2_VECTADDR
  52                 tst     \tmp, #VA_VECTORED              @ Direct vectored
  53                 bne     1002f
  54                 ldr     \irqstat, [\base, #0]           @ VIC2_IRQSTATUS
  55                 mov     \irqnr, #32                     @ VIC2 irq base
  56
  57 1001:           movs    \irqstat, \irqstat, lsr #1      @ Shift into carry
  58                 bcs     1008f                           @ Bit set; irq found
  59                 add     \irqnr, \irqnr, #1
  60                 bne     1001b                           @ Until no bits
  61                 b       1009f                           @ Nothing?  Hmm.
  62 1002:           and     \irqnr, \tmp, #0x3f             @ Mask for valid bits
  63 1008:           movs    \irqstat, #1                    @ Force !Z
  64                 str     \tmp, [\base, #0x0030]          @ Clear vector
  65                 b       1009f
  66
  67 @ Implementation of the LH7A400 get_irqnr_and_base.
  68
  69 1000:           mov     \irqnr, #0
  70                 mov     \base, #io_p2v(0x80000000)      @ APB registers
  71                 ldr     \irqstat, [\base, #0x500]       @ PIC INTSR
  72
  73 1001:           movs    \irqstat, \irqstat, lsr #1      @ Shift into carry
  74                 bcs     1008f                           @ Bit set; irq found
  75                 add     \irqnr, \irqnr, #1
  76                 bne     1001b                           @ Until no bits
  77                 b       1009f                           @ Nothing?  Hmm.
  78 1008:           movs    \irqstat, #1                    @ Force !Z
  79
  80 1009:
  81                .endm
  82
  83
  84
  85 #elif defined (CONFIG_ARCH_LH7A400)
  86                 .macro  disable_fiq
  87                 .endm
  88
  89                 .macro  get_irqnr_preamble, base, tmp
  90                 .endm
  91
  92                 .macro  arch_ret_to_user, tmp1, tmp2
  93                 .endm
  94
  95                 .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
  96                 mov     \irqnr, #0
  97                 mov     \base, #io_p2v(0x80000000)      @ APB registers
  98                 ldr     \irqstat, [\base, #0x500]       @ PIC INTSR
  99
 100 1001:           movs    \irqstat, \irqstat, lsr #1      @ Shift into carry
 101                 bcs     1008f                           @ Bit set; irq found
 102                 add     \irqnr, \irqnr, #1
 103                 bne     1001b                           @ Until no bits
 104                 b       1009f                           @ Nothing?  Hmm.
 105 1008:           movs    \irqstat, #1                    @ Force !Z
 106 1009:
 107                .endm
 108
 109 #elif defined(CONFIG_ARCH_LH7A404)
 110
 111                 .macro  disable_fiq
 112                 .endm
 113
 114                 .macro  get_irqnr_preamble, base, tmp
 115                 .endm
 116
 117                 .macro  arch_ret_to_user, tmp1, tmp2
 118                 .endm
 119
 120                 .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
 121                 mov     \irqnr, #0                      @ VIC1 irq base
 122                 mov     \base, #io_p2v(0x80000000)      @ APB registers
 123                 add     \base, \base, #0x8000
 124                 ldr     \tmp, [\base, #0x0030]          @ VIC1_VECTADDR
 125                 tst     \tmp, #VA_VECTORED              @ Direct vectored
 126                 bne     1002f
 127                 tst     \tmp, #VA_VIC1DEFAULT           @ Default vectored VIC1
 128                 ldrne   \irqstat, [\base, #0]           @ VIC1_IRQSTATUS
 129                 bne     1001f
 130                 add     \base, \base, #(0xa000 - 0x8000)
 131                 ldr     \tmp, [\base, #0x0030]          @ VIC2_VECTADDR
 132                 tst     \tmp, #VA_VECTORED              @ Direct vectored
 133                 bne     1002f
 134                 ldr     \irqstat, [\base, #0]           @ VIC2_IRQSTATUS
 135                 mov     \irqnr, #32                     @ VIC2 irq base
 136
 137 1001:           movs    \irqstat, \irqstat, lsr #1      @ Shift into carry
 138                 bcs     1008f                           @ Bit set; irq found
 139                 add     \irqnr, \irqnr, #1
 140                 bne     1001b                           @ Until no bits
 141                 b       1009f                           @ Nothing?  Hmm.
 142 1002:           and     \irqnr, \tmp, #0x3f             @ Mask for valid bits
 143 1008:           movs    \irqstat, #1                    @ Force !Z
 144                 str     \tmp, [\base, #0x0030]          @ Clear vector
 145 1009:
 146                .endm
 147 #endif
 148
 149