arch/mips/ar7/irq.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
   4  * Copyright (C) 2006,2007 Eugene Konev <ejka@openwrt.org>
   5  */
   6
   7 #include <linux/interrupt.h>
   8 #include <linux/io.h>
   9 #include <linux/irq.h>
  10
  11 #include <asm/irq_cpu.h>
  12 #include <asm/mipsregs.h>
  13 #include <asm/mach-ar7/ar7.h>
  14
  15 #define EXCEPT_OFFSET   0x80
  16 #define PACE_OFFSET     0xA0
  17 #define CHNLS_OFFSET    0x200
  18
  19 #define REG_OFFSET(irq, reg)    ((irq) / 32 * 0x4 + reg * 0x10)
  20 #define SEC_REG_OFFSET(reg)     (EXCEPT_OFFSET + reg * 0x8)
  21 #define SEC_SR_OFFSET           (SEC_REG_OFFSET(0))     /* 0x80 */
  22 #define CR_OFFSET(irq)          (REG_OFFSET(irq, 1))    /* 0x10 */
  23 #define SEC_CR_OFFSET           (SEC_REG_OFFSET(1))     /* 0x88 */
  24 #define ESR_OFFSET(irq)         (REG_OFFSET(irq, 2))    /* 0x20 */
  25 #define SEC_ESR_OFFSET          (SEC_REG_OFFSET(2))     /* 0x90 */
  26 #define ECR_OFFSET(irq)         (REG_OFFSET(irq, 3))    /* 0x30 */
  27 #define SEC_ECR_OFFSET          (SEC_REG_OFFSET(3))     /* 0x98 */
  28 #define PIR_OFFSET              (0x40)
  29 #define MSR_OFFSET              (0x44)
  30 #define PM_OFFSET(irq)          (REG_OFFSET(irq, 5))    /* 0x50 */
  31 #define TM_OFFSET(irq)          (REG_OFFSET(irq, 6))    /* 0x60 */
  32
  33 #define REG(addr) ((u32 *)(KSEG1ADDR(AR7_REGS_IRQ) + addr))
  34
  35 #define CHNL_OFFSET(chnl) (CHNLS_OFFSET + (chnl * 4))
  36
  37 static int ar7_irq_base;
  38
  39 static void ar7_unmask_irq(struct irq_data *d)
  40 {
  41         writel(1 << ((d->irq - ar7_irq_base) % 32),
  42                REG(ESR_OFFSET(d->irq - ar7_irq_base)));
  43 }
  44
  45 static void ar7_mask_irq(struct irq_data *d)
  46 {
  47         writel(1 << ((d->irq - ar7_irq_base) % 32),
  48                REG(ECR_OFFSET(d->irq - ar7_irq_base)));
  49 }
  50
  51 static void ar7_ack_irq(struct irq_data *d)
  52 {
  53         writel(1 << ((d->irq - ar7_irq_base) % 32),
  54                REG(CR_OFFSET(d->irq - ar7_irq_base)));
  55 }
  56
  57 static void ar7_unmask_sec_irq(struct irq_data *d)
  58 {
  59         writel(1 << (d->irq - ar7_irq_base - 40), REG(SEC_ESR_OFFSET));
  60 }
  61
  62 static void ar7_mask_sec_irq(struct irq_data *d)
  63 {
  64         writel(1 << (d->irq - ar7_irq_base - 40), REG(SEC_ECR_OFFSET));
  65 }
  66
  67 static void ar7_ack_sec_irq(struct irq_data *d)
  68 {
  69         writel(1 << (d->irq - ar7_irq_base - 40), REG(SEC_CR_OFFSET));
  70 }
  71
  72 static struct irq_chip ar7_irq_type = {
  73         .name = "AR7",
  74         .irq_unmask = ar7_unmask_irq,
  75         .irq_mask = ar7_mask_irq,
  76         .irq_ack = ar7_ack_irq
  77 };
  78
  79 static struct irq_chip ar7_sec_irq_type = {
  80         .name = "AR7",
  81         .irq_unmask = ar7_unmask_sec_irq,
  82         .irq_mask = ar7_mask_sec_irq,
  83         .irq_ack = ar7_ack_sec_irq,
  84 };
  85
  86 static void __init ar7_irq_init(int base)
  87 {
  88         int i;
  89         /*
  90          * Disable interrupts and clear pending
  91          */
  92         writel(0xffffffff, REG(ECR_OFFSET(0)));
  93         writel(0xff, REG(ECR_OFFSET(32)));
  94         writel(0xffffffff, REG(SEC_ECR_OFFSET));
  95         writel(0xffffffff, REG(CR_OFFSET(0)));
  96         writel(0xff, REG(CR_OFFSET(32)));
  97         writel(0xffffffff, REG(SEC_CR_OFFSET));
  98
  99         ar7_irq_base = base;
 100
 101         for (i = 0; i < 40; i++) {
 102                 writel(i, REG(CHNL_OFFSET(i)));
 103                 /* Primary IRQ's */
 104                 irq_set_chip_and_handler(base + i, &ar7_irq_type,
 105                                          handle_level_irq);
 106                 /* Secondary IRQ's */
 107                 if (i < 32)
 108                         irq_set_chip_and_handler(base + i + 40,
 109                                                  &ar7_sec_irq_type,
 110                                                  handle_level_irq);
 111         }
 112
 113         if (request_irq(2, no_action, IRQF_NO_THREAD, "AR7 cascade interrupt",
 114                         NULL))
 115                 pr_err("Failed to request irq 2 (AR7 cascade interrupt)\n");
 116         if (request_irq(ar7_irq_base, no_action, IRQF_NO_THREAD,
 117                         "AR7 cascade interrupt", NULL)) {
 118                 pr_err("Failed to request irq %d (AR7 cascade interrupt)\n",
 119                        ar7_irq_base);
 120         }
 121         set_c0_status(IE_IRQ0);
 122 }
 123
 124 void __init arch_init_irq(void)
 125 {
 126         mips_cpu_irq_init();
 127         ar7_irq_init(8);
 128 }
 129
 130 static void ar7_cascade(void)
 131 {
 132         u32 status;
 133         int i, irq;
 134
 135         /* Primary IRQ's */
 136         irq = readl(REG(PIR_OFFSET)) & 0x3f;
 137         if (irq) {
 138                 do_IRQ(ar7_irq_base + irq);
 139                 return;
 140         }
 141
 142         /* Secondary IRQ's are cascaded through primary '0' */
 143         writel(1, REG(CR_OFFSET(irq)));
 144         status = readl(REG(SEC_SR_OFFSET));
 145         for (i = 0; i < 32; i++) {
 146                 if (status & 1) {
 147                         do_IRQ(ar7_irq_base + i + 40);
 148                         return;
 149                 }
 150                 status >>= 1;
 151         }
 152
 153         spurious_interrupt();
 154 }
 155
 156 asmlinkage void plat_irq_dispatch(void)
 157 {
 158         unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM;
 159         if (pending & STATUSF_IP7)              /* cpu timer */
 160                 do_IRQ(7);
 161         else if (pending & STATUSF_IP2)         /* int0 hardware line */
 162                 ar7_cascade();
 163         else
 164                 spurious_interrupt();
 165 }