From: "Andreas Färber" <afaerber@suse.de>
To: linux-arm-kernel@lists.infradead.org
Cc: "Wells Lu 呂芳騰" <wells.lu@sunplus.com>,
"Dvorkin Dmitry" <dvorkin@tibbo.com>,
linux-kernel@vger.kernel.org, "Andreas Färber" <afaerber@suse.de>,
"Thomas Gleixner" <tglx@linutronix.de>,
"Jason Cooper" <jason@lakedaemon.net>,
"Marc Zyngier" <maz@kernel.org>
Subject: [RFC 09/11] irqchip: Add Sunplus SP7021 interrupt (mux) controller
Date: Sun, 8 Mar 2020 17:32:27 +0100 [thread overview]
Message-ID: <20200308163230.4002-10-afaerber@suse.de> (raw)
In-Reply-To: <20200308163230.4002-1-afaerber@suse.de>
Signed-off-by: Andreas Färber <afaerber@suse.de>
---
drivers/irqchip/Makefile | 1 +
drivers/irqchip/irq-sp7021.c | 285 +++++++++++++++++++++++++++++++++++++++++++
2 files changed, 286 insertions(+)
create mode 100644 drivers/irqchip/irq-sp7021.c
diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile
index eae0d78cbf22..a6b70d666739 100644
--- a/drivers/irqchip/Makefile
+++ b/drivers/irqchip/Makefile
@@ -105,3 +105,4 @@ obj-$(CONFIG_MADERA_IRQ) += irq-madera.o
obj-$(CONFIG_LS1X_IRQ) += irq-ls1x.o
obj-$(CONFIG_TI_SCI_INTR_IRQCHIP) += irq-ti-sci-intr.o
obj-$(CONFIG_TI_SCI_INTA_IRQCHIP) += irq-ti-sci-inta.o
+obj-$(CONFIG_ARCH_SUNPLUS) += irq-sp7021.o
diff --git a/drivers/irqchip/irq-sp7021.c b/drivers/irqchip/irq-sp7021.c
new file mode 100644
index 000000000000..a0b7972f2abb
--- /dev/null
+++ b/drivers/irqchip/irq-sp7021.c
@@ -0,0 +1,285 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+/*
+ * Sunplus Plus1 SP7021 SoC interrupt controller
+ *
+ * Copyright (c) 2020 Andreas Färber
+ */
+
+#include <linux/bitfield.h>
+#include <linux/bitops.h>
+#include <linux/irq.h>
+#include <linux/irqchip.h>
+#include <linux/irqchip/chained_irq.h>
+#include <linux/irqdomain.h>
+#include <linux/of_address.h>
+#include <linux/of_irq.h>
+
+#define REG_INTC_INTR_TYPE(i) (0x0 + (i) * 4)
+#define REG_INTC_INTR_POLARITY(i) (0x1c + (i) * 4)
+#define REG_INTC_INTR_PRIO(i) (0x38 + (i) * 4)
+#define REG_INTC_INTR_MASK(i) (0x54 + (i) * 4)
+
+#define REG_INTC_INTR_CLR(i) (0x0 + (i) * 4)
+#define REG_INTC_MASKED_FIQS(i) (0x1c + (i) * 4)
+#define REG_INTC_MASKED_IRQS(i) (0x38 + (i) * 4)
+#define REG_INTC_INTR_GROUP 0x7c
+
+#define INTC_INTR_GROUP_FIQ GENMASK(6, 0)
+#define INTC_INTR_GROUP_IRQ GENMASK(14, 8)
+
+struct sp7021_intc_data {
+ void __iomem *base0;
+ void __iomem *base1;
+ int ext0_irq;
+ int ext1_irq;
+ struct irq_chip chip;
+ struct irq_domain *domain;
+ raw_spinlock_t lock;
+};
+
+static void sp7021_intc_ext0_irq_handle(struct irq_desc *desc)
+{
+ struct sp7021_intc_data *s = irq_desc_get_handler_data(desc);
+ struct irq_chip *chip = irq_desc_get_chip(desc);
+ u32 mask, masked;
+ int i, j;
+
+ chained_irq_enter(chip, desc);
+
+ mask = readl_relaxed(s->base1 + REG_INTC_INTR_GROUP);
+ mask = FIELD_GET(INTC_INTR_GROUP_IRQ, mask);
+ while (mask) {
+ i = fls(mask) - 1;
+ mask &= ~BIT(i);
+
+ masked = readl_relaxed(s->base1 + REG_INTC_MASKED_IRQS(i));
+ while (masked) {
+ j = fls(masked) - 1;
+ masked &= ~BIT(j);
+
+ generic_handle_irq(irq_find_mapping(s->domain,
+ i * 32 + j));
+ }
+ }
+
+ chained_irq_exit(chip, desc);
+}
+
+static void sp7021_intc_ext1_irq_handle(struct irq_desc *desc)
+{
+ struct sp7021_intc_data *s = irq_desc_get_handler_data(desc);
+ struct irq_chip *chip = irq_desc_get_chip(desc);
+ u32 mask, masked;
+ int i, j;
+
+ chained_irq_enter(chip, desc);
+
+ mask = readl_relaxed(s->base1 + REG_INTC_INTR_GROUP);
+ mask = FIELD_GET(INTC_INTR_GROUP_FIQ, mask);
+ while (mask) {
+ i = fls(mask) - 1;
+ mask &= ~BIT(i);
+
+ masked = readl_relaxed(s->base1 + REG_INTC_MASKED_FIQS(i));
+ while (masked) {
+ j = fls(masked) - 1;
+ masked &= ~BIT(j);
+
+ generic_handle_irq(irq_find_mapping(s->domain,
+ i * 32 + j));
+ }
+ }
+
+ chained_irq_exit(chip, desc);
+}
+
+static void sp7021_intc_ack_irq(struct irq_data *data)
+{
+ struct sp7021_intc_data *s = irq_data_get_irq_chip_data(data);
+ unsigned int idx;
+ u32 mask;
+
+ idx = data->hwirq / 32;
+
+ mask = BIT(data->hwirq % 32);
+ writel_relaxed(mask, s->base1 + REG_INTC_INTR_CLR(idx));
+}
+
+static void sp7021_intc_mask_irq(struct irq_data *data)
+{
+ struct sp7021_intc_data *s = irq_data_get_irq_chip_data(data);
+ unsigned long flags;
+ unsigned int idx;
+ u32 mask;
+
+ idx = data->hwirq / 32;
+
+ raw_spin_lock_irqsave(&s->lock, flags);
+
+ mask = readl_relaxed(s->base0 + REG_INTC_INTR_MASK(idx));
+ mask &= ~BIT(data->hwirq % 32);
+ writel_relaxed(mask, s->base0 + REG_INTC_INTR_MASK(idx));
+
+ raw_spin_unlock_irqrestore(&s->lock, flags);
+}
+
+static void sp7021_intc_unmask_irq(struct irq_data *data)
+{
+ struct sp7021_intc_data *s = irq_data_get_irq_chip_data(data);
+ unsigned long flags;
+ unsigned int idx;
+ u32 mask;
+
+ idx = data->hwirq / 32;
+
+ raw_spin_lock_irqsave(&s->lock, flags);
+
+ mask = readl_relaxed(s->base0 + REG_INTC_INTR_MASK(idx));
+ mask |= BIT(data->hwirq % 32);
+ writel_relaxed(mask, s->base0 + REG_INTC_INTR_MASK(idx));
+
+ raw_spin_unlock_irqrestore(&s->lock, flags);
+}
+
+static int sp7021_intc_set_irq_type(struct irq_data *data, unsigned int flow_type)
+{
+ struct sp7021_intc_data *s = irq_data_get_irq_chip_data(data);
+ unsigned long flags;
+ unsigned int idx;
+ u32 mask, type, polarity;
+
+ idx = data->hwirq / 32;
+ mask = BIT(data->hwirq % 32);
+
+ if (flow_type & IRQ_TYPE_LEVEL_MASK)
+ irq_set_chip_handler_name_locked(data, &s->chip, handle_level_irq, NULL);
+ else
+ irq_set_chip_handler_name_locked(data, &s->chip, handle_edge_irq, NULL);
+
+ raw_spin_lock_irqsave(&s->lock, flags);
+
+ type = readl_relaxed(s->base0 + REG_INTC_INTR_TYPE(idx));
+ polarity = readl_relaxed(s->base0 + REG_INTC_INTR_POLARITY(idx));
+
+ switch (flow_type) {
+ case IRQ_TYPE_EDGE_RISING:
+ type |= mask;
+ polarity &= ~mask;
+ break;
+ case IRQ_TYPE_EDGE_FALLING:
+ type |= mask;
+ polarity |= mask;
+ break;
+ case IRQ_TYPE_LEVEL_HIGH:
+ type &= ~mask;
+ polarity &= ~mask;
+ break;
+ case IRQ_TYPE_LEVEL_LOW:
+ type &= ~mask;
+ polarity |= mask;
+ break;
+ default:
+ raw_spin_unlock_irqrestore(&s->lock, flags);
+ return -EBADR;
+ }
+
+ writel_relaxed(type, s->base0 + REG_INTC_INTR_TYPE(idx));
+ writel_relaxed(polarity, s->base0 + REG_INTC_INTR_POLARITY(idx));
+
+ raw_spin_unlock_irqrestore(&s->lock, flags);
+
+ return IRQ_SET_MASK_OK;
+}
+
+static const struct irq_chip sp7021_intc_irq_chip = {
+ .name = "SP7021-A",
+ .irq_ack = sp7021_intc_ack_irq,
+ .irq_mask = sp7021_intc_mask_irq,
+ .irq_unmask = sp7021_intc_unmask_irq,
+ .irq_set_type = sp7021_intc_set_irq_type,
+};
+
+static int sp7021_intc_irq_domain_map(struct irq_domain *d,
+ unsigned int irq, irq_hw_number_t hw)
+{
+ struct sp7021_intc_data *s = d->host_data;
+ unsigned int idx;
+ u32 mask, type;
+
+ idx = hw / 32;
+ mask = BIT(hw % 32);
+
+ type = readl_relaxed(s->base0 + REG_INTC_INTR_TYPE(idx));
+
+ irq_set_chip_and_handler(irq, &s->chip, (type & mask) ? handle_edge_irq : handle_level_irq);
+ irq_set_chip_data(irq, s);
+ irq_set_probe(irq);
+
+ return 0;
+}
+
+static const struct irq_domain_ops sp7021_intc_domain_ops = {
+ .xlate = irq_domain_xlate_onecell,
+ .map = sp7021_intc_irq_domain_map,
+};
+
+int __init sp7021_intc_init(struct device_node *node, struct device_node *parent)
+{
+ struct sp7021_intc_data *s;
+ void __iomem *base0, *base1;
+ int i;
+
+ base0 = of_iomap(node, 0);
+ if (!base0)
+ return -EIO;
+
+ base1 = of_iomap(node, 1);
+ if (!base1)
+ return -EIO;
+
+ s = kzalloc(sizeof(*s), GFP_KERNEL);
+ if (!s)
+ return -ENOMEM;
+
+ s->base0 = base0;
+ s->base1 = base1;
+ s->chip = sp7021_intc_irq_chip;
+
+ s->ext0_irq = irq_of_parse_and_map(node, 0);
+ if (s->ext0_irq <= 0) {
+ kfree(s);
+ return -EINVAL;
+ }
+
+ s->ext1_irq = irq_of_parse_and_map(node, 1);
+ if (s->ext1_irq <= 0) {
+ kfree(s);
+ return -EINVAL;
+ }
+
+ raw_spin_lock_init(&s->lock);
+
+ for (i = 0; i < 7; i++) {
+ writel_relaxed(0, s->base0 + REG_INTC_INTR_MASK(i));
+ writel_relaxed(~0, s->base0 + REG_INTC_INTR_TYPE(i));
+ writel_relaxed(0, s->base0 + REG_INTC_INTR_POLARITY(i));
+
+ /* irq, not fiq */
+ writel_relaxed(~0, s->base0 + REG_INTC_INTR_PRIO(i));
+
+ writel_relaxed(~0, s->base1 + REG_INTC_INTR_CLR(i));
+ }
+
+ s->domain = irq_domain_add_linear(node, 200, &sp7021_intc_domain_ops,
+ s);
+ if (!s->domain) {
+ kfree(s);
+ return -ENOMEM;
+ }
+
+ irq_set_chained_handler_and_data(s->ext0_irq, sp7021_intc_ext0_irq_handle, s);
+ irq_set_chained_handler_and_data(s->ext1_irq, sp7021_intc_ext1_irq_handle, s);
+
+ return 0;
+}
+IRQCHIP_DECLARE(sp7021_intc, "sunplus,sp7021-intc", sp7021_intc_init);
--
2.16.4
next prev parent reply other threads:[~2020-03-08 16:33 UTC|newest]
Thread overview: 16+ messages / expand[flat|nested] mbox.gz Atom feed top
2020-03-08 16:32 [RFC 00/11] ARM: Initial Sunplus Plus1 SP7021 and BPI-F2S support Andreas Färber
2020-03-08 16:32 ` [RFC 01/11] dt-bindings: vendor-prefixes: Add Sunplus Andreas Färber
2020-03-08 16:32 ` [RFC 02/11] dt-bindings: arm: Add Sunplus SP7021 and Banana Pi BPI-F2S Andreas Färber
2020-03-08 16:32 ` [RFC 03/11] ARM: Prepare Sunplus Plus1 SoC family Andreas Färber
2020-03-08 16:32 ` [RFC 04/11] dt-bindings: interrupt-controller: Add Sunplus SP7021 mux Andreas Färber
2020-03-23 19:48 ` Rob Herring
2020-03-08 16:32 ` [RFC 05/11] dt-bindings: serial: Add Sunplus SP7021 UART Andreas Färber
2020-03-23 19:50 ` Rob Herring
2020-03-08 16:32 ` [RFC 06/11] tty: serial: Add Sunplus Plus1 UART earlycon Andreas Färber
2020-03-08 16:32 ` [RFC 07/11] ARM: dts: Add Sunplus Plus1 SP7021 and Banana Pi F2S Andreas Färber
2020-03-08 16:32 ` [RFC 08/11] tty: serial: sunplus: Implement full UART driver Andreas Färber
2020-03-08 16:32 ` Andreas Färber [this message]
2020-03-08 17:57 ` [RFC 09/11] irqchip: Add Sunplus SP7021 interrupt (mux) controller Marc Zyngier
2020-03-08 16:32 ` [RFC 10/11] ARM: dts: sp7021-cpu: Add interrupt controller node Andreas Färber
2020-03-08 16:32 ` [RFC 11/11] ARM: dts: sp7021-cpu: Add dummy UART0 clock and interrupt Andreas Färber
2020-03-09 5:32 ` [RFC 00/11] ARM: Initial Sunplus Plus1 SP7021 and BPI-F2S support Wells Lu 呂芳騰
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20200308163230.4002-10-afaerber@suse.de \
--to=afaerber@suse.de \
--cc=dvorkin@tibbo.com \
--cc=jason@lakedaemon.net \
--cc=linux-arm-kernel@lists.infradead.org \
--cc=linux-kernel@vger.kernel.org \
--cc=maz@kernel.org \
--cc=tglx@linutronix.de \
--cc=wells.lu@sunplus.com \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).