From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from relay9-d.mail.gandi.net (relay9-d.mail.gandi.net [217.70.183.199]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 90CEF16C6A0; Mon, 27 May 2024 16:15:19 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=217.70.183.199 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1716826522; cv=none; b=WoCl4DTOfgsf8dEamQTV1My5m13BclHNiVArWOSSypuh7mxG95a1A3Q+atkYAVOPsWmN5ZeFfKLG+SLmpDMKLrYpesMLpWy7LiHsCqQhHtVLneZS0Qu9fzmF/eXZFWlQlLPHDBzjQhqnSWHIzLcA6tmYmclZXGWQ4V7CqYLd9To= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1716826522; c=relaxed/simple; bh=x/m77iqhUFE/lj7qj1x4mjZYBl01jxuGtZ9/VfM95qo=; h=From:To:Cc:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Type; b=Q4Nq+2Q5x32yE89EKb3CjoPH5hTGt60D+jbBYX6FLHDFEIEjWMmf1vm5k1fqNbmi6aw5p9hepjdycFhmRC8YGRCBGRQ+R9kkE6HrO/kk5m9U5RNrCBl40di4hPsCHoV1W1WYb6ogheY0a1CkfNprE0H61cxQQl1GLgin7meOGJk= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=pass (p=reject dis=none) header.from=bootlin.com; spf=pass smtp.mailfrom=bootlin.com; dkim=pass (2048-bit key) header.d=bootlin.com header.i=@bootlin.com header.b=CRs0Bt2a; arc=none smtp.client-ip=217.70.183.199 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=reject dis=none) header.from=bootlin.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=bootlin.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=bootlin.com header.i=@bootlin.com header.b="CRs0Bt2a" Received: by mail.gandi.net (Postfix) with ESMTPA id 6C5F8FF80C; Mon, 27 May 2024 16:15:16 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=bootlin.com; s=gm1; t=1716826518; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:cc:mime-version:mime-version:content-type:content-type: content-transfer-encoding:content-transfer-encoding: in-reply-to:in-reply-to:references:references; bh=gEUkUf+BSyAO3M0CiXuz/ivWZ/onbuyxsn9Wx1tQueo=; b=CRs0Bt2aY+bUF72VIn1+7ihLLbL6Mu17GL06QgZcN+v7HYoOOhKR7L0m/HmJ54tZUv2IJn 50l/PUaq2subgrdUZr8cG5ExgZRdT1Y5427Inld3sEzNozK3FHLLhCDRiu9XcaOPwslj+6 3Wy3GQxbr4ZLj90oyb8Iy9lpoZr+Kxmf057cci+bzIMVGLE7Qd8JV8xVwz/kMw+JtGVUss qOzPJvQ6vWisB1cqhnRHOBPA5vSXF8Ht26/lxny1R7VIXNpnBw0nkRmu9NMRAVqXBTPOTB DDM9bGqFbJs0MXsebPrydEkW8OsMO3lKPcv2hT23Kpt/QCK7NIQvvmja1OupSQ== From: Herve Codina To: Simon Horman , Sai Krishna Gajula , Herve Codina , Thomas Gleixner , Rob Herring , Krzysztof Kozlowski , Conor Dooley , "David S. Miller" , Eric Dumazet , Jakub Kicinski , Paolo Abeni , Lee Jones , Arnd Bergmann , Horatiu Vultur , UNGLinuxDriver@microchip.com, Andrew Lunn , Heiner Kallweit , Russell King , Saravana Kannan , Bjorn Helgaas , Philipp Zabel , Lars Povlsen , Steen Hegelund , Daniel Machon , Alexandre Belloni Cc: linux-kernel@vger.kernel.org, devicetree@vger.kernel.org, netdev@vger.kernel.org, linux-pci@vger.kernel.org, linux-arm-kernel@lists.infradead.org, Allan Nielsen , Steen Hegelund , Luca Ceresoli , Thomas Petazzoni Subject: [PATCH v2 11/19] irqchip: Add support for LAN966x OIC Date: Mon, 27 May 2024 18:14:38 +0200 Message-ID: <20240527161450.326615-12-herve.codina@bootlin.com> X-Mailer: git-send-email 2.45.0 In-Reply-To: <20240527161450.326615-1-herve.codina@bootlin.com> References: <20240527161450.326615-1-herve.codina@bootlin.com> Precedence: bulk X-Mailing-List: linux-pci@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit X-GND-Sasl: herve.codina@bootlin.com The Microchip LAN966x outband interrupt controller (OIC) maps the internal interrupt sources of the LAN966x device to an external interrupt. When the LAN966x device is used as a PCI device, the external interrupt is routed to the PCI interrupt. Signed-off-by: Herve Codina --- drivers/irqchip/Kconfig | 12 ++ drivers/irqchip/Makefile | 1 + drivers/irqchip/irq-lan966x-oic.c | 308 ++++++++++++++++++++++++++++++ 3 files changed, 321 insertions(+) create mode 100644 drivers/irqchip/irq-lan966x-oic.c diff --git a/drivers/irqchip/Kconfig b/drivers/irqchip/Kconfig index 14464716bacb..348f34525d23 100644 --- a/drivers/irqchip/Kconfig +++ b/drivers/irqchip/Kconfig @@ -169,6 +169,18 @@ config IXP4XX_IRQ select IRQ_DOMAIN select SPARSE_IRQ +config LAN966X_OIC + tristate "Microchip LAN966x OIC Support" + select GENERIC_IRQ_CHIP + select IRQ_DOMAIN + help + Enable support for the LAN966x Outbound Interrupt Controller. + This controller is present on the Microchip LAN966x PCI device and + maps the internal interrupts sources to PCIe interrupt. + + To compile this driver as a module, choose M here: the module + will be called irq-lan966x-oic. + config MADERA_IRQ tristate diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile index d9dc3d99aaa8..9f6f88274bec 100644 --- a/drivers/irqchip/Makefile +++ b/drivers/irqchip/Makefile @@ -104,6 +104,7 @@ obj-$(CONFIG_IMX_IRQSTEER) += irq-imx-irqsteer.o obj-$(CONFIG_IMX_INTMUX) += irq-imx-intmux.o obj-$(CONFIG_IMX_MU_MSI) += irq-imx-mu-msi.o obj-$(CONFIG_MADERA_IRQ) += irq-madera.o +obj-$(CONFIG_LAN966X_OIC) += irq-lan966x-oic.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 diff --git a/drivers/irqchip/irq-lan966x-oic.c b/drivers/irqchip/irq-lan966x-oic.c new file mode 100644 index 000000000000..a5f64610e62d --- /dev/null +++ b/drivers/irqchip/irq-lan966x-oic.c @@ -0,0 +1,308 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for the Microchip LAN966x outbound interrupt controller + * + * Copyright (c) 2024 Technology Inc. and its subsidiaries. + * + * Authors: + * Horatiu Vultur + * Clément Léger + * Herve Codina + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +struct lan966x_oic_chip_regs { + int reg_off_ena_set; + int reg_off_ena_clr; + int reg_off_sticky; + int reg_off_ident; + int reg_off_map; +}; + +struct lan966x_oic_data { + struct irq_domain *domain; + void __iomem *regs; + int irq; +}; + +#define LAN966X_OIC_NR_IRQ 86 + +/* Interrupt sticky status */ +#define LAN966X_OIC_INTR_STICKY 0x30 +#define LAN966X_OIC_INTR_STICKY1 0x34 +#define LAN966X_OIC_INTR_STICKY2 0x38 + +/* Interrupt enable */ +#define LAN966X_OIC_INTR_ENA 0x48 +#define LAN966X_OIC_INTR_ENA1 0x4c +#define LAN966X_OIC_INTR_ENA2 0x50 + +/* Atomic clear of interrupt enable */ +#define LAN966X_OIC_INTR_ENA_CLR 0x54 +#define LAN966X_OIC_INTR_ENA_CLR1 0x58 +#define LAN966X_OIC_INTR_ENA_CLR2 0x5c + +/* Atomic set of interrupt */ +#define LAN966X_OIC_INTR_ENA_SET 0x60 +#define LAN966X_OIC_INTR_ENA_SET1 0x64 +#define LAN966X_OIC_INTR_ENA_SET2 0x68 + +/* Mapping of source to destination interrupts (_n = 0..8) */ +#define LAN966X_OIC_DST_INTR_MAP(_n) (0x78 + (_n) * 4) +#define LAN966X_OIC_DST_INTR_MAP1(_n) (0x9c + (_n) * 4) +#define LAN966X_OIC_DST_INTR_MAP2(_n) (0xc0 + (_n) * 4) + +/* Currently active interrupt sources per destination (_n = 0..8) */ +#define LAN966X_OIC_DST_INTR_IDENT(_n) (0xe4 + (_n) * 4) +#define LAN966X_OIC_DST_INTR_IDENT1(_n) (0x108 + (_n) * 4) +#define LAN966X_OIC_DST_INTR_IDENT2(_n) (0x12c + (_n) * 4) + +static unsigned int lan966x_oic_irq_startup(struct irq_data *data) +{ + struct irq_chip_generic *gc = irq_data_get_irq_chip_data(data); + struct irq_chip_type *ct = irq_data_get_chip_type(data); + struct lan966x_oic_chip_regs *chip_regs = gc->private; + u32 map; + + irq_gc_lock(gc); + + /* Map the source interrupt to the destination */ + map = irq_reg_readl(gc, chip_regs->reg_off_map); + map |= data->mask; + irq_reg_writel(gc, map, chip_regs->reg_off_map); + + irq_gc_unlock(gc); + + ct->chip.irq_ack(data); + ct->chip.irq_unmask(data); + + return 0; +} + +static void lan966x_oic_irq_shutdown(struct irq_data *data) +{ + struct irq_chip_generic *gc = irq_data_get_irq_chip_data(data); + struct irq_chip_type *ct = irq_data_get_chip_type(data); + struct lan966x_oic_chip_regs *chip_regs = gc->private; + u32 map; + + ct->chip.irq_mask(data); + + irq_gc_lock(gc); + + /* Unmap the interrupt */ + map = irq_reg_readl(gc, chip_regs->reg_off_map); + map &= ~data->mask; + irq_reg_writel(gc, map, chip_regs->reg_off_map); + + irq_gc_unlock(gc); +} + +static int lan966x_oic_irq_set_type(struct irq_data *data, + unsigned int flow_type) +{ + if (flow_type != IRQ_TYPE_LEVEL_HIGH) { + pr_err("lan966x oic doesn't support flow type %d\n", flow_type); + return -EINVAL; + } + + return 0; +} + +static void lan966x_oic_irq_handler_domain(struct irq_domain *d, u32 first_irq) +{ + struct irq_chip_generic *gc = irq_get_domain_generic_chip(d, first_irq); + struct lan966x_oic_chip_regs *chip_regs = gc->private; + unsigned long ident; + unsigned int hwirq; + + ident = irq_reg_readl(gc, chip_regs->reg_off_ident); + if (!ident) + return; + + for_each_set_bit(hwirq, &ident, 32) + generic_handle_domain_irq(d, hwirq + first_irq); +} + +static void lan966x_oic_irq_handler(struct irq_desc *desc) +{ + struct irq_domain *d = irq_desc_get_handler_data(desc); + struct irq_chip *chip = irq_desc_get_chip(desc); + + chained_irq_enter(chip, desc); + lan966x_oic_irq_handler_domain(d, 0); + lan966x_oic_irq_handler_domain(d, 32); + lan966x_oic_irq_handler_domain(d, 64); + chained_irq_exit(chip, desc); +} + +static struct lan966x_oic_chip_regs lan966x_oic_chip_regs[3] = { + { + .reg_off_ena_set = LAN966X_OIC_INTR_ENA_SET, + .reg_off_ena_clr = LAN966X_OIC_INTR_ENA_CLR, + .reg_off_sticky = LAN966X_OIC_INTR_STICKY, + .reg_off_ident = LAN966X_OIC_DST_INTR_IDENT(0), + .reg_off_map = LAN966X_OIC_DST_INTR_MAP(0), + }, { + .reg_off_ena_set = LAN966X_OIC_INTR_ENA_SET1, + .reg_off_ena_clr = LAN966X_OIC_INTR_ENA_CLR1, + .reg_off_sticky = LAN966X_OIC_INTR_STICKY1, + .reg_off_ident = LAN966X_OIC_DST_INTR_IDENT1(0), + .reg_off_map = LAN966X_OIC_DST_INTR_MAP1(0), + }, { + .reg_off_ena_set = LAN966X_OIC_INTR_ENA_SET2, + .reg_off_ena_clr = LAN966X_OIC_INTR_ENA_CLR2, + .reg_off_sticky = LAN966X_OIC_INTR_STICKY2, + .reg_off_ident = LAN966X_OIC_DST_INTR_IDENT2(0), + .reg_off_map = LAN966X_OIC_DST_INTR_MAP2(0), + } +}; + +static void lan966x_oic_chip_init(struct lan966x_oic_data *lan966x_oic, + struct irq_chip_generic *gc, + struct lan966x_oic_chip_regs *chip_regs) +{ + gc->reg_base = lan966x_oic->regs; + gc->chip_types[0].regs.enable = chip_regs->reg_off_ena_set; + gc->chip_types[0].regs.disable = chip_regs->reg_off_ena_clr; + gc->chip_types[0].regs.ack = chip_regs->reg_off_sticky; + gc->chip_types[0].chip.irq_startup = lan966x_oic_irq_startup; + gc->chip_types[0].chip.irq_shutdown = lan966x_oic_irq_shutdown; + gc->chip_types[0].chip.irq_set_type = lan966x_oic_irq_set_type; + gc->chip_types[0].chip.irq_mask = irq_gc_mask_disable_reg; + gc->chip_types[0].chip.irq_unmask = irq_gc_unmask_enable_reg; + gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit; + gc->private = chip_regs; + + /* Disable all interrupts handled by this chip */ + irq_reg_writel(gc, ~0, chip_regs->reg_off_ena_clr); +} + +static void lan966x_oic_chip_exit(struct irq_chip_generic *gc) +{ + /* Disable and ack all interrupts handled by this chip */ + irq_reg_writel(gc, ~0, gc->chip_types[0].regs.disable); + irq_reg_writel(gc, ~0, gc->chip_types[0].regs.ack); +} + +static int lan966x_oic_probe(struct platform_device *pdev) +{ + struct device_node *node = pdev->dev.of_node; + struct lan966x_oic_data *lan966x_oic; + struct device *dev = &pdev->dev; + struct irq_chip_generic *gc; + int ret; + int i; + + lan966x_oic = devm_kmalloc(dev, sizeof(*lan966x_oic), GFP_KERNEL); + if (!lan966x_oic) + return -ENOMEM; + + lan966x_oic->regs = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(lan966x_oic->regs)) + return dev_err_probe(dev, PTR_ERR(lan966x_oic->regs), + "failed to map resource\n"); + + lan966x_oic->domain = irq_domain_alloc_linear(of_node_to_fwnode(node), + LAN966X_OIC_NR_IRQ, + &irq_generic_chip_ops, + NULL); + if (!lan966x_oic->domain) { + dev_err(dev, "failed to create an IRQ domain\n"); + return -EINVAL; + } + + lan966x_oic->irq = platform_get_irq(pdev, 0); + if (lan966x_oic->irq < 0) { + ret = dev_err_probe(dev, lan966x_oic->irq, + "failed to get the IRQ\n"); + goto err_domain_free; + } + + ret = irq_alloc_domain_generic_chips(lan966x_oic->domain, 32, 1, + "lan966x-oic", handle_level_irq, 0, + 0, 0); + if (ret) { + dev_err_probe(dev, ret, "failed to alloc irq domain gc\n"); + goto err_domain_free; + } + + /* Init chips */ + BUILD_BUG_ON(DIV_ROUND_UP(LAN966X_OIC_NR_IRQ, 32) != + ARRAY_SIZE(lan966x_oic_chip_regs)); + for (i = 0; i < ARRAY_SIZE(lan966x_oic_chip_regs); i++) { + gc = irq_get_domain_generic_chip(lan966x_oic->domain, i * 32); + lan966x_oic_chip_init(lan966x_oic, gc, + &lan966x_oic_chip_regs[i]); + } + + irq_set_chained_handler_and_data(lan966x_oic->irq, + lan966x_oic_irq_handler, + lan966x_oic->domain); + + irq_domain_publish(lan966x_oic->domain); + platform_set_drvdata(pdev, lan966x_oic); + return 0; + +err_domain_free: + irq_domain_free(lan966x_oic->domain); + return ret; +} + +static void lan966x_oic_remove(struct platform_device *pdev) +{ + struct lan966x_oic_data *lan966x_oic = platform_get_drvdata(pdev); + struct irq_chip_generic *gc; + int i; + + for (i = 0; i < ARRAY_SIZE(lan966x_oic_chip_regs); i++) { + gc = irq_get_domain_generic_chip(lan966x_oic->domain, i * 32); + lan966x_oic_chip_exit(gc); + } + + irq_set_chained_handler_and_data(lan966x_oic->irq, NULL, NULL); + + for (i = 0; i < LAN966X_OIC_NR_IRQ; i++) + irq_dispose_mapping(irq_find_mapping(lan966x_oic->domain, i)); + + irq_domain_unpublish(lan966x_oic->domain); + + for (i = 0; i < ARRAY_SIZE(lan966x_oic_chip_regs); i++) { + gc = irq_get_domain_generic_chip(lan966x_oic->domain, i * 32); + irq_remove_generic_chip(gc, ~0, 0, 0); + } + + kfree(lan966x_oic->domain->gc); + irq_domain_free(lan966x_oic->domain); +} + +static const struct of_device_id lan966x_oic_of_match[] = { + { .compatible = "microchip,lan966x-oic" }, + {} /* sentinel */ +}; +MODULE_DEVICE_TABLE(of, lan966x_oic_of_match); + +static struct platform_driver lan966x_oic_driver = { + .probe = lan966x_oic_probe, + .remove_new = lan966x_oic_remove, + .driver = { + .name = "lan966x-oic", + .of_match_table = lan966x_oic_of_match, + }, +}; +module_platform_driver(lan966x_oic_driver); + +MODULE_AUTHOR("Herve Codina "); +MODULE_DESCRIPTION("Microchip LAN966x OIC driver"); +MODULE_LICENSE("GPL"); -- 2.45.0 From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 2C5D5C25B74 for ; Mon, 27 May 2024 16:16:07 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-ID:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=UQV9qUOKohOJ2awjBorJEPp67pfxZQI6Hj4V4Qm2pdw=; b=kRDbS3UEnf+UnV XpV7ev5B5oVOvjx34bWCm69qRYHBmksqRpidMupGzN1tih6AM0I0wK1T0ZZcN/hlo1bWfVP7LKRMP JWRU7ipgkkcW2rSysls+Mhb/YkMs9RzgCLAU4m3QLnhPCl0HuQ7UzaUFP5Kx99pPWuCLoUblRdmS+ 5DPP5MLxLF2tKQq1z7kAnzVrQnOwiIXYdoo4E+gDkFsqrk58yWEJI8jDuttPUmqN534CLqFW5hb0J Ff4Ra4YzUqjpzVQQYMh4/YqzevNjDzMHnVwPl/YR/xtP3acyJg4f2fYi0nq+a41G8Lt23tfBmW2QX 9uldf/lNGfFQrZ6ofFZw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.97.1 #2 (Red Hat Linux)) id 1sBd0s-0000000Fn5P-1aGC; Mon, 27 May 2024 16:15:54 +0000 Received: from relay9-d.mail.gandi.net ([2001:4b98:dc4:8::229]) by bombadil.infradead.org with esmtps (Exim 4.97.1 #2 (Red Hat Linux)) id 1sBd0J-0000000Fmbr-1uRm for linux-arm-kernel@lists.infradead.org; Mon, 27 May 2024 16:15:21 +0000 Received: by mail.gandi.net (Postfix) with ESMTPA id 6C5F8FF80C; Mon, 27 May 2024 16:15:16 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=bootlin.com; s=gm1; t=1716826518; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:cc:mime-version:mime-version:content-type:content-type: content-transfer-encoding:content-transfer-encoding: in-reply-to:in-reply-to:references:references; bh=gEUkUf+BSyAO3M0CiXuz/ivWZ/onbuyxsn9Wx1tQueo=; b=CRs0Bt2aY+bUF72VIn1+7ihLLbL6Mu17GL06QgZcN+v7HYoOOhKR7L0m/HmJ54tZUv2IJn 50l/PUaq2subgrdUZr8cG5ExgZRdT1Y5427Inld3sEzNozK3FHLLhCDRiu9XcaOPwslj+6 3Wy3GQxbr4ZLj90oyb8Iy9lpoZr+Kxmf057cci+bzIMVGLE7Qd8JV8xVwz/kMw+JtGVUss qOzPJvQ6vWisB1cqhnRHOBPA5vSXF8Ht26/lxny1R7VIXNpnBw0nkRmu9NMRAVqXBTPOTB DDM9bGqFbJs0MXsebPrydEkW8OsMO3lKPcv2hT23Kpt/QCK7NIQvvmja1OupSQ== From: Herve Codina To: Simon Horman , Sai Krishna Gajula , Herve Codina , Thomas Gleixner , Rob Herring , Krzysztof Kozlowski , Conor Dooley , "David S. Miller" , Eric Dumazet , Jakub Kicinski , Paolo Abeni , Lee Jones , Arnd Bergmann , Horatiu Vultur , UNGLinuxDriver@microchip.com, Andrew Lunn , Heiner Kallweit , Russell King , Saravana Kannan , Bjorn Helgaas , Philipp Zabel , Lars Povlsen , Steen Hegelund , Daniel Machon , Alexandre Belloni Cc: linux-kernel@vger.kernel.org, devicetree@vger.kernel.org, netdev@vger.kernel.org, linux-pci@vger.kernel.org, linux-arm-kernel@lists.infradead.org, Allan Nielsen , Steen Hegelund , Luca Ceresoli , Thomas Petazzoni Subject: [PATCH v2 11/19] irqchip: Add support for LAN966x OIC Date: Mon, 27 May 2024 18:14:38 +0200 Message-ID: <20240527161450.326615-12-herve.codina@bootlin.com> X-Mailer: git-send-email 2.45.0 In-Reply-To: <20240527161450.326615-1-herve.codina@bootlin.com> References: <20240527161450.326615-1-herve.codina@bootlin.com> MIME-Version: 1.0 X-GND-Sasl: herve.codina@bootlin.com X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20240527_091519_872273_4E770996 X-CRM114-Status: GOOD ( 29.50 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: base64 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org VGhlIE1pY3JvY2hpcCBMQU45NjZ4IG91dGJhbmQgaW50ZXJydXB0IGNvbnRyb2xsZXIgKE9JQykg bWFwcyB0aGUKaW50ZXJuYWwgaW50ZXJydXB0IHNvdXJjZXMgb2YgdGhlIExBTjk2NnggZGV2aWNl IHRvIGFuIGV4dGVybmFsCmludGVycnVwdC4KV2hlbiB0aGUgTEFOOTY2eCBkZXZpY2UgaXMgdXNl ZCBhcyBhIFBDSSBkZXZpY2UsIHRoZSBleHRlcm5hbCBpbnRlcnJ1cHQKaXMgcm91dGVkIHRvIHRo ZSBQQ0kgaW50ZXJydXB0LgoKU2lnbmVkLW9mZi1ieTogSGVydmUgQ29kaW5hIDxoZXJ2ZS5jb2Rp bmFAYm9vdGxpbi5jb20+Ci0tLQogZHJpdmVycy9pcnFjaGlwL0tjb25maWcgICAgICAgICAgIHwg IDEyICsrCiBkcml2ZXJzL2lycWNoaXAvTWFrZWZpbGUgICAgICAgICAgfCAgIDEgKwogZHJpdmVy cy9pcnFjaGlwL2lycS1sYW45NjZ4LW9pYy5jIHwgMzA4ICsrKysrKysrKysrKysrKysrKysrKysr KysrKysrKwogMyBmaWxlcyBjaGFuZ2VkLCAzMjEgaW5zZXJ0aW9ucygrKQogY3JlYXRlIG1vZGUg MTAwNjQ0IGRyaXZlcnMvaXJxY2hpcC9pcnEtbGFuOTY2eC1vaWMuYwoKZGlmZiAtLWdpdCBhL2Ry aXZlcnMvaXJxY2hpcC9LY29uZmlnIGIvZHJpdmVycy9pcnFjaGlwL0tjb25maWcKaW5kZXggMTQ0 NjQ3MTZiYWNiLi4zNDhmMzQ1MjVkMjMgMTAwNjQ0Ci0tLSBhL2RyaXZlcnMvaXJxY2hpcC9LY29u ZmlnCisrKyBiL2RyaXZlcnMvaXJxY2hpcC9LY29uZmlnCkBAIC0xNjksNiArMTY5LDE4IEBAIGNv bmZpZyBJWFA0WFhfSVJRCiAJc2VsZWN0IElSUV9ET01BSU4KIAlzZWxlY3QgU1BBUlNFX0lSUQog Citjb25maWcgTEFOOTY2WF9PSUMKKwl0cmlzdGF0ZSAiTWljcm9jaGlwIExBTjk2NnggT0lDIFN1 cHBvcnQiCisJc2VsZWN0IEdFTkVSSUNfSVJRX0NISVAKKwlzZWxlY3QgSVJRX0RPTUFJTgorCWhl bHAKKwkgIEVuYWJsZSBzdXBwb3J0IGZvciB0aGUgTEFOOTY2eCBPdXRib3VuZCBJbnRlcnJ1cHQg Q29udHJvbGxlci4KKwkgIFRoaXMgY29udHJvbGxlciBpcyBwcmVzZW50IG9uIHRoZSBNaWNyb2No aXAgTEFOOTY2eCBQQ0kgZGV2aWNlIGFuZAorCSAgbWFwcyB0aGUgaW50ZXJuYWwgaW50ZXJydXB0 cyBzb3VyY2VzIHRvIFBDSWUgaW50ZXJydXB0LgorCisJICBUbyBjb21waWxlIHRoaXMgZHJpdmVy IGFzIGEgbW9kdWxlLCBjaG9vc2UgTSBoZXJlOiB0aGUgbW9kdWxlCisJICB3aWxsIGJlIGNhbGxl ZCBpcnEtbGFuOTY2eC1vaWMuCisKIGNvbmZpZyBNQURFUkFfSVJRCiAJdHJpc3RhdGUKIApkaWZm IC0tZ2l0IGEvZHJpdmVycy9pcnFjaGlwL01ha2VmaWxlIGIvZHJpdmVycy9pcnFjaGlwL01ha2Vm aWxlCmluZGV4IGQ5ZGMzZDk5YWFhOC4uOWY2Zjg4Mjc0YmVjIDEwMDY0NAotLS0gYS9kcml2ZXJz L2lycWNoaXAvTWFrZWZpbGUKKysrIGIvZHJpdmVycy9pcnFjaGlwL01ha2VmaWxlCkBAIC0xMDQs NiArMTA0LDcgQEAgb2JqLSQoQ09ORklHX0lNWF9JUlFTVEVFUikJCSs9IGlycS1pbXgtaXJxc3Rl ZXIubwogb2JqLSQoQ09ORklHX0lNWF9JTlRNVVgpCQkrPSBpcnEtaW14LWludG11eC5vCiBvYmot JChDT05GSUdfSU1YX01VX01TSSkJCSs9IGlycS1pbXgtbXUtbXNpLm8KIG9iai0kKENPTkZJR19N QURFUkFfSVJRKQkJKz0gaXJxLW1hZGVyYS5vCitvYmotJChDT05GSUdfTEFOOTY2WF9PSUMpCQkr PSBpcnEtbGFuOTY2eC1vaWMubwogb2JqLSQoQ09ORklHX0xTMVhfSVJRKQkJCSs9IGlycS1sczF4 Lm8KIG9iai0kKENPTkZJR19USV9TQ0lfSU5UUl9JUlFDSElQKQkrPSBpcnEtdGktc2NpLWludHIu bwogb2JqLSQoQ09ORklHX1RJX1NDSV9JTlRBX0lSUUNISVApCSs9IGlycS10aS1zY2ktaW50YS5v CmRpZmYgLS1naXQgYS9kcml2ZXJzL2lycWNoaXAvaXJxLWxhbjk2Nngtb2ljLmMgYi9kcml2ZXJz L2lycWNoaXAvaXJxLWxhbjk2Nngtb2ljLmMKbmV3IGZpbGUgbW9kZSAxMDA2NDQKaW5kZXggMDAw MDAwMDAwMDAwLi5hNWY2NDYxMGU2MmQKLS0tIC9kZXYvbnVsbAorKysgYi9kcml2ZXJzL2lycWNo aXAvaXJxLWxhbjk2Nngtb2ljLmMKQEAgLTAsMCArMSwzMDggQEAKKy8vIFNQRFgtTGljZW5zZS1J ZGVudGlmaWVyOiBHUEwtMi4wCisvKgorICogRHJpdmVyIGZvciB0aGUgTWljcm9jaGlwIExBTjk2 Nnggb3V0Ym91bmQgaW50ZXJydXB0IGNvbnRyb2xsZXIKKyAqCisgKiBDb3B5cmlnaHQgKGMpIDIw MjQgVGVjaG5vbG9neSBJbmMuIGFuZCBpdHMgc3Vic2lkaWFyaWVzLgorICoKKyAqIEF1dGhvcnM6 CisgKglIb3JhdGl1IFZ1bHR1ciA8aG9yYXRpdS52dWx0dXJAbWljcm9jaGlwLmNvbT4KKyAqCUNs w6ltZW50IEzDqWdlciA8Y2xlbWVudC5sZWdlckBib290bGluLmNvbT4KKyAqCUhlcnZlIENvZGlu YSA8aGVydmUuY29kaW5hQGJvb3RsaW4uY29tPgorICovCisKKyNpbmNsdWRlIDxsaW51eC9iaXRv cHMuaD4KKyNpbmNsdWRlIDxsaW51eC9idWlsZF9idWcuaD4KKyNpbmNsdWRlIDxsaW51eC9pbnRl cnJ1cHQuaD4KKyNpbmNsdWRlIDxsaW51eC9pcnFjaGlwL2NoYWluZWRfaXJxLmg+CisjaW5jbHVk ZSA8bGludXgvaXJxY2hpcC5oPgorI2luY2x1ZGUgPGxpbnV4L2lycS5oPgorI2luY2x1ZGUgPGxp bnV4L2lvcG9sbC5oPgorI2luY2x1ZGUgPGxpbnV4L21mZC9jb3JlLmg+CisjaW5jbHVkZSA8bGlu dXgvbW9kdWxlLmg+CisjaW5jbHVkZSA8bGludXgvcGNpLmg+CisjaW5jbHVkZSA8bGludXgvZGVs YXkuaD4KKworc3RydWN0IGxhbjk2Nnhfb2ljX2NoaXBfcmVncyB7CisJaW50IHJlZ19vZmZfZW5h X3NldDsKKwlpbnQgcmVnX29mZl9lbmFfY2xyOworCWludCByZWdfb2ZmX3N0aWNreTsKKwlpbnQg cmVnX29mZl9pZGVudDsKKwlpbnQgcmVnX29mZl9tYXA7Cit9OworCitzdHJ1Y3QgbGFuOTY2eF9v aWNfZGF0YSB7CisJc3RydWN0IGlycV9kb21haW4gKmRvbWFpbjsKKwl2b2lkIF9faW9tZW0gKnJl Z3M7CisJaW50IGlycTsKK307CisKKyNkZWZpbmUgTEFOOTY2WF9PSUNfTlJfSVJRIDg2CisKKy8q IEludGVycnVwdCBzdGlja3kgc3RhdHVzICovCisjZGVmaW5lIExBTjk2NlhfT0lDX0lOVFJfU1RJ Q0tZCQkweDMwCisjZGVmaW5lIExBTjk2NlhfT0lDX0lOVFJfU1RJQ0tZMQkweDM0CisjZGVmaW5l IExBTjk2NlhfT0lDX0lOVFJfU1RJQ0tZMgkweDM4CisKKy8qIEludGVycnVwdCBlbmFibGUgKi8K KyNkZWZpbmUgTEFOOTY2WF9PSUNfSU5UUl9FTkEJCTB4NDgKKyNkZWZpbmUgTEFOOTY2WF9PSUNf SU5UUl9FTkExCQkweDRjCisjZGVmaW5lIExBTjk2NlhfT0lDX0lOVFJfRU5BMgkJMHg1MAorCisv KiBBdG9taWMgY2xlYXIgb2YgaW50ZXJydXB0IGVuYWJsZSAqLworI2RlZmluZSBMQU45NjZYX09J Q19JTlRSX0VOQV9DTFIJMHg1NAorI2RlZmluZSBMQU45NjZYX09JQ19JTlRSX0VOQV9DTFIxCTB4 NTgKKyNkZWZpbmUgTEFOOTY2WF9PSUNfSU5UUl9FTkFfQ0xSMgkweDVjCisKKy8qIEF0b21pYyBz ZXQgb2YgaW50ZXJydXB0ICovCisjZGVmaW5lIExBTjk2NlhfT0lDX0lOVFJfRU5BX1NFVAkweDYw CisjZGVmaW5lIExBTjk2NlhfT0lDX0lOVFJfRU5BX1NFVDEJMHg2NAorI2RlZmluZSBMQU45NjZY X09JQ19JTlRSX0VOQV9TRVQyCTB4NjgKKworLyogTWFwcGluZyBvZiBzb3VyY2UgdG8gZGVzdGlu YXRpb24gaW50ZXJydXB0cyAoX24gPSAwLi44KSAqLworI2RlZmluZSBMQU45NjZYX09JQ19EU1Rf SU5UUl9NQVAoX24pCSgweDc4ICsgKF9uKSAqIDQpCisjZGVmaW5lIExBTjk2NlhfT0lDX0RTVF9J TlRSX01BUDEoX24pCSgweDljICsgKF9uKSAqIDQpCisjZGVmaW5lIExBTjk2NlhfT0lDX0RTVF9J TlRSX01BUDIoX24pCSgweGMwICsgKF9uKSAqIDQpCisKKy8qIEN1cnJlbnRseSBhY3RpdmUgaW50 ZXJydXB0IHNvdXJjZXMgcGVyIGRlc3RpbmF0aW9uIChfbiA9IDAuLjgpICovCisjZGVmaW5lIExB Tjk2NlhfT0lDX0RTVF9JTlRSX0lERU5UKF9uKQkoMHhlNCArIChfbikgKiA0KQorI2RlZmluZSBM QU45NjZYX09JQ19EU1RfSU5UUl9JREVOVDEoX24pCSgweDEwOCArIChfbikgKiA0KQorI2RlZmlu ZSBMQU45NjZYX09JQ19EU1RfSU5UUl9JREVOVDIoX24pCSgweDEyYyArIChfbikgKiA0KQorCitz dGF0aWMgdW5zaWduZWQgaW50IGxhbjk2Nnhfb2ljX2lycV9zdGFydHVwKHN0cnVjdCBpcnFfZGF0 YSAqZGF0YSkKK3sKKwlzdHJ1Y3QgaXJxX2NoaXBfZ2VuZXJpYyAqZ2MgPSBpcnFfZGF0YV9nZXRf aXJxX2NoaXBfZGF0YShkYXRhKTsKKwlzdHJ1Y3QgaXJxX2NoaXBfdHlwZSAqY3QgPSBpcnFfZGF0 YV9nZXRfY2hpcF90eXBlKGRhdGEpOworCXN0cnVjdCBsYW45NjZ4X29pY19jaGlwX3JlZ3MgKmNo aXBfcmVncyA9IGdjLT5wcml2YXRlOworCXUzMiBtYXA7CisKKwlpcnFfZ2NfbG9jayhnYyk7CisK KwkvKiBNYXAgdGhlIHNvdXJjZSBpbnRlcnJ1cHQgdG8gdGhlIGRlc3RpbmF0aW9uICovCisJbWFw ID0gaXJxX3JlZ19yZWFkbChnYywgY2hpcF9yZWdzLT5yZWdfb2ZmX21hcCk7CisJbWFwIHw9IGRh dGEtPm1hc2s7CisJaXJxX3JlZ193cml0ZWwoZ2MsIG1hcCwgY2hpcF9yZWdzLT5yZWdfb2ZmX21h cCk7CisKKwlpcnFfZ2NfdW5sb2NrKGdjKTsKKworCWN0LT5jaGlwLmlycV9hY2soZGF0YSk7CisJ Y3QtPmNoaXAuaXJxX3VubWFzayhkYXRhKTsKKworCXJldHVybiAwOworfQorCitzdGF0aWMgdm9p ZCBsYW45NjZ4X29pY19pcnFfc2h1dGRvd24oc3RydWN0IGlycV9kYXRhICpkYXRhKQoreworCXN0 cnVjdCBpcnFfY2hpcF9nZW5lcmljICpnYyA9IGlycV9kYXRhX2dldF9pcnFfY2hpcF9kYXRhKGRh dGEpOworCXN0cnVjdCBpcnFfY2hpcF90eXBlICpjdCA9IGlycV9kYXRhX2dldF9jaGlwX3R5cGUo ZGF0YSk7CisJc3RydWN0IGxhbjk2Nnhfb2ljX2NoaXBfcmVncyAqY2hpcF9yZWdzID0gZ2MtPnBy aXZhdGU7CisJdTMyIG1hcDsKKworCWN0LT5jaGlwLmlycV9tYXNrKGRhdGEpOworCisJaXJxX2dj X2xvY2soZ2MpOworCisJLyogVW5tYXAgdGhlIGludGVycnVwdCAqLworCW1hcCA9IGlycV9yZWdf cmVhZGwoZ2MsIGNoaXBfcmVncy0+cmVnX29mZl9tYXApOworCW1hcCAmPSB+ZGF0YS0+bWFzazsK KwlpcnFfcmVnX3dyaXRlbChnYywgbWFwLCBjaGlwX3JlZ3MtPnJlZ19vZmZfbWFwKTsKKworCWly cV9nY191bmxvY2soZ2MpOworfQorCitzdGF0aWMgaW50IGxhbjk2Nnhfb2ljX2lycV9zZXRfdHlw ZShzdHJ1Y3QgaXJxX2RhdGEgKmRhdGEsCisJCQkJICAgIHVuc2lnbmVkIGludCBmbG93X3R5cGUp Cit7CisJaWYgKGZsb3dfdHlwZSAhPSBJUlFfVFlQRV9MRVZFTF9ISUdIKSB7CisJCXByX2Vycigi bGFuOTY2eCBvaWMgZG9lc24ndCBzdXBwb3J0IGZsb3cgdHlwZSAlZFxuIiwgZmxvd190eXBlKTsK KwkJcmV0dXJuIC1FSU5WQUw7CisJfQorCisJcmV0dXJuIDA7Cit9CisKK3N0YXRpYyB2b2lkIGxh bjk2Nnhfb2ljX2lycV9oYW5kbGVyX2RvbWFpbihzdHJ1Y3QgaXJxX2RvbWFpbiAqZCwgdTMyIGZp cnN0X2lycSkKK3sKKwlzdHJ1Y3QgaXJxX2NoaXBfZ2VuZXJpYyAqZ2MgPSBpcnFfZ2V0X2RvbWFp bl9nZW5lcmljX2NoaXAoZCwgZmlyc3RfaXJxKTsKKwlzdHJ1Y3QgbGFuOTY2eF9vaWNfY2hpcF9y ZWdzICpjaGlwX3JlZ3MgPSBnYy0+cHJpdmF0ZTsKKwl1bnNpZ25lZCBsb25nIGlkZW50OworCXVu c2lnbmVkIGludCBod2lycTsKKworCWlkZW50ID0gaXJxX3JlZ19yZWFkbChnYywgY2hpcF9yZWdz LT5yZWdfb2ZmX2lkZW50KTsKKwlpZiAoIWlkZW50KQorCQlyZXR1cm47CisKKwlmb3JfZWFjaF9z ZXRfYml0KGh3aXJxLCAmaWRlbnQsIDMyKQorCQlnZW5lcmljX2hhbmRsZV9kb21haW5faXJxKGQs IGh3aXJxICsgZmlyc3RfaXJxKTsKK30KKworc3RhdGljIHZvaWQgbGFuOTY2eF9vaWNfaXJxX2hh bmRsZXIoc3RydWN0IGlycV9kZXNjICpkZXNjKQoreworCXN0cnVjdCBpcnFfZG9tYWluICpkID0g aXJxX2Rlc2NfZ2V0X2hhbmRsZXJfZGF0YShkZXNjKTsKKwlzdHJ1Y3QgaXJxX2NoaXAgKmNoaXAg PSBpcnFfZGVzY19nZXRfY2hpcChkZXNjKTsKKworCWNoYWluZWRfaXJxX2VudGVyKGNoaXAsIGRl c2MpOworCWxhbjk2Nnhfb2ljX2lycV9oYW5kbGVyX2RvbWFpbihkLCAwKTsKKwlsYW45NjZ4X29p Y19pcnFfaGFuZGxlcl9kb21haW4oZCwgMzIpOworCWxhbjk2Nnhfb2ljX2lycV9oYW5kbGVyX2Rv bWFpbihkLCA2NCk7CisJY2hhaW5lZF9pcnFfZXhpdChjaGlwLCBkZXNjKTsKK30KKworc3RhdGlj IHN0cnVjdCBsYW45NjZ4X29pY19jaGlwX3JlZ3MgbGFuOTY2eF9vaWNfY2hpcF9yZWdzWzNdID0g eworCXsKKwkJLnJlZ19vZmZfZW5hX3NldCA9IExBTjk2NlhfT0lDX0lOVFJfRU5BX1NFVCwKKwkJ LnJlZ19vZmZfZW5hX2NsciA9IExBTjk2NlhfT0lDX0lOVFJfRU5BX0NMUiwKKwkJLnJlZ19vZmZf c3RpY2t5ID0gTEFOOTY2WF9PSUNfSU5UUl9TVElDS1ksCisJCS5yZWdfb2ZmX2lkZW50ID0gTEFO OTY2WF9PSUNfRFNUX0lOVFJfSURFTlQoMCksCisJCS5yZWdfb2ZmX21hcCA9IExBTjk2NlhfT0lD X0RTVF9JTlRSX01BUCgwKSwKKwl9LCB7CisJCS5yZWdfb2ZmX2VuYV9zZXQgPSBMQU45NjZYX09J Q19JTlRSX0VOQV9TRVQxLAorCQkucmVnX29mZl9lbmFfY2xyID0gTEFOOTY2WF9PSUNfSU5UUl9F TkFfQ0xSMSwKKwkJLnJlZ19vZmZfc3RpY2t5ID0gTEFOOTY2WF9PSUNfSU5UUl9TVElDS1kxLAor CQkucmVnX29mZl9pZGVudCA9IExBTjk2NlhfT0lDX0RTVF9JTlRSX0lERU5UMSgwKSwKKwkJLnJl Z19vZmZfbWFwID0gTEFOOTY2WF9PSUNfRFNUX0lOVFJfTUFQMSgwKSwKKwl9LCB7CisJCS5yZWdf b2ZmX2VuYV9zZXQgPSBMQU45NjZYX09JQ19JTlRSX0VOQV9TRVQyLAorCQkucmVnX29mZl9lbmFf Y2xyID0gTEFOOTY2WF9PSUNfSU5UUl9FTkFfQ0xSMiwKKwkJLnJlZ19vZmZfc3RpY2t5ID0gTEFO OTY2WF9PSUNfSU5UUl9TVElDS1kyLAorCQkucmVnX29mZl9pZGVudCA9IExBTjk2NlhfT0lDX0RT VF9JTlRSX0lERU5UMigwKSwKKwkJLnJlZ19vZmZfbWFwID0gTEFOOTY2WF9PSUNfRFNUX0lOVFJf TUFQMigwKSwKKwl9Cit9OworCitzdGF0aWMgdm9pZCBsYW45NjZ4X29pY19jaGlwX2luaXQoc3Ry dWN0IGxhbjk2Nnhfb2ljX2RhdGEgKmxhbjk2Nnhfb2ljLAorCQkJCSAgc3RydWN0IGlycV9jaGlw X2dlbmVyaWMgKmdjLAorCQkJCSAgc3RydWN0IGxhbjk2Nnhfb2ljX2NoaXBfcmVncyAqY2hpcF9y ZWdzKQoreworCWdjLT5yZWdfYmFzZSA9IGxhbjk2Nnhfb2ljLT5yZWdzOworCWdjLT5jaGlwX3R5 cGVzWzBdLnJlZ3MuZW5hYmxlID0gY2hpcF9yZWdzLT5yZWdfb2ZmX2VuYV9zZXQ7CisJZ2MtPmNo aXBfdHlwZXNbMF0ucmVncy5kaXNhYmxlID0gY2hpcF9yZWdzLT5yZWdfb2ZmX2VuYV9jbHI7CisJ Z2MtPmNoaXBfdHlwZXNbMF0ucmVncy5hY2sgPSBjaGlwX3JlZ3MtPnJlZ19vZmZfc3RpY2t5Owor CWdjLT5jaGlwX3R5cGVzWzBdLmNoaXAuaXJxX3N0YXJ0dXAgPSBsYW45NjZ4X29pY19pcnFfc3Rh cnR1cDsKKwlnYy0+Y2hpcF90eXBlc1swXS5jaGlwLmlycV9zaHV0ZG93biA9IGxhbjk2Nnhfb2lj X2lycV9zaHV0ZG93bjsKKwlnYy0+Y2hpcF90eXBlc1swXS5jaGlwLmlycV9zZXRfdHlwZSA9IGxh bjk2Nnhfb2ljX2lycV9zZXRfdHlwZTsKKwlnYy0+Y2hpcF90eXBlc1swXS5jaGlwLmlycV9tYXNr ID0gaXJxX2djX21hc2tfZGlzYWJsZV9yZWc7CisJZ2MtPmNoaXBfdHlwZXNbMF0uY2hpcC5pcnFf dW5tYXNrID0gaXJxX2djX3VubWFza19lbmFibGVfcmVnOworCWdjLT5jaGlwX3R5cGVzWzBdLmNo aXAuaXJxX2FjayA9IGlycV9nY19hY2tfc2V0X2JpdDsKKwlnYy0+cHJpdmF0ZSA9IGNoaXBfcmVn czsKKworCS8qIERpc2FibGUgYWxsIGludGVycnVwdHMgaGFuZGxlZCBieSB0aGlzIGNoaXAgKi8K KwlpcnFfcmVnX3dyaXRlbChnYywgfjAsIGNoaXBfcmVncy0+cmVnX29mZl9lbmFfY2xyKTsKK30K Kworc3RhdGljIHZvaWQgbGFuOTY2eF9vaWNfY2hpcF9leGl0KHN0cnVjdCBpcnFfY2hpcF9nZW5l cmljICpnYykKK3sKKwkvKiBEaXNhYmxlIGFuZCBhY2sgYWxsIGludGVycnVwdHMgaGFuZGxlZCBi eSB0aGlzIGNoaXAgKi8KKwlpcnFfcmVnX3dyaXRlbChnYywgfjAsIGdjLT5jaGlwX3R5cGVzWzBd LnJlZ3MuZGlzYWJsZSk7CisJaXJxX3JlZ193cml0ZWwoZ2MsIH4wLCBnYy0+Y2hpcF90eXBlc1sw XS5yZWdzLmFjayk7Cit9CisKK3N0YXRpYyBpbnQgbGFuOTY2eF9vaWNfcHJvYmUoc3RydWN0IHBs YXRmb3JtX2RldmljZSAqcGRldikKK3sKKwlzdHJ1Y3QgZGV2aWNlX25vZGUgKm5vZGUgPSBwZGV2 LT5kZXYub2Zfbm9kZTsKKwlzdHJ1Y3QgbGFuOTY2eF9vaWNfZGF0YSAqbGFuOTY2eF9vaWM7CisJ c3RydWN0IGRldmljZSAqZGV2ID0gJnBkZXYtPmRldjsKKwlzdHJ1Y3QgaXJxX2NoaXBfZ2VuZXJp YyAqZ2M7CisJaW50IHJldDsKKwlpbnQgaTsKKworCWxhbjk2Nnhfb2ljID0gZGV2bV9rbWFsbG9j KGRldiwgc2l6ZW9mKCpsYW45NjZ4X29pYyksIEdGUF9LRVJORUwpOworCWlmICghbGFuOTY2eF9v aWMpCisJCXJldHVybiAtRU5PTUVNOworCisJbGFuOTY2eF9vaWMtPnJlZ3MgPSBkZXZtX3BsYXRm b3JtX2lvcmVtYXBfcmVzb3VyY2UocGRldiwgMCk7CisJaWYgKElTX0VSUihsYW45NjZ4X29pYy0+ cmVncykpCisJCXJldHVybiBkZXZfZXJyX3Byb2JlKGRldiwgUFRSX0VSUihsYW45NjZ4X29pYy0+ cmVncyksCisJCQkJICAgICAiZmFpbGVkIHRvIG1hcCByZXNvdXJjZVxuIik7CisKKwlsYW45NjZ4 X29pYy0+ZG9tYWluID0gaXJxX2RvbWFpbl9hbGxvY19saW5lYXIob2Zfbm9kZV90b19md25vZGUo bm9kZSksCisJCQkJCQkgICAgICBMQU45NjZYX09JQ19OUl9JUlEsCisJCQkJCQkgICAgICAmaXJx X2dlbmVyaWNfY2hpcF9vcHMsCisJCQkJCQkgICAgICBOVUxMKTsKKwlpZiAoIWxhbjk2Nnhfb2lj LT5kb21haW4pIHsKKwkJZGV2X2VycihkZXYsICJmYWlsZWQgdG8gY3JlYXRlIGFuIElSUSBkb21h aW5cbiIpOworCQlyZXR1cm4gLUVJTlZBTDsKKwl9CisKKwlsYW45NjZ4X29pYy0+aXJxID0gcGxh dGZvcm1fZ2V0X2lycShwZGV2LCAwKTsKKwlpZiAobGFuOTY2eF9vaWMtPmlycSA8IDApIHsKKwkJ cmV0ID0gZGV2X2Vycl9wcm9iZShkZXYsIGxhbjk2Nnhfb2ljLT5pcnEsCisJCQkJICAgICJmYWls ZWQgdG8gZ2V0IHRoZSBJUlFcbiIpOworCQlnb3RvIGVycl9kb21haW5fZnJlZTsKKwl9CisKKwly ZXQgPSBpcnFfYWxsb2NfZG9tYWluX2dlbmVyaWNfY2hpcHMobGFuOTY2eF9vaWMtPmRvbWFpbiwg MzIsIDEsCisJCQkJCSAgICAgImxhbjk2Nngtb2ljIiwgaGFuZGxlX2xldmVsX2lycSwgMCwKKwkJ CQkJICAgICAwLCAwKTsKKwlpZiAocmV0KSB7CisJCWRldl9lcnJfcHJvYmUoZGV2LCByZXQsICJm YWlsZWQgdG8gYWxsb2MgaXJxIGRvbWFpbiBnY1xuIik7CisJCWdvdG8gZXJyX2RvbWFpbl9mcmVl OworCX0KKworCS8qIEluaXQgY2hpcHMgKi8KKwlCVUlMRF9CVUdfT04oRElWX1JPVU5EX1VQKExB Tjk2NlhfT0lDX05SX0lSUSwgMzIpICE9CisJCSAgICAgQVJSQVlfU0laRShsYW45NjZ4X29pY19j aGlwX3JlZ3MpKTsKKwlmb3IgKGkgPSAwOyBpIDwgQVJSQVlfU0laRShsYW45NjZ4X29pY19jaGlw X3JlZ3MpOyBpKyspIHsKKwkJZ2MgPSBpcnFfZ2V0X2RvbWFpbl9nZW5lcmljX2NoaXAobGFuOTY2 eF9vaWMtPmRvbWFpbiwgaSAqIDMyKTsKKwkJbGFuOTY2eF9vaWNfY2hpcF9pbml0KGxhbjk2Nnhf b2ljLCBnYywKKwkJCQkgICAgICAmbGFuOTY2eF9vaWNfY2hpcF9yZWdzW2ldKTsKKwl9CisKKwlp cnFfc2V0X2NoYWluZWRfaGFuZGxlcl9hbmRfZGF0YShsYW45NjZ4X29pYy0+aXJxLAorCQkJCQkg bGFuOTY2eF9vaWNfaXJxX2hhbmRsZXIsCisJCQkJCSBsYW45NjZ4X29pYy0+ZG9tYWluKTsKKwor CWlycV9kb21haW5fcHVibGlzaChsYW45NjZ4X29pYy0+ZG9tYWluKTsKKwlwbGF0Zm9ybV9zZXRf ZHJ2ZGF0YShwZGV2LCBsYW45NjZ4X29pYyk7CisJcmV0dXJuIDA7CisKK2Vycl9kb21haW5fZnJl ZToKKwlpcnFfZG9tYWluX2ZyZWUobGFuOTY2eF9vaWMtPmRvbWFpbik7CisJcmV0dXJuIHJldDsK K30KKworc3RhdGljIHZvaWQgbGFuOTY2eF9vaWNfcmVtb3ZlKHN0cnVjdCBwbGF0Zm9ybV9kZXZp Y2UgKnBkZXYpCit7CisJc3RydWN0IGxhbjk2Nnhfb2ljX2RhdGEgKmxhbjk2Nnhfb2ljID0gcGxh dGZvcm1fZ2V0X2RydmRhdGEocGRldik7CisJc3RydWN0IGlycV9jaGlwX2dlbmVyaWMgKmdjOwor CWludCBpOworCisJZm9yIChpID0gMDsgaSA8IEFSUkFZX1NJWkUobGFuOTY2eF9vaWNfY2hpcF9y ZWdzKTsgaSsrKSB7CisJCWdjID0gaXJxX2dldF9kb21haW5fZ2VuZXJpY19jaGlwKGxhbjk2Nnhf b2ljLT5kb21haW4sIGkgKiAzMik7CisJCWxhbjk2Nnhfb2ljX2NoaXBfZXhpdChnYyk7CisJfQor CisJaXJxX3NldF9jaGFpbmVkX2hhbmRsZXJfYW5kX2RhdGEobGFuOTY2eF9vaWMtPmlycSwgTlVM TCwgTlVMTCk7CisKKwlmb3IgKGkgPSAwOyBpIDwgTEFOOTY2WF9PSUNfTlJfSVJROyBpKyspCisJ CWlycV9kaXNwb3NlX21hcHBpbmcoaXJxX2ZpbmRfbWFwcGluZyhsYW45NjZ4X29pYy0+ZG9tYWlu LCBpKSk7CisKKwlpcnFfZG9tYWluX3VucHVibGlzaChsYW45NjZ4X29pYy0+ZG9tYWluKTsKKwor CWZvciAoaSA9IDA7IGkgPCBBUlJBWV9TSVpFKGxhbjk2Nnhfb2ljX2NoaXBfcmVncyk7IGkrKykg eworCQlnYyA9IGlycV9nZXRfZG9tYWluX2dlbmVyaWNfY2hpcChsYW45NjZ4X29pYy0+ZG9tYWlu LCBpICogMzIpOworCQlpcnFfcmVtb3ZlX2dlbmVyaWNfY2hpcChnYywgfjAsIDAsIDApOworCX0K KworCWtmcmVlKGxhbjk2Nnhfb2ljLT5kb21haW4tPmdjKTsKKwlpcnFfZG9tYWluX2ZyZWUobGFu OTY2eF9vaWMtPmRvbWFpbik7Cit9CisKK3N0YXRpYyBjb25zdCBzdHJ1Y3Qgb2ZfZGV2aWNlX2lk IGxhbjk2Nnhfb2ljX29mX21hdGNoW10gPSB7CisJeyAuY29tcGF0aWJsZSA9ICJtaWNyb2NoaXAs bGFuOTY2eC1vaWMiIH0sCisJe30gLyogc2VudGluZWwgKi8KK307CitNT0RVTEVfREVWSUNFX1RB QkxFKG9mLCBsYW45NjZ4X29pY19vZl9tYXRjaCk7CisKK3N0YXRpYyBzdHJ1Y3QgcGxhdGZvcm1f ZHJpdmVyIGxhbjk2Nnhfb2ljX2RyaXZlciA9IHsKKwkucHJvYmUgPSBsYW45NjZ4X29pY19wcm9i ZSwKKwkucmVtb3ZlX25ldyA9IGxhbjk2Nnhfb2ljX3JlbW92ZSwKKwkuZHJpdmVyID0geworCQku bmFtZSA9ICJsYW45NjZ4LW9pYyIsCisJCS5vZl9tYXRjaF90YWJsZSA9IGxhbjk2Nnhfb2ljX29m X21hdGNoLAorCX0sCit9OworbW9kdWxlX3BsYXRmb3JtX2RyaXZlcihsYW45NjZ4X29pY19kcml2 ZXIpOworCitNT0RVTEVfQVVUSE9SKCJIZXJ2ZSBDb2RpbmEgPGhlcnZlLmNvZGluYUBib290bGlu LmNvbT4iKTsKK01PRFVMRV9ERVNDUklQVElPTigiTWljcm9jaGlwIExBTjk2NnggT0lDIGRyaXZl ciIpOworTU9EVUxFX0xJQ0VOU0UoIkdQTCIpOwotLSAKMi40NS4wCgoKX19fX19fX19fX19fX19f X19fX19fX19fX19fX19fX19fX19fX19fX19fX19fX18KbGludXgtYXJtLWtlcm5lbCBtYWlsaW5n IGxpc3QKbGludXgtYXJtLWtlcm5lbEBsaXN0cy5pbmZyYWRlYWQub3JnCmh0dHA6Ly9saXN0cy5p bmZyYWRlYWQub3JnL21haWxtYW4vbGlzdGluZm8vbGludXgtYXJtLWtlcm5lbAo=