[PATCH v3 12/15] [NOT FOR MERGE] irqchip/mbox: Introduce a mailbox-backed irqchip driver

From: Samuel Holland
Date: Fri Mar 01 2019 - 23:30:11 EST


This driver implements a simple interrupt controller using message
passing over a mailbox channel. The intention is for the other end of
the channel to be implemented in firmware. This allows filtering and
forwarding interrupts from one processor to another.

Signed-off-by: Samuel Holland <samuel@xxxxxxxxxxxx>
---
drivers/irqchip/Kconfig | 9 ++
drivers/irqchip/Makefile | 1 +
drivers/irqchip/irq-mbox.c | 199 +++++++++++++++++++++++++++++++++++++
3 files changed, 209 insertions(+)
create mode 100644 drivers/irqchip/irq-mbox.c

diff --git a/drivers/irqchip/Kconfig b/drivers/irqchip/Kconfig
index 3d1e60779078..d22921276797 100644
--- a/drivers/irqchip/Kconfig
+++ b/drivers/irqchip/Kconfig
@@ -406,6 +406,15 @@ config IMX_IRQSTEER
help
Support for the i.MX IRQSTEER interrupt multiplexer/remapper.

+config IRQ_MBOX
+ tristate "Simple mailbox-backed interrupt controller"
+ depends on MAILBOX
+ select IRQ_DOMAIN
+ help
+ Support for interrupt controllers attached via a mailbox channel.
+ This allows a coprocessor to inject interrupts via a simple
+ message-based protocol.
+
endmenu

config SIFIVE_PLIC
diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile
index c93713d24b86..9de16ab4e69a 100644
--- a/drivers/irqchip/Makefile
+++ b/drivers/irqchip/Makefile
@@ -94,3 +94,4 @@ obj-$(CONFIG_CSKY_APB_INTC) += irq-csky-apb-intc.o
obj-$(CONFIG_SIFIVE_PLIC) += irq-sifive-plic.o
obj-$(CONFIG_IMX_IRQSTEER) += irq-imx-irqsteer.o
obj-$(CONFIG_MADERA_IRQ) += irq-madera.o
+obj-$(CONFIG_IRQ_MBOX) += irq-mbox.o
diff --git a/drivers/irqchip/irq-mbox.c b/drivers/irqchip/irq-mbox.c
new file mode 100644
index 000000000000..f7f6b47bc5b9
--- /dev/null
+++ b/drivers/irqchip/irq-mbox.c
@@ -0,0 +1,199 @@
+// SPDX-License-Identifier: GPL-2.0
+//
+// Copyright (c) 2018-2019 Samuel Holland <samuel@xxxxxxxxxxxx>
+
+/*
+ * Simple mailbox-backed interrupt controller driver using 32-bit messages.
+ * The mailbox controller is expected to take a (uint32_t *) message argument.
+ *
+ * Client-to-server messages:
+ * Byte 3 (MSB) : Reserved
+ * Byte 2 : Reserved
+ * Byte 1 : Message type (enumerated below)
+ * Byte 0 (LSB) : IRQ number
+ *
+ * Server-to-client messages:
+ * Byte 3 (MSB) : Reserved
+ * Byte 2 : Reserved
+ * Byte 1 : Message type (must be zero == interrupt received)
+ * Byte 0 (LSB) : IRQ number
+ *
+ * IRQ lines must be unmasked before they can be used (generic irqchip code
+ * takes care of that in this driver).
+ */
+
+#include <linux/irq.h>
+#include <linux/irqchip.h>
+#include <linux/irqdomain.h>
+#include <linux/mailbox_client.h>
+#include <linux/module.h>
+#include <linux/of_platform.h>
+
+#define MBOX_INTC_MAX_IRQS 32
+
+enum {
+ MSG_EOI = 0,
+ MSG_MASK = 1,
+ MSG_UNMASK = 2,
+};
+
+struct mbox_intc {
+ struct irq_chip chip;
+ struct irq_domain *domain;
+ struct mbox_chan *rx_chan;
+ struct mbox_chan *tx_chan;
+ struct mbox_client cl;
+};
+
+static int mbox_intc_map(struct irq_domain *domain, unsigned int virq,
+ irq_hw_number_t hwirq)
+{
+ struct mbox_intc *intc = domain->host_data;
+
+ if (hwirq >= MBOX_INTC_MAX_IRQS)
+ return -ENODEV;
+
+ irq_set_chip_data(virq, intc);
+ irq_set_chip_and_handler(virq, &intc->chip, handle_fasteoi_irq);
+ irq_set_status_flags(virq, IRQ_LEVEL);
+
+ return 0;
+}
+
+static const struct irq_domain_ops mbox_intc_domain_ops = {
+ .map = mbox_intc_map,
+ .xlate = irq_domain_xlate_onecell,
+};
+
+static void mbox_intc_rx_callback(struct mbox_client *cl, void *msg)
+{
+ struct mbox_intc *intc = container_of(cl, struct mbox_intc, cl);
+ uint32_t hwirq = *(uint32_t *)msg;
+
+ if (hwirq >= MBOX_INTC_MAX_IRQS)
+ return;
+
+ generic_handle_irq(irq_linear_revmap(intc->domain, hwirq));
+}
+
+static void mbox_intc_tx_msg(struct irq_data *d, uint8_t request)
+{
+ struct mbox_intc *intc = irq_data_get_irq_chip_data(d);
+ uint32_t msg = (request << 8) | (d->hwirq & GENMASK(0, 7));
+
+ /* Since we don't expect an ACK for this message, immediately complete
+ * the transmission. This ensures that each message is sent out without
+ * sleeping, and 'data' remains in scope until actual transmission. */
+ if (mbox_send_message(intc->tx_chan, &msg) >= 0)
+ mbox_client_txdone(intc->tx_chan, 0);
+}
+
+static void mbox_intc_irq_mask(struct irq_data *d)
+{
+ mbox_intc_tx_msg(d, MSG_MASK);
+}
+
+static void mbox_intc_irq_unmask(struct irq_data *d)
+{
+ mbox_intc_tx_msg(d, MSG_UNMASK);
+}
+
+static void mbox_intc_irq_eoi(struct irq_data *d)
+{
+ mbox_intc_tx_msg(d, MSG_EOI);
+}
+
+static int mbox_intc_probe(struct platform_device *pdev)
+{
+ struct device *dev = &pdev->dev;
+ struct mbox_intc *intc;
+ int ret;
+
+ intc = devm_kzalloc(dev, sizeof(*intc), GFP_KERNEL);
+ if (!intc)
+ return -ENOMEM;
+
+ intc->cl.dev = dev;
+ intc->cl.knows_txdone = true;
+ intc->cl.rx_callback = mbox_intc_rx_callback;
+
+ if (of_get_property(dev->of_node, "mbox-names", NULL)) {
+ intc->rx_chan = mbox_request_channel_byname(&intc->cl, "rx");
+ if (IS_ERR(intc->rx_chan)) {
+ ret = PTR_ERR(intc->rx_chan);
+ dev_err(dev, "Failed to request rx mailbox channel\n");
+ goto err;
+ }
+ intc->tx_chan = mbox_request_channel_byname(&intc->cl, "tx");
+ if (IS_ERR(intc->tx_chan)) {
+ ret = PTR_ERR(intc->tx_chan);
+ dev_err(dev, "Failed to request tx mailbox channel\n");
+ goto err_free_rx_chan;
+ }
+ } else {
+ intc->rx_chan = mbox_request_channel(&intc->cl, 0);
+ intc->tx_chan = intc->rx_chan;
+ if (IS_ERR(intc->tx_chan)) {
+ ret = PTR_ERR(intc->tx_chan);
+ dev_err(dev, "Failed to request mailbox channel\n");
+ goto err;
+ }
+ }
+
+ intc->chip.name = dev_name(dev);
+ intc->chip.irq_mask = mbox_intc_irq_mask;
+ intc->chip.irq_unmask = mbox_intc_irq_unmask;
+ intc->chip.irq_eoi = mbox_intc_irq_eoi;
+
+ intc->domain = irq_domain_add_linear(dev->of_node, MBOX_INTC_MAX_IRQS,
+ &mbox_intc_domain_ops, intc);
+ if (IS_ERR(intc->domain)) {
+ ret = PTR_ERR(intc->domain);
+ dev_err(dev, "Failed to allocate IRQ domain: %d\n", ret);
+ goto err_free_tx_chan;
+ }
+
+ platform_set_drvdata(pdev, intc);
+
+ return 0;
+
+err_free_tx_chan:
+ if (intc->tx_chan != intc->rx_chan)
+ mbox_free_channel(intc->tx_chan);
+err_free_rx_chan:
+ mbox_free_channel(intc->rx_chan);
+err:
+ return ret;
+}
+
+static int mbox_intc_remove(struct platform_device *pdev)
+{
+ struct mbox_intc *intc = platform_get_drvdata(pdev);
+
+ irq_domain_remove(intc->domain);
+ if (intc->tx_chan != intc->rx_chan)
+ mbox_free_channel(intc->tx_chan);
+ mbox_free_channel(intc->rx_chan);
+
+ return 0;
+}
+
+static const struct of_device_id mbox_intc_of_match[] = {
+ { .compatible = "allwinner,sunxi-msgbox-intc" },
+ {},
+};
+MODULE_DEVICE_TABLE(of, mbox_intc_of_match);
+
+static struct platform_driver mbox_intc_driver = {
+ .driver = {
+ .name = KBUILD_MODNAME,
+ .of_match_table = mbox_intc_of_match,
+ },
+ .probe = mbox_intc_probe,
+ .remove = mbox_intc_remove,
+};
+module_platform_driver(mbox_intc_driver);
+
+MODULE_AUTHOR("Samuel Holland <samuel@xxxxxxxxxxxx>");
+MODULE_DESCRIPTION("Simple mailbox-backed interrupt controller");
+MODULE_LICENSE("GPL v2");
--
2.19.2