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, i;
  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         /*
  75          * Set a default priority for all available interrupts to prevent
  76          * switching of register banks if Fast IRQ and multiple register banks
  77          * are supported by CPU.
  78          */
  79         for (i = NR_EXCEPTIONS; i < irq_bcr.irqs + NR_EXCEPTIONS; i++) {
  80                 write_aux_reg(AUX_IRQ_SELECT, i);
  81                 write_aux_reg(AUX_IRQ_PRIORITY, ARCV2_IRQ_DEF_PRIO);
  82         }
  83
  84         /* setup status32, don't enable intr yet as kernel doesn't want */
  85         tmp = read_aux_reg(ARC_REG_STATUS32);
  86         tmp |= STATUS_AD_MASK | (ARCV2_IRQ_DEF_PRIO << 1);
  87         tmp &= ~STATUS_IE_MASK;
  88         asm volatile("kflag %0  \n"::"r"(tmp));
  89 }
  90
  91 static void arcv2_irq_mask(struct irq_data *data)
  92 {
  93         write_aux_reg(AUX_IRQ_SELECT, data->hwirq);
  94         write_aux_reg(AUX_IRQ_ENABLE, 0);
  95 }
  96
  97 static void arcv2_irq_unmask(struct irq_data *data)
  98 {
  99         write_aux_reg(AUX_IRQ_SELECT, data->hwirq);
 100         write_aux_reg(AUX_IRQ_ENABLE, 1);
 101 }
 102
 103 void arcv2_irq_enable(struct irq_data *data)
 104 {
 105         /* set default priority */
 106         write_aux_reg(AUX_IRQ_SELECT, data->hwirq);
 107         write_aux_reg(AUX_IRQ_PRIORITY, ARCV2_IRQ_DEF_PRIO);
 108
 109         /*
 110          * hw auto enables (linux unmask) all by default
 111          * So no need to do IRQ_ENABLE here
 112          * XXX: However OSCI LAN need it
 113          */
 114         write_aux_reg(AUX_IRQ_ENABLE, 1);
 115 }
 116
 117 static struct irq_chip arcv2_irq_chip = {
 118         .name           = "ARCv2 core Intc",
 119         .irq_mask       = arcv2_irq_mask,
 120         .irq_unmask     = arcv2_irq_unmask,
 121         .irq_enable     = arcv2_irq_enable
 122 };
 123
 124 static int arcv2_irq_map(struct irq_domain *d, unsigned int irq,
 125                          irq_hw_number_t hw)
 126 {
 127         /*
 128          * core intc IRQs [16, 23]:
 129          * Statically assigned always private-per-core (Timers, WDT, IPI, PCT)
 130          */
 131         if (hw < FIRST_EXT_IRQ) {
 132                 /*
 133                  * A subsequent request_percpu_irq() fails if percpu_devid is
 134                  * not set. That in turns sets NOAUTOEN, meaning each core needs
 135                  * to call enable_percpu_irq()
 136                  */
 137                 irq_set_percpu_devid(irq);
 138                 irq_set_chip_and_handler(irq, &arcv2_irq_chip, handle_percpu_irq);
 139         } else {
 140                 irq_set_chip_and_handler(irq, &arcv2_irq_chip, handle_level_irq);
 141         }
 142
 143         return 0;
 144 }
 145
 146 static const struct irq_domain_ops arcv2_irq_ops = {
 147         .xlate = irq_domain_xlate_onecell,
 148         .map = arcv2_irq_map,
 149 };
 150
 151
 152 static int __init
 153 init_onchip_IRQ(struct device_node *intc, struct device_node *parent)
 154 {
 155         struct irq_domain *root_domain;
 156         struct bcr_irq_arcv2 irq_bcr;
 157         unsigned int nr_cpu_irqs;
 158
 159         READ_BCR(ARC_REG_IRQ_BCR, irq_bcr);
 160         nr_cpu_irqs = irq_bcr.irqs + NR_EXCEPTIONS;
 161
 162         if (parent)
 163                 panic("DeviceTree incore intc not a root irq controller\n");
 164
 165         root_domain = irq_domain_add_linear(intc, nr_cpu_irqs, &arcv2_irq_ops, NULL);
 166         if (!root_domain)
 167                 panic("root irq domain not avail\n");
 168
 169         /*
 170          * Needed for primary domain lookup to succeed
 171          * This is a primary irqchip, and can never have a parent
 172          */
 173         irq_set_default_host(root_domain);
 174
 175 #ifdef CONFIG_SMP
 176         irq_create_mapping(root_domain, IPI_IRQ);
 177 #endif
 178         irq_create_mapping(root_domain, SOFTIRQ_IRQ);
 179
 180         return 0;
 181 }
 182
 183 IRQCHIP_DECLARE(arc_intc, "snps,archs-intc", init_onchip_IRQ);