arch/arc/kernel/intc-arcv2.c

   1 /*
   2  * Copyright (C) 2014 Synopsys, Inc. (www.synopsys.com)
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  *
   8  */
   9
  10 #include <linux/interrupt.h>
  11 #include <linux/module.h>
  12 #include <linux/of.h>
  13 #include <linux/irqdomain.h>
  14 #include <linux/irqchip.h>
  15 #include <asm/irq.h>
  16
  17 #define NR_EXCEPTIONS   16
  18
  19 struct bcr_irq_arcv2 {
  20 #ifdef CONFIG_CPU_BIG_ENDIAN
  21         unsigned int pad:3, firq:1, prio:4, exts:8, irqs:8, ver:8;
  22 #else
  23         unsigned int ver:8, irqs:8, exts:8, prio:4, firq:1, pad:3;
  24 #endif
  25 };
  26
  27 /*
  28  * Early Hardware specific Interrupt setup
  29  * -Called very early (start_kernel -> setup_arch -> setup_processor)
  30  * -Platform Independent (must for any ARC Core)
  31  * -Needed for each CPU (hence not foldable into init_IRQ)
  32  */
  33 void arc_init_IRQ(void)
  34 {
  35         unsigned int tmp, irq_prio;
  36         struct bcr_irq_arcv2 irq_bcr;
  37
  38         struct aux_irq_ctrl {
  39 #ifdef CONFIG_CPU_BIG_ENDIAN
  40                 unsigned int res3:18, save_idx_regs:1, res2:1,
  41                              save_u_to_u:1, save_lp_regs:1, save_blink:1,
  42                              res:4, save_nr_gpr_pairs:5;
  43 #else
  44                 unsigned int save_nr_gpr_pairs:5, res:4,
  45                              save_blink:1, save_lp_regs:1, save_u_to_u:1,
  46                              res2:1, save_idx_regs:1, res3:18;
  47 #endif
  48         } ictrl;
  49
  50         *(unsigned int *)&ictrl = 0;
  51
  52         ictrl.save_nr_gpr_pairs = 6;    /* r0 to r11 (r12 saved manually) */
  53         ictrl.save_blink = 1;
  54         ictrl.save_lp_regs = 1;         /* LP_COUNT, LP_START, LP_END */
  55         ictrl.save_u_to_u = 0;          /* user ctxt saved on kernel stack */
  56         ictrl.save_idx_regs = 1;        /* JLI, LDI, EI */
  57
  58         WRITE_AUX(AUX_IRQ_CTRL, ictrl);
  59
  60         /*
  61          * ARCv2 core intc provides multiple interrupt priorities (upto 16).
  62          * Typical builds though have only two levels (0-high, 1-low)
  63          * Linux by default uses lower prio 1 for most irqs, reserving 0 for
  64          * NMI style interrupts in future (say perf)
  65          */
  66
  67         READ_BCR(ARC_REG_IRQ_BCR, irq_bcr);
  68
  69         irq_prio = irq_bcr.prio;        /* Encoded as N-1 for N levels */
  70         pr_info("archs-intc\t: %d priority levels (default %d)%s\n",
  71                 irq_prio + 1, ARCV2_IRQ_DEF_PRIO,
  72                 irq_bcr.firq ? " FIRQ (not used)":"");
  73
  74         /* setup status32, don't enable intr yet as kernel doesn't want */
  75         tmp = read_aux_reg(ARC_REG_STATUS32);
  76         tmp |= STATUS_AD_MASK | (ARCV2_IRQ_DEF_PRIO << 1);
  77         tmp &= ~STATUS_IE_MASK;
  78         asm volatile("kflag %0  \n"::"r"(tmp));
  79 }
  80
  81 static void arcv2_irq_mask(struct irq_data *data)
  82 {
  83         write_aux_reg(AUX_IRQ_SELECT, data->hwirq);
  84         write_aux_reg(AUX_IRQ_ENABLE, 0);
  85 }
  86
  87 static void arcv2_irq_unmask(struct irq_data *data)
  88 {
  89         write_aux_reg(AUX_IRQ_SELECT, data->hwirq);
  90         write_aux_reg(AUX_IRQ_ENABLE, 1);
  91 }
  92
  93 void arcv2_irq_enable(struct irq_data *data)
  94 {
  95         /* set default priority */
  96         write_aux_reg(AUX_IRQ_SELECT, data->hwirq);
  97         write_aux_reg(AUX_IRQ_PRIORITY, ARCV2_IRQ_DEF_PRIO);
  98
  99         /*
 100          * hw auto enables (linux unmask) all by default
 101          * So no need to do IRQ_ENABLE here
 102          * XXX: However OSCI LAN need it
 103          */
 104         write_aux_reg(AUX_IRQ_ENABLE, 1);
 105 }
 106
 107 static struct irq_chip arcv2_irq_chip = {
 108         .name           = "ARCv2 core Intc",
 109         .irq_mask       = arcv2_irq_mask,
 110         .irq_unmask     = arcv2_irq_unmask,
 111         .irq_enable     = arcv2_irq_enable
 112 };
 113
 114 static int arcv2_irq_map(struct irq_domain *d, unsigned int irq,
 115                          irq_hw_number_t hw)
 116 {
 117         /*
 118          * core intc IRQs [16, 23]:
 119          * Statically assigned always private-per-core (Timers, WDT, IPI, PCT)
 120          */
 121         if (hw < FIRST_EXT_IRQ) {
 122                 /*
 123                  * A subsequent request_percpu_irq() fails if percpu_devid is
 124                  * not set. That in turns sets NOAUTOEN, meaning each core needs
 125                  * to call enable_percpu_irq()
 126                  */
 127                 irq_set_percpu_devid(irq);
 128                 irq_set_chip_and_handler(irq, &arcv2_irq_chip, handle_percpu_irq);
 129         } else {
 130                 irq_set_chip_and_handler(irq, &arcv2_irq_chip, handle_level_irq);
 131         }
 132
 133         return 0;
 134 }
 135
 136 static const struct irq_domain_ops arcv2_irq_ops = {
 137         .xlate = irq_domain_xlate_onecell,
 138         .map = arcv2_irq_map,
 139 };
 140
 141
 142 static int __init
 143 init_onchip_IRQ(struct device_node *intc, struct device_node *parent)
 144 {
 145         struct irq_domain *root_domain;
 146         struct bcr_irq_arcv2 irq_bcr;
 147         unsigned int nr_cpu_irqs;
 148
 149         READ_BCR(ARC_REG_IRQ_BCR, irq_bcr);
 150         nr_cpu_irqs = irq_bcr.irqs + NR_EXCEPTIONS;
 151
 152         if (parent)
 153                 panic("DeviceTree incore intc not a root irq controller\n");
 154
 155         root_domain = irq_domain_add_linear(intc, nr_cpu_irqs, &arcv2_irq_ops, NULL);
 156         if (!root_domain)
 157                 panic("root irq domain not avail\n");
 158
 159         /*
 160          * Needed for primary domain lookup to succeed
 161          * This is a primary irqchip, and can never have a parent
 162          */
 163         irq_set_default_host(root_domain);
 164
 165 #ifdef CONFIG_SMP
 166         irq_create_mapping(root_domain, IPI_IRQ);
 167 #endif
 168         irq_create_mapping(root_domain, SOFTIRQ_IRQ);
 169
 170         return 0;
 171 }
 172
 173 IRQCHIP_DECLARE(arc_intc, "snps,archs-intc", init_onchip_IRQ);