Received: by 2002:a05:6a10:f3d0:0:0:0:0 with SMTP id a16csp2145760pxv; Sun, 11 Jul 2021 04:12:07 -0700 (PDT) X-Google-Smtp-Source: ABdhPJxRI2pemGx887uXVZWcSoOm9s1+2nPDBYT1ludI64AlgiLNhu1e4nM5+jqKwoeUdi5O4YtO X-Received: by 2002:a17:906:25d5:: with SMTP id n21mr48245423ejb.156.1626001926968; Sun, 11 Jul 2021 04:12:06 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1626001926; cv=none; d=google.com; s=arc-20160816; b=XmmqDGqhOtYH3zSiViTxncf4PigUkyVZnZ/EsJlPymi9MHg3/mdwyNB1r/Wh4AqfSQ Rq3V+Wq5RLP29xOHi0warPy6JFwpvKR99dKpxzaXpo+eqPv7fn5HkzI8itE7ra+SZKv5 vIdPnHYybe+Zsm4ROGkOD+iqCbxalXXFkHAh6BW7H3L2wSUykJBKr2aEYYDYlHoZZ4B6 TWef+GKinHBT6skfuQh+i6D3KjcW68170qO81q4bZw+ldxtTOUUHVM44q24oY8btGA8N ztPh7BlfwcvgrGa1cyzlHBJucNqIjaZKCuWU9k1UScMExDdocY5m7sMgiHwKe1TULTCd fa2A== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:mime-version:user-agent:references:in-reply-to :subject:cc:to:from:message-id:date; bh=qdp3B8wf4h56aD3VrBoAVaiI0FukO2a8AX931tw7NQ4=; b=l11a397DtrHKaEIhAL5ygTMa3ou/ihd/Ltoaj8Y96fOkWXbqGoAC2EgMZogRVUCfwL 1bS/RfrCl5067PikBikyLhDKi7/bhm4s99dtOv8tASgXHVf3/SFd1VHvUKIj+NJ+6Fm1 yQQMpQ714Enj/gEa+JgYpiV5+VKpgPH0IBwkP75Wz99syZoma0tL9J5hlZ9M682t2o5C rUCpnEA1nTMlJnUrl/k+C6TniBM1RFpZ6KjgTo9RJ7mqa04e9aS+5P4stpmYNOnEuzWx qy/TxfisdpzLXbqwvWqJCWGdYZsJ+0jlBFAqHIT4RqOogv+W5pY3ipPZEWAcuWIlG7H9 aZ3A== ARC-Authentication-Results: i=1; mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id mp36si14188920ejc.478.2021.07.11.04.11.43; Sun, 11 Jul 2021 04:12:06 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S232647AbhGKLM1 (ORCPT + 99 others); Sun, 11 Jul 2021 07:12:27 -0400 Received: from mail.kernel.org ([198.145.29.99]:44106 "EHLO mail.kernel.org" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S232024AbhGKLM0 (ORCPT ); Sun, 11 Jul 2021 07:12:26 -0400 Received: from disco-boy.misterjones.org (disco-boy.misterjones.org [51.254.78.96]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPSA id 3C5E1610FB; Sun, 11 Jul 2021 11:09:40 +0000 (UTC) Received: from host31-54-148-101.range31-54.btcentralplus.com ([31.54.148.101] helo=wait-a-minute.misterjones.org) by disco-boy.misterjones.org with esmtpsa (TLS1.3) tls TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384 (Exim 4.94.2) (envelope-from ) id 1m2XL8-00CX2s-6d; Sun, 11 Jul 2021 12:09:38 +0100 Date: Sun, 11 Jul 2021 12:09:37 +0100 Message-ID: <87a6mt2jke.wl-maz@kernel.org> From: Marc Zyngier To: Sunil Muthuswamy Cc: Thomas Gleixner , "linux-kernel@vger.kernel.org" , "linux-arm-kernel@lists.infradead.org" , "catalin.marinas@arm.com" , "will@kernel.org" , Michael Kelley , Boqun Feng , KY Srinivasan , Arnd Bergmann Subject: Re: [RFC 1/1] irqchip/gic-v3-its: Add irq domain and chip for Direct LPI without ITS In-Reply-To: References: User-Agent: Wanderlust/2.15.9 (Almost Unreal) SEMI-EPG/1.14.7 (Harue) FLIM-LB/1.14.9 (=?UTF-8?B?R29qxY0=?=) APEL-LB/10.8 EasyPG/1.0.0 Emacs/27.1 (x86_64-pc-linux-gnu) MULE/6.0 (HANACHIRUSATO) MIME-Version: 1.0 (generated by SEMI-EPG 1.14.7 - "Harue") Content-Type: text/plain; charset=US-ASCII X-SA-Exim-Connect-IP: 31.54.148.101 X-SA-Exim-Rcpt-To: sunilmut@microsoft.com, tglx@linutronix.de, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org, catalin.marinas@arm.com, will@kernel.org, mikelley@microsoft.com, Boqun.Feng@microsoft.com, kys@microsoft.com, arnd@arndb.de X-SA-Exim-Mail-From: maz@kernel.org X-SA-Exim-Scanned: No (on disco-boy.misterjones.org); SAEximRunCond expanded to false Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On Thu, 08 Jul 2021 20:36:51 +0100, Sunil Muthuswamy wrote: > > The current GIC v3 driver doesn't support Direct LPI when there is > no ITS. The spec architecturally supports Direct LPI without an ITS. > This patch introduces an IRQ domain and chip to manage Direct LPI > when there is no ITS. > > Signed-off-by: Sunil Muthuswamy > --- > drivers/irqchip/Makefile | 2 +- > drivers/irqchip/irq-gic-common.h | 22 + > drivers/irqchip/irq-gic-v3-dlpi.c | 639 ++++++++++++++++++++++++++++++ > drivers/irqchip/irq-gic-v3-its.c | 51 ++- > 4 files changed, 694 insertions(+), 20 deletions(-) > create mode 100644 drivers/irqchip/irq-gic-v3-dlpi.c > > diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile > index f88cbf36a9d2..c6ea9620161b 100644 > --- a/drivers/irqchip/Makefile > +++ b/drivers/irqchip/Makefile > @@ -32,7 +32,7 @@ obj-$(CONFIG_ARM_GIC_PM) += irq-gic-pm.o > obj-$(CONFIG_ARCH_REALVIEW) += irq-gic-realview.o > obj-$(CONFIG_ARM_GIC_V2M) += irq-gic-v2m.o > obj-$(CONFIG_ARM_GIC_V3) += irq-gic-v3.o irq-gic-v3-mbi.o irq-gic-common.o > -obj-$(CONFIG_ARM_GIC_V3_ITS) += irq-gic-v3-its.o irq-gic-v3-its-platform-msi.o irq-gic-v4.o > +obj-$(CONFIG_ARM_GIC_V3_ITS) += irq-gic-v3-its.o irq-gic-v3-its-platform-msi.o irq-gic-v4.o irq-gic-v3-dlpi.o > obj-$(CONFIG_ARM_GIC_V3_ITS_PCI) += irq-gic-v3-its-pci-msi.o > obj-$(CONFIG_ARM_GIC_V3_ITS_FSL_MC) += irq-gic-v3-its-fsl-mc-msi.o > obj-$(CONFIG_PARTITION_PERCPU) += irq-partition-percpu.o > diff --git a/drivers/irqchip/irq-gic-common.h b/drivers/irqchip/irq-gic-common.h > index ccba8b0fe0f5..21e4e8f6ba70 100644 > --- a/drivers/irqchip/irq-gic-common.h > +++ b/drivers/irqchip/irq-gic-common.h > @@ -30,4 +30,26 @@ void gic_enable_of_quirks(const struct device_node *np, > > void gic_set_kvm_info(const struct gic_kvm_info *info); > > +/* LPI related functionality */ > +/* > + * TODO: Ideally, I think these should be moved to a different file > + * such as irq-gic-v3-lpi-common.h/.c. But, keeping it here > + * for now to get comments from the RFC. > + */ > +DECLARE_PER_CPU(struct cpu_lpi_count, cpu_lpi_count); > + > +__maybe_unused u32 its_read_lpi_count(struct irq_data *d, int cpu); > +void its_inc_lpi_count(struct irq_data *d, int cpu); > +void its_dec_lpi_count(struct irq_data *d, int cpu); > +unsigned int cpumask_pick_least_loaded(struct irq_data *d, > + const struct cpumask *cpu_mask); Ideally, you shouldn't use this at all. At least not until we have figured out what you are trying to achieve. At best, this is premature optimisation. > +int its_irq_gic_domain_alloc(struct irq_domain *domain, > + unsigned int virq, > + irq_hw_number_t hwirq); > +unsigned long *its_lpi_alloc(int nr_irqs, u32 *base, int *nr_ids); > +void its_lpi_free(unsigned long *bitmap, u32 base, u32 nr_ids); And certainly not use these *ever*. > + > +struct rdists; > +int direct_lpi_init(struct irq_domain *parent, struct rdists *rdists); > + > #endif /* _IRQ_GIC_COMMON_H */ > diff --git a/drivers/irqchip/irq-gic-v3-dlpi.c b/drivers/irqchip/irq-gic-v3-dlpi.c > new file mode 100644 > index 000000000000..722a0630fced > --- /dev/null > +++ b/drivers/irqchip/irq-gic-v3-dlpi.c > @@ -0,0 +1,639 @@ > +// SPDX-License-Identifier: GPL-2.0-only > +/* > + * Copyright (c) Microsoft Corporation. > + * Author: Sunil Muthuswamy > + * > + * This file implements an IRQ domain and chip to handle Direct LPI > + * when there is no ITS, for GIC v3. > + */ > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +#include > +#include > +#include > + > +#include "irq-gic-common.h" > + > +static struct rdists *gic_rdists; > + > +#define gic_data_rdist_cpu(cpu) (per_cpu_ptr(gic_rdists->rdist, cpu)) > + > +#define RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING (1 << 0) > + > +/* > + * Structure that holds most of the infrastructure needed to support > + * DirectLPI without an ITS. > + * > + * dev_alloc_lock has to be taken for device allocations, while the > + * spinlock must be taken to parse data structures such as the device > + * list. > + */ > + > +struct direct_lpi { > + raw_spinlock_t lock; > + struct mutex dev_alloc_lock; > + struct list_head entry; > + struct fwnode_handle *fwnode_handle; > + struct list_head device_list; > + u64 flags; > + unsigned int msi_domain_flags; > +}; > + > +struct event_lpi_map { > + unsigned long *lpi_map; > + u16 *col_map; > + irq_hw_number_t lpi_base; > + int nr_lpis; > +}; DirectLPI has no notion of event, collection, or anything like this. It deals with LPIs, and that's it. > + > +struct direct_lpi_device { > + struct list_head entry; > + struct direct_lpi *dlpi; > + struct event_lpi_map event_map; > + u32 device_id; > + bool shared; > +}; Same this here. DirectLPI has no notion of DeviceID. > + > +static int dlpi_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, > + unsigned int nr_irqs, void *args); > + > +static void dlpi_irq_domain_free(struct irq_domain *domain, unsigned int virq, > + unsigned int nr_irqs); > + > +static int dlpi_irq_domain_activate(struct irq_domain *domain, > + struct irq_data *d, bool reserve); > + > +static void dlpi_irq_domain_deactivate(struct irq_domain *domain, > + struct irq_data *d); > + > +static const struct irq_domain_ops dlpi_domain_ops = { > + .alloc = dlpi_irq_domain_alloc, > + .free = dlpi_irq_domain_free, > + .activate = dlpi_irq_domain_activate, > + .deactivate = dlpi_irq_domain_deactivate, > +}; > + > +static int dlpi_msi_prepare(struct irq_domain *domain, struct device *dev, > + int nvec, msi_alloc_info_t *info); > + > +static struct msi_domain_ops dlpi_msi_domain_ops = { > + .msi_prepare = dlpi_msi_prepare, > +}; > + > +static int dlpi_init_domain(struct fwnode_handle *handle, > + struct irq_domain *parent_domain, > + struct direct_lpi *dlpi) > +{ > + struct irq_domain *inner_domain; > + struct msi_domain_info *info; > + > + info = kzalloc(sizeof(*info), GFP_KERNEL); > + if (!info) > + return -ENOMEM; > + > + inner_domain = irq_domain_create_tree(handle, &dlpi_domain_ops, NULL); > + if (!inner_domain) { > + kfree(info); > + return -ENOMEM; > + } > + > + inner_domain->parent = parent_domain; > + irq_domain_update_bus_token(inner_domain, DOMAIN_BUS_NEXUS); > + inner_domain->flags |= dlpi->msi_domain_flags; > + info->ops = &dlpi_msi_domain_ops; > + info->data = dlpi; > + inner_domain->host_data = info; > + > + return 0; > +} > + > +int __init direct_lpi_init(struct irq_domain *parent, struct rdists *rdists) > +{ > + struct fwnode_handle *fwnode; > + int err; > + struct direct_lpi *dlpi = NULL; > + > + gic_rdists = rdists; > + fwnode = irq_domain_alloc_named_fwnode("Direct LPI"); > + if (!fwnode) > + return -ENOMEM; > + > + /* > + * Registering with the iort allows other services to query the > + * fwnode. But, the registration requires an ITS ID and base address, > + * which does not apply here. So, probably best to just export the > + * fwnode handle for other services. Keeping it here for comments > + * from RFC submission. > + */ > + err = iort_register_domain_token(0, 0, fwnode); > + if (err) > + goto out_free_fwnode; Please remove this. IORT has no notion of DirectLPI, and doesn't describe it at all. > + > + dlpi = kzalloc(sizeof(*dlpi), GFP_KERNEL); > + if (!dlpi) { > + err = -ENOMEM; > + goto out_unregister_fwnode; > + } > + > + raw_spin_lock_init(&dlpi->lock); > + mutex_init(&dlpi->dev_alloc_lock); > + INIT_LIST_HEAD(&dlpi->entry); > + INIT_LIST_HEAD(&dlpi->device_list); > + dlpi->msi_domain_flags = IRQ_DOMAIN_FLAG_MSI_REMAP; Remap what? There is nothing to remap at all, since you don't have an ITS! From a security/isolation perspective, DirectLPI is a gaping hole. > + err = dlpi_init_domain(fwnode, parent, dlpi); > + if (err) > + goto out_unregister_fwnode; > + > + return 0; > + > +out_unregister_fwnode: > + iort_deregister_domain_token(0); > +out_free_fwnode: > + irq_domain_free_fwnode(fwnode); > + kfree(dlpi); > + > + return err; > + > +} > + > +static inline u32 dlpi_get_event_id(struct irq_data *d) > +{ > + struct direct_lpi_device *dlpi_dev = irq_data_get_irq_chip_data(d); > + > + return d->hwirq - dlpi_dev->event_map.lpi_base; This is more and more puzzling. DirectLPI *does not* perform any device isolation, so there is no per-device interrupt namespace. You are just copy-pasting bits of the ITS code without understanding the architecture. > +} > + > +static int dlpi_irq_to_cpuid(struct irq_data *d, unsigned long *flags) > +{ > + int cpu; > + > + /* Physical LPIs are already locked via the irq_desc lock */ > + struct direct_lpi_device *dlpi_dev = > + irq_data_get_irq_chip_data(d); > + cpu = dlpi_dev->event_map.col_map[dlpi_get_event_id(d)]; > + /* Keep GCC quiet... */ > + *flags = 0; More pointless copy-paste. > + > + return cpu; > +} > + > +/* > + * irqchip functions - assumes MSI, mostly. > + */ > +//TODO: Maybe its::lpi_write_config can call into this routine > +static void lpi_write_config(struct irq_data *d, u8 clr, u8 set) > +{ > + irq_hw_number_t hwirq; > + void *va; > + u8 *cfg; > + > + va = gic_rdists->prop_table_va; > + hwirq = d->hwirq; > + cfg = va + hwirq - 8192; > + *cfg &= ~clr; > + *cfg |= set | LPI_PROP_GROUP1; > + > + /* > + * Make the above write visible to the redistributors. > + * And yes, we're flushing exactly: One. Single. Byte. > + * Humpf... > + */ > + if (gic_rdists->flags & RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING) > + gic_flush_dcache_to_poc(cfg, sizeof(*cfg)); > + else > + dsb(ishst); > +} > + > +static void wait_for_syncr(void __iomem *rdbase) > +{ > + while (readl_relaxed(rdbase + GICR_SYNCR) & 1) > + cpu_relax(); > +} > + > +static void dlpi_direct_lpi_inv(struct irq_data *d) > +{ > + void __iomem *rdbase; > + unsigned long flags; > + u64 val; > + int cpu; > + > + val = d->hwirq; > + > + /* Target the redistributor this LPI is currently routed to */ > + cpu = dlpi_irq_to_cpuid(d, &flags); > + raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); > + rdbase = per_cpu_ptr(gic_rdists->rdist, cpu)->rd_base; > + gic_write_lpir(val, rdbase + GICR_INVLPIR); > + wait_for_syncr(rdbase); > + raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); > +} > + > +static int dlpi_alloc_device_irq(struct direct_lpi_device *dlpi_dev, > + int nvecs, irq_hw_number_t *hwirq) > +{ > + int idx; > + > + /* Find a free LPI region in lpi_map and allocate them. */ > + idx = bitmap_find_free_region(dlpi_dev->event_map.lpi_map, > + dlpi_dev->event_map.nr_lpis, > + get_count_order(nvecs)); > + if (idx < 0) > + return -ENOSPC; > + > + *hwirq = dlpi_dev->event_map.lpi_base + idx; > + > + return 0; Totally pointless, again. Why do you maintain a per-device allocation given that there is no per-device HW tracking? > +} > + > +static void no_lpi_update_config(struct irq_data *d, u8 clr, u8 set) > +{ > + lpi_write_config(d, clr, set); > + dlpi_direct_lpi_inv(d); > +} > + > +static void dlpi_unmask_irq(struct irq_data *d) > +{ > + no_lpi_update_config(d, 0, LPI_PROP_ENABLED); > +} > + > +static void dlpi_mask_irq(struct irq_data *d) > +{ > + no_lpi_update_config(d, LPI_PROP_ENABLED, 0); > +} > + > +static int dlpi_select_cpu(struct irq_data *d, > + const struct cpumask *aff_mask) > +{ > + cpumask_var_t tmpmask; > + int cpu; > + > + if (!alloc_cpumask_var(&tmpmask, GFP_ATOMIC)) > + return -ENOMEM; > + > + /* There is no NUMA node affliation */ Why? > + if (!irqd_affinity_is_managed(d)) { > + /* Try the intersection of the affinity and online masks */ > + cpumask_and(tmpmask, aff_mask, cpu_online_mask); > + > + /* If that doesn't fly, the online mask is the last resort */ > + if (cpumask_empty(tmpmask)) > + cpumask_copy(tmpmask, cpu_online_mask); > + > + cpu = cpumask_pick_least_loaded(d, tmpmask); > + } else { > + cpumask_and(tmpmask, irq_data_get_affinity_mask(d), cpu_online_mask); > + cpu = cpumask_pick_least_loaded(d, tmpmask); > + } > + > + free_cpumask_var(tmpmask); > + pr_debug("IRQ%d -> %*pbl CPU%d\n", d->irq, cpumask_pr_args(aff_mask), cpu); > + > + return cpu; > +} > + > +static int dlpi_set_affinity(struct irq_data *d, const struct cpumask *mask_val, > + bool force) > +{ > + struct direct_lpi_device *dlpi_dev = irq_data_get_irq_chip_data(d); > + u32 id = dlpi_get_event_id(d); > + int cpu, prev_cpu; > + > + /* > + * A forwarded interrupt should use irq_set_vcpu_affinity. Anyways, > + * vcpu is not supported for Direct LPI, as it requires an ITS. > + */ > + if (irqd_is_forwarded_to_vcpu(d)) > + return -EINVAL; > + > + prev_cpu = dlpi_dev->event_map.col_map[id]; > + its_dec_lpi_count(d, prev_cpu); > + > + if (!force) > + cpu = dlpi_select_cpu(d, mask_val); > + else > + cpu = cpumask_pick_least_loaded(d, mask_val); > + > + if (cpu < 0 || cpu >= nr_cpu_ids) > + goto err; > + > + /* don't set the affinity when the target cpu is same as current one */ > + if (cpu != prev_cpu) { > + dlpi_dev->event_map.col_map[id] = cpu; > + irq_data_update_effective_affinity(d, cpumask_of(cpu)); > + } > + > + its_inc_lpi_count(d, cpu); > + > + return IRQ_SET_MASK_OK_DONE; > + > +err: > + its_inc_lpi_count(d, prev_cpu); > + return -EINVAL; > +} > + > +static u64 dlpi_get_msi_base(struct irq_data *d) > +{ > + u64 addr; > + int cpu; > + unsigned long flags; > + > + cpu = dlpi_irq_to_cpuid(d, &flags); > + addr = (u64)(per_cpu_ptr(gic_rdists->rdist, cpu)->rd_base + > + GICR_SETLPIR); > + > + return addr; > +} > + > +/* > + * As per the spec, MSI address is the address of the target processor's > + * GICR_SETLPIR location. > + */ > +static void dlpi_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg) > +{ > + u64 addr; > + > + addr = dlpi_get_msi_base(d); > + > + msg->address_lo = lower_32_bits(addr); > + msg->address_hi = upper_32_bits(addr); Oh, that's is going to work so well with MultiMSI... > + msg->data = dlpi_get_event_id(d); > + > + iommu_dma_compose_msi_msg(irq_data_get_msi_desc(d), msg); > +} > + > +static int dlpi_irq_set_irqchip_state(struct irq_data *d, > + enum irqchip_irq_state which, > + bool state) > +{ > + if (which != IRQCHIP_STATE_PENDING) > + return -EINVAL; > + > + return 0; This is a joke, right? > +} > + > +static int dlpi_irq_retrigger(struct irq_data *d) > +{ > + return !dlpi_irq_set_irqchip_state(d, IRQCHIP_STATE_PENDING, true); > +} > + > +static int dlpi_irq_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) > +{ > + /* vCPU support requires an ITS */ > + return -EINVAL; Then why are you providing this callback the first place? > +} > + > +static struct irq_chip dlpi_irq_chip = { > + .name = "Direct LPI", > + .irq_mask = dlpi_mask_irq, > + .irq_unmask = dlpi_unmask_irq, > + .irq_eoi = irq_chip_eoi_parent, > + .irq_set_affinity = dlpi_set_affinity, > + .irq_compose_msi_msg = dlpi_irq_compose_msi_msg, > + .irq_set_irqchip_state = dlpi_irq_set_irqchip_state, > + .irq_retrigger = dlpi_irq_retrigger, > + .irq_set_vcpu_affinity = dlpi_irq_set_vcpu_affinity, > +}; > + > +static int dlpi_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, > + unsigned int nr_irqs, void *args) > +{ > + msi_alloc_info_t *info = args; > + struct direct_lpi_device *dlpi_dev = info->scratchpad[0].ptr; > + struct irq_data *irqd; > + irq_hw_number_t hwirq; > + int err; > + int i; > + > + err = dlpi_alloc_device_irq(dlpi_dev, nr_irqs, &hwirq); > + if (err) > + return err; > + > + /* > + * TODO: Need to call 'iommu_dma_prepare_msi' to prepare for DMA, > + * but, that requires an MSI address. And, for Direct LPI > + * the MSI address comes from the Redistributor from > + * 'GICR_SETLPIR', which is per CPU and that is not known > + * at the moment. Not sure what is the best way to handle > + * this. > + */ > + > + /* > + err = iommu_dma_prepare_msi(info->desc, its->get_msi_base(its_dev)); > + if (err) > + return err; > + */ What is the point of this? IORT cannot describe the routing of MSIs to redistributors, only to an ITS. > + > + for (i = 0; i < nr_irqs; i++) { > + err = its_irq_gic_domain_alloc(domain, virq + i, hwirq + i); > + if (err) > + return err; > + > + irq_domain_set_hwirq_and_chip(domain, virq + i, hwirq + i, > + &dlpi_irq_chip, dlpi_dev); > + irqd = irq_get_irq_data(virq + i); > + irqd_set_single_target(irqd); > + irqd_set_affinity_on_activate(irqd); > + pr_debug("ID:%d pID:%d vID:%d\n", > + (int)(hwirq + i - dlpi_dev->event_map.lpi_base), > + (int)(hwirq + i), virq + i); > + } > + > + return 0; > +} > + > +static void dlpi_free_device(struct direct_lpi_device *dlpi_dev) > +{ > + unsigned long flags; > + > + raw_spin_lock_irqsave(&dlpi_dev->dlpi->lock, flags); > + list_del(&dlpi_dev->entry); > + raw_spin_unlock_irqrestore(&dlpi_dev->dlpi->lock, flags); > + kfree(dlpi_dev->event_map.col_map); > + kfree(dlpi_dev->event_map.lpi_map); > + kfree(dlpi_dev); > +} > + > +static void dlpi_irq_domain_free(struct irq_domain *domain, unsigned int virq, > + unsigned int nr_irqs) > +{ > + struct irq_data *d = irq_domain_get_irq_data(domain, virq); > + struct direct_lpi_device *dlpi_dev = irq_data_get_irq_chip_data(d); > + int i; > + struct direct_lpi *dlpi = dlpi_dev->dlpi; > + > + bitmap_release_region(dlpi_dev->event_map.lpi_map, > + dlpi_get_event_id(irq_domain_get_irq_data(domain, virq)), > + get_count_order(nr_irqs)); > + > + for (i = 0; i < nr_irqs; i++) { > + struct irq_data *data = irq_domain_get_irq_data(domain, > + virq + i); > + /* Nuke the entry in the domain */ > + irq_domain_reset_irq_data(data); > + } > + > + mutex_lock(&dlpi->dev_alloc_lock); > + > + /* > + * If all interrupts have been freed, start mopping the > + * floor. This is conditionned on the device not being shared. > + */ > + if (!dlpi_dev->shared && > + bitmap_empty(dlpi_dev->event_map.lpi_map, > + dlpi_dev->event_map.nr_lpis)) { > + its_lpi_free(dlpi_dev->event_map.lpi_map, > + dlpi_dev->event_map.lpi_base, > + dlpi_dev->event_map.nr_lpis); > + > + dlpi_free_device(dlpi_dev); > + } > + > + mutex_unlock(&dlpi->dev_alloc_lock); > + irq_domain_free_irqs_parent(domain, virq, nr_irqs); > +} > + > +static int dlpi_irq_domain_activate(struct irq_domain *domain, > + struct irq_data *d, bool reserve) > +{ > + struct direct_lpi_device *dlpi_dev = irq_data_get_irq_chip_data(d); > + u32 event; > + int cpu; > + > + event = dlpi_get_event_id(d); > + cpu = dlpi_select_cpu(d, cpu_online_mask); > + if (cpu < 0 || cpu >= nr_cpu_ids) > + return -EINVAL; > + > + its_inc_lpi_count(d, cpu); > + dlpi_dev->event_map.col_map[event] = cpu; > + irq_data_update_effective_affinity(d, cpumask_of(cpu)); > + > + return 0; > +} > + > +static void dlpi_irq_domain_deactivate(struct irq_domain *domain, > + struct irq_data *d) > +{ > + struct direct_lpi_device *dlpi_dev = irq_data_get_irq_chip_data(d); > + u32 event = dlpi_get_event_id(d); > + > + its_dec_lpi_count(d, dlpi_dev->event_map.col_map[event]); > +} > + > +static struct direct_lpi_device *dlpi_create_device(struct direct_lpi *dlpi, > + u32 dev_id, int nvecs, bool alloc_lpis) > +{ > + struct direct_lpi_device *dlpi_dev = NULL; > + unsigned long *lpi_map = NULL; > + u16 *col_map = NULL; > + int lpi_base; > + int nr_lpis; > + unsigned long flags; > + > + if (WARN_ON(!is_power_of_2(nvecs))) > + nvecs = roundup_pow_of_two(nvecs); > + > + dlpi_dev = kzalloc(sizeof(*dlpi_dev), GFP_KERNEL); > + if (!dlpi_dev) > + return NULL; > + > + lpi_map = its_lpi_alloc(nvecs, &lpi_base, &nr_lpis); > + if (!lpi_map) { > + kfree(dlpi_dev); > + return NULL; > + } > + > + col_map = kcalloc(nr_lpis, sizeof(*col_map), GFP_KERNEL); > + if (!col_map) { > + kfree(dlpi_dev); > + kfree(lpi_map); > + return NULL; > + } > + > + dlpi_dev->dlpi = dlpi; > + dlpi_dev->event_map.lpi_map = lpi_map; > + dlpi_dev->event_map.col_map = col_map; > + dlpi_dev->event_map.lpi_base = lpi_base; > + dlpi_dev->event_map.nr_lpis = nr_lpis; > + dlpi_dev->device_id = dev_id; > + > + raw_spin_lock_irqsave(&dlpi->lock, flags); > + list_add(&dlpi_dev->entry, &dlpi->device_list); > + raw_spin_unlock_irqrestore(&dlpi->lock, flags); > + > + return dlpi_dev; > +} > + > +static struct direct_lpi_device *dlpi_find_device(struct direct_lpi *dlpi, u32 dev_id) > +{ > + struct direct_lpi_device *dlpi_dev = NULL, *tmp; > + unsigned long flags; > + > + raw_spin_lock_irqsave(&dlpi->lock, flags); > + list_for_each_entry(tmp, &dlpi->device_list, entry) { > + if (tmp->device_id == dev_id) { > + dlpi_dev = tmp; > + break; > + } > + } > + > + raw_spin_unlock_irqrestore(&dlpi->lock, flags); > + > + return dlpi_dev; > +} > + > +static int dlpi_msi_prepare(struct irq_domain *domain, struct device *dev, > + int nvec, msi_alloc_info_t *info) > +{ > + struct direct_lpi_device *dlpi_dev; > + struct direct_lpi *dlpi; > + struct msi_domain_info *msi_info; > + u32 dev_id; > + int err = 0; > + > + /* > + * We ignore "dev" entirely, and rely on the dev_id that has > + * been passed via the scratchpad. This limits this domain's > + * usefulness to upper layers that definitely know that they > + * are built on top of the ITS. > + */ This is complete nonsense. You are just copying bits of the ITS code and randomly reorganising it. You are trying to reuse the PCI-specific front-end of the ITS code, not even realising that it *cannot* work. For example, how can MultiMSI be supported? > + dev_id = info->scratchpad[0].ul; > + msi_info = msi_get_domain_info(domain); > + dlpi = msi_info->data; > + > + mutex_lock(&dlpi->dev_alloc_lock); > + dlpi_dev = dlpi_find_device(dlpi, dev_id); > + if (dlpi_dev) { > + /* > + * We already have seen this ID, probably through > + * another alias (PCI bridge of some sort). No need to > + * create the device. > + */ > + dlpi_dev->shared = true; > + pr_debug("Reusing ITT for devID %x\n", dev_id); > + goto out; > + } > + > + dlpi_dev = dlpi_create_device(dlpi, dev_id, nvec, true); > + if (!dlpi_dev) { > + err = -ENOMEM; > + goto out; > + } > + > +out: > + mutex_unlock(&dlpi->dev_alloc_lock); > + info->scratchpad[0].ptr = dlpi_dev; > + > + return err; > +} > diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c > index ba39668c3e08..aa101dfcbbfc 100644 > --- a/drivers/irqchip/irq-gic-v3-its.c > +++ b/drivers/irqchip/irq-gic-v3-its.c > @@ -178,7 +178,7 @@ struct cpu_lpi_count { > atomic_t unmanaged; > }; > > -static DEFINE_PER_CPU(struct cpu_lpi_count, cpu_lpi_count); > +DEFINE_PER_CPU(struct cpu_lpi_count, cpu_lpi_count); > > static LIST_HEAD(its_nodes); > static DEFINE_RAW_SPINLOCK(its_lock); > @@ -1521,7 +1521,7 @@ static void its_unmask_irq(struct irq_data *d) > lpi_update_config(d, 0, LPI_PROP_ENABLED); > } > > -static __maybe_unused u32 its_read_lpi_count(struct irq_data *d, int cpu) > +__maybe_unused u32 its_read_lpi_count(struct irq_data *d, int cpu) > { > if (irqd_affinity_is_managed(d)) > return atomic_read(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); > @@ -1529,7 +1529,7 @@ static __maybe_unused u32 its_read_lpi_count(struct irq_data *d, int cpu) > return atomic_read(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); > } > > -static void its_inc_lpi_count(struct irq_data *d, int cpu) > +void its_inc_lpi_count(struct irq_data *d, int cpu) > { > if (irqd_affinity_is_managed(d)) > atomic_inc(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); > @@ -1537,7 +1537,7 @@ static void its_inc_lpi_count(struct irq_data *d, int cpu) > atomic_inc(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); > } > > -static void its_dec_lpi_count(struct irq_data *d, int cpu) > +void its_dec_lpi_count(struct irq_data *d, int cpu) > { > if (irqd_affinity_is_managed(d)) > atomic_dec(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); > @@ -1545,7 +1545,7 @@ static void its_dec_lpi_count(struct irq_data *d, int cpu) > atomic_dec(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); > } > > -static unsigned int cpumask_pick_least_loaded(struct irq_data *d, > +unsigned int cpumask_pick_least_loaded(struct irq_data *d, > const struct cpumask *cpu_mask) > { > unsigned int cpu = nr_cpu_ids, tmp; > @@ -2121,7 +2121,7 @@ static int __init its_lpi_init(u32 id_bits) > return err; > } > > -static unsigned long *its_lpi_alloc(int nr_irqs, u32 *base, int *nr_ids) > +unsigned long *its_lpi_alloc(int nr_irqs, u32 *base, int *nr_ids) > { > unsigned long *bitmap = NULL; > int err = 0; > @@ -2153,7 +2153,7 @@ static unsigned long *its_lpi_alloc(int nr_irqs, u32 *base, int *nr_ids) > return bitmap; > } > > -static void its_lpi_free(unsigned long *bitmap, u32 base, u32 nr_ids) > +void its_lpi_free(unsigned long *bitmap, u32 base, u32 nr_ids) > { > WARN_ON(free_lpi_range(base, nr_ids)); > kfree(bitmap); > @@ -3506,9 +3506,9 @@ static struct msi_domain_ops its_msi_domain_ops = { > .msi_prepare = its_msi_prepare, > }; > > -static int its_irq_gic_domain_alloc(struct irq_domain *domain, > - unsigned int virq, > - irq_hw_number_t hwirq) > +int its_irq_gic_domain_alloc(struct irq_domain *domain, > + unsigned int virq, > + irq_hw_number_t hwirq) > { > struct irq_fwspec fwspec; There is no way you are messing with the ITS driver internals like this. The only thing you *may* do is to have a common infrastructure to allocate the RD tables, and only that. None of the ITS infrastructure makes any sense for DirectLPI anyway. Please rearchitect your code to be fully independent of the ITS, and without any of the pointless abstractions that the ITS requires. This should be much closer to GICv3-MBI than the ITS. Heck, you could even use the MBI driver directly instead of trying to use DirectLPI, as it gives you similar functionalities. I also want to understand *how* you are going to plumb this into both ACPI and DT, given that neither understand how to link a PCI endpoint to a set of RDs. M. -- Without deviation from the norm, progress is not possible.