From patchwork Mon Oct 17 21:02:56 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Agustin Vega-Frias X-Patchwork-Id: 9380555 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 5C0C1607D4 for ; Mon, 17 Oct 2016 21:05:31 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 4637929087 for ; Mon, 17 Oct 2016 21:05:31 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 3AE7B29094; Mon, 17 Oct 2016 21:05:31 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-4.1 required=2.0 tests=BAYES_00,DKIM_SIGNED, RCVD_IN_DNSWL_MED, T_DKIM_INVALID autolearn=unavailable version=3.3.1 Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 84EDB29087 for ; Mon, 17 Oct 2016 21:05:30 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.85_2 #1 (Red Hat Linux)) id 1bwF4h-0006gS-Fk; Mon, 17 Oct 2016 21:03:59 +0000 Received: from smtp.codeaurora.org ([198.145.29.96]) by bombadil.infradead.org with esmtps (Exim 4.85_2 #1 (Red Hat Linux)) id 1bwF4V-0006YZ-6O for linux-arm-kernel@lists.infradead.org; Mon, 17 Oct 2016 21:03:50 +0000 Received: by smtp.codeaurora.org (Postfix, from userid 1000) id 653F8617BF; Mon, 17 Oct 2016 21:03:29 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=codeaurora.org; s=default; t=1476738209; bh=KaINYvSO6rWcJJuqaUdrJvsSO8/kTxjYH0mNDLZziDc=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=OQMrNSG3UcBgecnnznlhGgqqDe8qDL/WrX8fpKjzMMJAFCi7AqeU9sjubaB5OcbmN wVyPU/mKF5SceF3w1imcW2yIZkS+R8ME+lMgf/dQl4lnDanM9yLZVs++YN2y8tk4S7 7ag+fMwFwcQiKA0cIA4MI/ShDlB4VfPs2YueSUsY= Received: from midgar.qualcomm.com (global_nat1_iad_fw.qualcomm.com [129.46.232.65]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-SHA256 (128/128 bits)) (No client certificate requested) (Authenticated sender: agustinv@smtp.codeaurora.org) by smtp.codeaurora.org (Postfix) with ESMTPSA id 79395617BF; Mon, 17 Oct 2016 21:03:24 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=codeaurora.org; s=default; t=1476738206; bh=KaINYvSO6rWcJJuqaUdrJvsSO8/kTxjYH0mNDLZziDc=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=DfGlO0UV5dAq8g2ebCVLpyVCgPlpObxQMqXN6BsClXpBvDWFy0LH0eLeVomDcjORq YdOFUa2VQxIAzKJwFzn/bUk2oxhxv9uOXQyGOTeqG/2kF7C1NOrKRdHlb4VInY8pZE sroX/wowfqrxZSWXqvTZ74v+7uS89dxNjkGO9XhI= DMARC-Filter: OpenDMARC Filter v1.3.1 smtp.codeaurora.org 79395617BF Authentication-Results: pdx-caf-mail.web.codeaurora.org; dmarc=none header.from=codeaurora.org Authentication-Results: pdx-caf-mail.web.codeaurora.org; spf=pass smtp.mailfrom=agustinv@codeaurora.org From: Agustin Vega-Frias To: linux-kernel@vger.kernel.org, linux-acpi@vger.kernel.org, linux-arm-kernel@lists.infradead.org, rjw@rjwysocki.net, lenb@kernel.org, tglx@linutronix.de, jason@lakedaemon.net, marc.zyngier@arm.com Subject: [PATCH V4 1/2] ACPI: Add support for ResourceSource/IRQ domain mapping Date: Mon, 17 Oct 2016 17:02:56 -0400 Message-Id: <1476738177-24979-2-git-send-email-agustinv@codeaurora.org> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1476738177-24979-1-git-send-email-agustinv@codeaurora.org> References: <1476738177-24979-1-git-send-email-agustinv@codeaurora.org> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20161017_140347_393632_B250E732 X-CRM114-Status: GOOD ( 29.15 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.20 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: harba@codeaurora.org, mlangsdo@redhat.com, graeme.gregory@linaro.org, jcm@redhat.com, timur@codeaurora.org, agross@codeaurora.org, guohanjun@huawei.com, astone@redhat.com, cov@codeaurora.org, msalter@redhat.com, Agustin Vega-Frias , ahs3@redhat.com, charles.garcia-tobin@arm.com MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Virus-Scanned: ClamAV using ClamSMTP This allows irqchip drivers to associate an ACPI DSDT device to an IRQ domain and provides support for using the ResourceSource in Extended IRQ Resources to find the domain and map the IRQs specified on that domain. Signed-off-by: Agustin Vega-Frias --- drivers/acpi/Makefile | 1 + drivers/acpi/irqdomain.c | 135 ++++++++++++++++++++++++++++++++++++++ drivers/acpi/resource.c | 21 +++--- include/asm-generic/vmlinux.lds.h | 1 + include/linux/acpi.h | 50 ++++++++++++++ include/linux/irqchip.h | 17 ++++- 6 files changed, 213 insertions(+), 12 deletions(-) create mode 100644 drivers/acpi/irqdomain.c diff --git a/drivers/acpi/Makefile b/drivers/acpi/Makefile index 9ed0878..81bdc95 100644 --- a/drivers/acpi/Makefile +++ b/drivers/acpi/Makefile @@ -57,6 +57,7 @@ acpi-$(CONFIG_ACPI_PROCFS_POWER) += cm_sbs.o acpi-y += acpi_lpat.o acpi-$(CONFIG_ACPI_GENERIC_GSI) += gsi.o acpi-$(CONFIG_ACPI_WATCHDOG) += acpi_watchdog.o +acpi-y += irqdomain.o # These are (potentially) separate modules diff --git a/drivers/acpi/irqdomain.c b/drivers/acpi/irqdomain.c new file mode 100644 index 0000000..0429607 --- /dev/null +++ b/drivers/acpi/irqdomain.c @@ -0,0 +1,135 @@ +/* + * ACPI ResourceSource/IRQ domain mapping support + * + * Copyright (c) 2016, The Linux Foundation. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ +#include +#include +#include + +/** + * acpi_irq_domain_ensure_probed() - Check if the device has registered + * an IRQ domain and probe as necessary + * + * @device: Device to check and probe + * + * Returns: 0 on success, -ENODEV otherwise + */ +static int acpi_irq_domain_ensure_probed(struct acpi_device *device) +{ + struct acpi_dsdt_probe_entry *entry; + + if (irq_find_matching_fwnode(&device->fwnode, DOMAIN_BUS_ANY) != 0) + return 0; + + for (entry = &__dsdt_acpi_probe_table; + entry < &__dsdt_acpi_probe_table_end; e++) + if (strcmp(e->_hid, acpi_device_hid(device)) == 0) + return e->probe(device); + + return -ENODEV; +} + +/** + * acpi_irq_domain_register_irq() - Register the mapping for an IRQ produced + * by the given acpi_resource_source to a + * Linux IRQ number + * @source: IRQ source + * @hwirq: Hardware IRQ number + * @trigger: trigger type of the IRQ number to be mapped + * @polarity: polarity of the IRQ to be mapped + * + * Returns: a valid linux IRQ number on success + * -ENODEV if the given acpi_resource_source cannot be found + * -EPROBE_DEFER if the IRQ domain has not been registered + * -EINVAL for all other errors + */ +int acpi_irq_domain_register_irq(struct acpi_resource_source *source, u32 hwirq, + int trigger, int polarity) +{ + struct irq_fwspec fwspec; + struct acpi_device *device; + acpi_handle handle; + acpi_status status; + int ret; + + if (source->string_length == 0) + return acpi_register_gsi(NULL, hwirq, trigger, polarity); + + status = acpi_get_handle(NULL, source->string_ptr, &handle); + if (ACPI_FAILURE(status)) + return -ENODEV; + + device = acpi_bus_get_acpi_device(handle); + if (!device) + return -ENODEV; + + if (acpi_irq_domain_ensure_probed(device)) + return -ENODEV; + + fwspec.fwnode = &device->fwnode; + fwspec.param[0] = hwirq; + fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); + fwspec.param_count = 2; + + ret = irq_create_fwspec_mapping(&fwspec); + acpi_bus_put_acpi_device(device); + return ret; +} +EXPORT_SYMBOL_GPL(acpi_irq_domain_register_irq); + +/** + * acpi_irq_domain_unregister_irq() - Delete the mapping for an IRQ produced + * by the given acpi_resource_source to a + * Linux IRQ number + * @source: IRQ source + * @hwirq: Hardware IRQ number + * + * Returns: 0 on success + * -ENODEV if the given acpi_resource_source cannot be found + * -EINVAL for all other errors + */ +int acpi_irq_domain_unregister_irq(struct acpi_resource_source *source, + u32 hwirq) +{ + struct irq_domain *domain; + struct acpi_device *device; + acpi_handle handle; + acpi_status status; + int ret = 0; + + if (source->string_length == 0) { + acpi_unregister_gsi(hwirq); + return 0; + } + + status = acpi_get_handle(NULL, source->string_ptr, &handle); + if (ACPI_FAILURE(status)) + return -ENODEV; + + device = acpi_bus_get_acpi_device(handle); + if (!device) + return -ENODEV; + + domain = irq_find_matching_fwnode(&device->fwnode, DOMAIN_BUS_ANY); + if (!domain) { + ret = -EINVAL; + goto out_put_device; + } + + irq_dispose_mapping(irq_find_mapping(domain, hwirq)); + +out_put_device: + acpi_bus_put_acpi_device(device); + return ret; +} +EXPORT_SYMBOL_GPL(acpi_irq_domain_unregister_irq); diff --git a/drivers/acpi/resource.c b/drivers/acpi/resource.c index 56241eb..8e69a7a 100644 --- a/drivers/acpi/resource.c +++ b/drivers/acpi/resource.c @@ -381,14 +381,15 @@ static void acpi_dev_irqresource_disabled(struct resource *res, u32 gsi) res->flags = IORESOURCE_IRQ | IORESOURCE_DISABLED | IORESOURCE_UNSET; } -static void acpi_dev_get_irqresource(struct resource *res, u32 gsi, +static void acpi_dev_get_irqresource(struct resource *res, u32 hwirq, + struct acpi_resource_source *source, u8 triggering, u8 polarity, u8 shareable, bool legacy) { int irq, p, t; - if (!valid_IRQ(gsi)) { - acpi_dev_irqresource_disabled(res, gsi); + if ((source->string_length == 0) && !valid_IRQ(hwirq)) { + acpi_dev_irqresource_disabled(res, hwirq); return; } @@ -402,25 +403,25 @@ static void acpi_dev_get_irqresource(struct resource *res, u32 gsi, * using extended IRQ descriptors we take the IRQ configuration * from _CRS directly. */ - if (legacy && !acpi_get_override_irq(gsi, &t, &p)) { + if (legacy && !acpi_get_override_irq(hwirq, &t, &p)) { u8 trig = t ? ACPI_LEVEL_SENSITIVE : ACPI_EDGE_SENSITIVE; u8 pol = p ? ACPI_ACTIVE_LOW : ACPI_ACTIVE_HIGH; if (triggering != trig || polarity != pol) { - pr_warning("ACPI: IRQ %d override to %s, %s\n", gsi, - t ? "level" : "edge", p ? "low" : "high"); + pr_warn("ACPI: IRQ %d override to %s, %s\n", hwirq, + t ? "level" : "edge", p ? "low" : "high"); triggering = trig; polarity = pol; } } res->flags = acpi_dev_irq_flags(triggering, polarity, shareable); - irq = acpi_register_gsi(NULL, gsi, triggering, polarity); + irq = acpi_irq_domain_register_irq(source, hwirq, triggering, polarity); if (irq >= 0) { res->start = irq; res->end = irq; } else { - acpi_dev_irqresource_disabled(res, gsi); + acpi_dev_irqresource_disabled(res, hwirq); } } @@ -448,6 +449,7 @@ bool acpi_dev_resource_interrupt(struct acpi_resource *ares, int index, { struct acpi_resource_irq *irq; struct acpi_resource_extended_irq *ext_irq; + struct acpi_resource_source dummy = { 0, 0, NULL }; switch (ares->type) { case ACPI_RESOURCE_TYPE_IRQ: @@ -460,7 +462,7 @@ bool acpi_dev_resource_interrupt(struct acpi_resource *ares, int index, acpi_dev_irqresource_disabled(res, 0); return false; } - acpi_dev_get_irqresource(res, irq->interrupts[index], + acpi_dev_get_irqresource(res, irq->interrupts[index], &dummy, irq->triggering, irq->polarity, irq->sharable, true); break; @@ -471,6 +473,7 @@ bool acpi_dev_resource_interrupt(struct acpi_resource *ares, int index, return false; } acpi_dev_get_irqresource(res, ext_irq->interrupts[index], + &ext_irq->resource_source, ext_irq->triggering, ext_irq->polarity, ext_irq->sharable, false); break; diff --git a/include/asm-generic/vmlinux.lds.h b/include/asm-generic/vmlinux.lds.h index 3074796..f808afdc 100644 --- a/include/asm-generic/vmlinux.lds.h +++ b/include/asm-generic/vmlinux.lds.h @@ -563,6 +563,7 @@ IRQCHIP_OF_MATCH_TABLE() \ ACPI_PROBE_TABLE(irqchip) \ ACPI_PROBE_TABLE(clksrc) \ + ACPI_PROBE_TABLE(dsdt) \ EARLYCON_TABLE() #define INIT_TEXT \ diff --git a/include/linux/acpi.h b/include/linux/acpi.h index ddbeda6..619cd4f 100644 --- a/include/linux/acpi.h +++ b/include/linux/acpi.h @@ -26,6 +26,7 @@ #include #include #include +#include #ifndef _LINUX #define _LINUX @@ -309,6 +310,11 @@ static inline bool acpi_sci_irq_valid(void) void acpi_set_irq_model(enum acpi_irq_model_id model, struct fwnode_handle *fwnode); +int acpi_irq_domain_register_irq(struct acpi_resource_source *source, u32 hwirq, + int trigger, int polarity); +int acpi_irq_domain_unregister_irq(struct acpi_resource_source *source, + u32 hwirq); + #ifdef CONFIG_X86_IO_APIC extern int acpi_get_override_irq(u32 gsi, int *trigger, int *polarity); #else @@ -1024,6 +1030,43 @@ struct acpi_probe_entry { (&ACPI_PROBE_TABLE_END(t) - \ &ACPI_PROBE_TABLE(t))); \ }) + +#define ACPI_HID_LEN 9 + +typedef int (*acpi_dsdt_handler)(struct acpi_device *); + +/** + * struct acpi_probe_dsdt_entry - boot-time probing entry for DSDT devices + * @hid: _HID of the device + * @fn: Callback to the driver being probed + * @driver_data: Sideband data provided back to the driver + */ +struct acpi_dsdt_probe_entry { + __u8 _hid[ACPI_HID_LEN]; + acpi_dsdt_handler probe; +}; + +#define ACPI_DECLARE_DSDT_PROBE_ENTRY(name, hid, fn) \ + static const struct acpi_dsdt_probe_entry __acpi_probe_##name \ + __used __section(__dsdt_acpi_probe_table) = \ + { \ + ._hid = hid, \ + .probe = fn, \ + } + +extern struct acpi_dsdt_probe_entry __dsdt_acpi_probe_table; +extern struct acpi_dsdt_probe_entry __dsdt_acpi_probe_table_end; + +#define MADT_IRQCHIP_ACPI_DECLARE(name, subtable, validate, data, fn) \ + ACPI_DECLARE_PROBE_ENTRY(irqchip, name, ACPI_SIG_MADT, \ + subtable, validate, data, fn) + +#define DSDT_IRQCHIP_ACPI_DECLARE(name, hid, fn) \ + ACPI_DECLARE_DSDT_PROBE_ENTRY(name, hid, fn) + +#define __IRQCHIP_ACPI_DECLARE(_a1, _a2, _a3, _a4, _a5, type, ...) \ + type##_IRQCHIP_ACPI_DECLARE + #else static inline int acpi_dev_get_property(struct acpi_device *adev, const char *name, acpi_object_type type, @@ -1101,6 +1144,13 @@ static inline struct fwnode_handle *acpi_get_next_subnode(struct device *dev, (void *) data } #define acpi_probe_device_table(t) ({ int __r = 0; __r;}) + +#define ACPI_DECLARE_DSDT_PROBE_ENTRY(name, hid, fn) \ + static const void *__acpi_probe_##name[] \ + __attribute__((unused)) \ + = { (void *) hid, \ + (void *) fn } + #endif #ifdef CONFIG_ACPI_TABLE_UPGRADE diff --git a/include/linux/irqchip.h b/include/linux/irqchip.h index 89c34b2..c2d0c12 100644 --- a/include/linux/irqchip.h +++ b/include/linux/irqchip.h @@ -29,6 +29,10 @@ /* * This macro must be used by the different irqchip drivers to declare * the association between their version and their initialization function. + * Two syntaxes are supported depending on the table where the irqchip device + * is declared: + * + * - MADT irqchip syntax, which requires the following five arguments: * * @name: name that must be unique accross all IRQCHIP_ACPI_DECLARE of the * same file. @@ -37,10 +41,17 @@ * Can be NULL. * @data: data to be checked by the validate function. * @fn: initialization function + * + * - DSDT irqchip syntax, which requires the following three arguments: + * + * @name: name that must be unique across all IRQCHIP_ACPI_DECLARE of the + * same file. + * @hid: _HID of the DSDT device + * @fn: initialization function */ -#define IRQCHIP_ACPI_DECLARE(name, subtable, validate, data, fn) \ - ACPI_DECLARE_PROBE_ENTRY(irqchip, name, ACPI_SIG_MADT, \ - subtable, validate, data, fn) + +#define IRQCHIP_ACPI_DECLARE(...) \ + __IRQCHIP_ACPI_DECLARE(__VA_ARGS__, MADT, _unused, DSDT)(__VA_ARGS__) #ifdef CONFIG_IRQCHIP void irqchip_init(void);