From: Palmer Dabbelt <[email protected]>

This patch adds a driver that manages the local interrupts on each
RISC-V hart, as specifiec by the RISC-V supervisor level ISA manual.
The local interrupt controller manages software interrupts, timer
interrupts, and hardware interrupts (which are routed via the
platform level interrupt controller).  Per-hart local interrupt
controllers are found on all RISC-V systems.

Signed-off-by: Palmer Dabbelt <[email protected]>
[hch: Kconfig simplifications, various cleanups]
Signed-off-by: Christoph Hellwig <[email protected]>
---
 drivers/irqchip/Kconfig          |   4 +
 drivers/irqchip/Makefile         |   1 +
 drivers/irqchip/irq-riscv-intc.c | 197 +++++++++++++++++++++++++++++++
 3 files changed, 202 insertions(+)
 create mode 100644 drivers/irqchip/irq-riscv-intc.c

diff --git a/drivers/irqchip/Kconfig b/drivers/irqchip/Kconfig
index e9233db16e03..8460fdcecc2c 100644
--- a/drivers/irqchip/Kconfig
+++ b/drivers/irqchip/Kconfig
@@ -372,3 +372,7 @@ config QCOM_PDC
          IRQs for Qualcomm Technologies Inc (QTI) mobile chips.
 
 endmenu
+
+config RISCV_INTC
+       def_bool y
+       depends on RISCV
diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile
index 15f268f646bf..74e333cc274c 100644
--- a/drivers/irqchip/Makefile
+++ b/drivers/irqchip/Makefile
@@ -87,3 +87,4 @@ obj-$(CONFIG_MESON_IRQ_GPIO)          += irq-meson-gpio.o
 obj-$(CONFIG_GOLDFISH_PIC)             += irq-goldfish-pic.o
 obj-$(CONFIG_NDS32)                    += irq-ativic32.o
 obj-$(CONFIG_QCOM_PDC)                 += qcom-pdc.o
+obj-$(CONFIG_RISCV_INTC)               += irq-riscv-intc.o
diff --git a/drivers/irqchip/irq-riscv-intc.c b/drivers/irqchip/irq-riscv-intc.c
new file mode 100644
index 000000000000..883efaa154b8
--- /dev/null
+++ b/drivers/irqchip/irq-riscv-intc.c
@@ -0,0 +1,197 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2012 Regents of the University of California
+ * Copyright (C) 2017 SiFive
+ */
+#include <linux/irq.h>
+#include <linux/irqchip.h>
+#include <linux/irqdomain.h>
+#include <linux/interrupt.h>
+#include <linux/of.h>
+#include <linux/smp.h>
+#include <asm/sbi.h>
+
+#define NR_RISCV_IRQS (8 * sizeof(uintptr_t))
+
+/*
+ * Possible interrupt causes:
+ */
+#define INTERRUPT_CAUSE_SOFTWARE    1
+#define INTERRUPT_CAUSE_TIMER       5
+#define INTERRUPT_CAUSE_EXTERNAL    9
+
+/*
+ * The high order bit of the trap cause register is always set for
+ * interrupts, which allows us to differentiate them from exceptions
+ * quickly.  The INTERRUPT_CAUSE_* macros don't contain that bit, so we
+ * need to mask it off.
+ */
+#define INTERRUPT_CAUSE_MASK   (1UL << (NR_RISCV_IRQS - 1))
+
+struct riscv_irq_data {
+       struct irq_chip         chip;
+       struct irq_domain       *domain;
+       int                     hart;
+       char                    name[20];
+};
+
+static DEFINE_PER_CPU(struct riscv_irq_data, riscv_irq_data);
+
+static void riscv_intc_irq(struct pt_regs *regs)
+{
+       struct pt_regs *old_regs = set_irq_regs(regs);
+       unsigned long cause = csr_read(scause);
+       struct irq_domain *domain;
+
+       WARN_ON((cause & INTERRUPT_CAUSE_MASK) == 0);
+       cause &= ~INTERRUPT_CAUSE_MASK;
+
+       irq_enter();
+
+       /*
+        * There are three classes of interrupt: timer, software, and
+        * external devices.  We dispatch between them here.  External
+        * device interrupts use the generic IRQ mechanisms.
+        */
+       switch (cause) {
+       case INTERRUPT_CAUSE_TIMER:
+               riscv_timer_interrupt();
+               break;
+       case INTERRUPT_CAUSE_SOFTWARE:
+               riscv_software_interrupt();
+               break;
+       default:
+               domain = per_cpu(riscv_irq_data, smp_processor_id()).domain;
+               generic_handle_irq(irq_find_mapping(domain, cause));
+               break;
+       }
+
+       irq_exit();
+       set_irq_regs(old_regs);
+}
+
+static int riscv_irqdomain_map(struct irq_domain *d, unsigned int irq,
+                              irq_hw_number_t hwirq)
+{
+       struct riscv_irq_data *data = d->host_data;
+
+       irq_set_chip_and_handler(irq, &data->chip, handle_simple_irq);
+       irq_set_chip_data(irq, data);
+       irq_set_noprobe(irq);
+       irq_set_affinity(irq, cpumask_of(data->hart));
+       return 0;
+}
+
+static const struct irq_domain_ops riscv_irqdomain_ops = {
+       .map    = riscv_irqdomain_map,
+       .xlate  = irq_domain_xlate_onecell,
+};
+
+/*
+ * On RISC-V systems local interrupts are masked or unmasked by writing the SIE
+ * (Supervisor Interrupt Enable) CSR.  As CSRs can only be written on the local
+ * hart, these functions can only be called on the hart that corresponds to the
+ * IRQ chip.  They are only called internally to this module, so they BUG_ON if
+ * this condition is violated rather than attempting to handle the error by
+ * forwarding to the target hart, as that's already expected to have been done.
+ */
+static void riscv_irq_mask(struct irq_data *d)
+{
+       struct riscv_irq_data *data = irq_data_get_irq_chip_data(d);
+
+       BUG_ON(smp_processor_id() != data->hart);
+       csr_clear(sie, 1 << d->hwirq);
+}
+
+static void riscv_irq_unmask(struct irq_data *d)
+{
+       struct riscv_irq_data *data = irq_data_get_irq_chip_data(d);
+
+       BUG_ON(smp_processor_id() != data->hart);
+       csr_set(sie, 1 << d->hwirq);
+}
+
+/* Callbacks for twiddling SIE on another hart. */
+static void riscv_irq_enable_helper(void *d)
+{
+       riscv_irq_unmask(d);
+}
+
+static void riscv_irq_disable_helper(void *d)
+{
+       riscv_irq_mask(d);
+}
+
+static void riscv_remote_ctrl(unsigned int cpu, void (*fn)(void *d),
+                             struct irq_data *data)
+{
+       smp_call_function_single(cpu, fn, data, true);
+}
+
+static void riscv_irq_enable(struct irq_data *d)
+{
+       struct riscv_irq_data *data = irq_data_get_irq_chip_data(d);
+
+       /*
+        * It's only possible to write SIE on the current hart.  This jumps
+        * over to the target hart if it's not the current one.  It's invalid
+        * to write SIE on a hart that's not currently running.
+        */
+       if (data->hart == smp_processor_id())
+               riscv_irq_unmask(d);
+       else if (cpu_online(data->hart))
+               riscv_remote_ctrl(data->hart, riscv_irq_enable_helper, d);
+       else
+               WARN_ON_ONCE(1);
+}
+
+static void riscv_irq_disable(struct irq_data *d)
+{
+       struct riscv_irq_data *data = irq_data_get_irq_chip_data(d);
+
+       /*
+        * It's only possible to write SIE on the current hart.  This jumps
+        * over to the target hart if it's not the current one.  It's invalid
+        * to write SIE on a hart that's not currently running.
+        */
+       if (data->hart == smp_processor_id())
+               riscv_irq_mask(d);
+       else if (cpu_online(data->hart))
+               riscv_remote_ctrl(data->hart, riscv_irq_disable_helper, d);
+       else
+               WARN_ON_ONCE(1);
+}
+
+static int __init riscv_intc_init(struct device_node *node,
+                                 struct device_node *parent)
+{
+       struct riscv_irq_data *data;
+       int hart;
+
+       hart = riscv_of_processor_hart(node->parent);
+       if (hart < 0)
+               return -EIO;
+
+       data = &per_cpu(riscv_irq_data, hart);
+       snprintf(data->name, sizeof(data->name), "riscv,cpu_intc,%d", hart);
+       data->hart = hart;
+       data->chip.name = data->name;
+       data->chip.irq_mask = riscv_irq_mask;
+       data->chip.irq_unmask = riscv_irq_unmask;
+       data->chip.irq_enable = riscv_irq_enable;
+       data->chip.irq_disable = riscv_irq_disable;
+       data->domain = irq_domain_add_linear(node, NR_RISCV_IRQS,
+                       &riscv_irqdomain_ops, data);
+       if (!data->domain)
+               goto error_add_linear;
+
+       set_handle_irq(&riscv_intc_irq);
+       pr_info("%s: %lu local interrupts mapped\n", data->name, NR_RISCV_IRQS);
+       return 0;
+
+error_add_linear:
+       pr_warn("%s: unable to add IRQ domain\n", data->name);
+       return -ENXIO;
+}
+
+IRQCHIP_DECLARE(riscv, "riscv,cpu-intc", riscv_intc_init);
-- 
2.18.0

Reply via email to