Commit a71225e2 authored by Marc Zyngier's avatar Marc Zyngier Committed by Thomas Gleixner

irqchip/gic-v2m: Add support for multiple MSI frames

The GICv2m driver is so far limited to a single MSI frame, but
nothing prevents an implementation from having several of them.

This patch expands the driver to enumerate all frames, keeping
the first one as the canonical identifier for the MSI domains.
Signed-off-by: default avatarMarc Zyngier <marc.zyngier@arm.com>
Tested-by: default avatarDuc Dang <dhdang@apm.com>
Cc: <linux-arm-kernel@lists.infradead.org>
Cc: Suravee Suthikulpanit <Suravee.Suthikulpanit@amd.com>
Cc: Jason Cooper <jason@lakedaemon.net>
Link: http://lkml.kernel.org/r/1444822037-16983-3-git-send-email-marc.zyngier@arm.comSigned-off-by: default avatarThomas Gleixner <tglx@linutronix.de>
parent db8c70ec
...@@ -50,8 +50,12 @@ ...@@ -50,8 +50,12 @@
/* List of flags for specific v2m implementation */ /* List of flags for specific v2m implementation */
#define GICV2M_NEEDS_SPI_OFFSET 0x00000001 #define GICV2M_NEEDS_SPI_OFFSET 0x00000001
static LIST_HEAD(v2m_nodes);
static DEFINE_SPINLOCK(v2m_lock);
struct v2m_data { struct v2m_data {
spinlock_t msi_cnt_lock; struct list_head entry;
struct device_node *node;
struct resource res; /* GICv2m resource */ struct resource res; /* GICv2m resource */
void __iomem *base; /* GICv2m virt address */ void __iomem *base; /* GICv2m virt address */
u32 spi_start; /* The SPI number that MSIs start */ u32 spi_start; /* The SPI number that MSIs start */
...@@ -158,27 +162,30 @@ static void gicv2m_unalloc_msi(struct v2m_data *v2m, unsigned int hwirq) ...@@ -158,27 +162,30 @@ static void gicv2m_unalloc_msi(struct v2m_data *v2m, unsigned int hwirq)
return; return;
} }
spin_lock(&v2m->msi_cnt_lock); spin_lock(&v2m_lock);
__clear_bit(pos, v2m->bm); __clear_bit(pos, v2m->bm);
spin_unlock(&v2m->msi_cnt_lock); spin_unlock(&v2m_lock);
} }
static int gicv2m_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, static int gicv2m_irq_domain_alloc(struct irq_domain *domain, unsigned int virq,
unsigned int nr_irqs, void *args) unsigned int nr_irqs, void *args)
{ {
struct v2m_data *v2m = domain->host_data; struct v2m_data *v2m = NULL, *tmp;
int hwirq, offset, err = 0; int hwirq, offset, err = 0;
spin_lock(&v2m->msi_cnt_lock); spin_lock(&v2m_lock);
offset = find_first_zero_bit(v2m->bm, v2m->nr_spis); list_for_each_entry(tmp, &v2m_nodes, entry) {
if (offset < v2m->nr_spis) offset = find_first_zero_bit(tmp->bm, tmp->nr_spis);
__set_bit(offset, v2m->bm); if (offset < tmp->nr_spis) {
else __set_bit(offset, tmp->bm);
err = -ENOSPC; v2m = tmp;
spin_unlock(&v2m->msi_cnt_lock); break;
}
}
spin_unlock(&v2m_lock);
if (err) if (!v2m)
return err; return -ENOSPC;
hwirq = v2m->spi_start + offset; hwirq = v2m->spi_start + offset;
...@@ -239,12 +246,61 @@ static struct msi_domain_info gicv2m_pmsi_domain_info = { ...@@ -239,12 +246,61 @@ static struct msi_domain_info gicv2m_pmsi_domain_info = {
.chip = &gicv2m_pmsi_irq_chip, .chip = &gicv2m_pmsi_irq_chip,
}; };
static void gicv2m_teardown(void)
{
struct v2m_data *v2m, *tmp;
list_for_each_entry_safe(v2m, tmp, &v2m_nodes, entry) {
list_del(&v2m->entry);
kfree(v2m->bm);
iounmap(v2m->base);
of_node_put(v2m->node);
kfree(v2m);
}
}
static int gicv2m_allocate_domains(struct irq_domain *parent)
{
struct irq_domain *inner_domain, *pci_domain, *plat_domain;
struct v2m_data *v2m;
v2m = list_first_entry_or_null(&v2m_nodes, struct v2m_data, entry);
if (!v2m)
return 0;
inner_domain = irq_domain_create_tree(of_node_to_fwnode(v2m->node),
&gicv2m_domain_ops, v2m);
if (!inner_domain) {
pr_err("Failed to create GICv2m domain\n");
return -ENOMEM;
}
inner_domain->bus_token = DOMAIN_BUS_NEXUS;
inner_domain->parent = parent;
pci_domain = pci_msi_create_irq_domain(of_node_to_fwnode(v2m->node),
&gicv2m_msi_domain_info,
inner_domain);
plat_domain = platform_msi_create_irq_domain(of_node_to_fwnode(v2m->node),
&gicv2m_pmsi_domain_info,
inner_domain);
if (!pci_domain || !plat_domain) {
pr_err("Failed to create MSI domains\n");
if (plat_domain)
irq_domain_remove(plat_domain);
if (pci_domain)
irq_domain_remove(pci_domain);
irq_domain_remove(inner_domain);
return -ENOMEM;
}
return 0;
}
static int __init gicv2m_init_one(struct device_node *node, static int __init gicv2m_init_one(struct device_node *node,
struct irq_domain *parent) struct irq_domain *parent)
{ {
int ret; int ret;
struct v2m_data *v2m; struct v2m_data *v2m;
struct irq_domain *inner_domain, *pci_domain, *plat_domain;
v2m = kzalloc(sizeof(struct v2m_data), GFP_KERNEL); v2m = kzalloc(sizeof(struct v2m_data), GFP_KERNEL);
if (!v2m) { if (!v2m) {
...@@ -252,6 +308,9 @@ static int __init gicv2m_init_one(struct device_node *node, ...@@ -252,6 +308,9 @@ static int __init gicv2m_init_one(struct device_node *node,
return -ENOMEM; return -ENOMEM;
} }
INIT_LIST_HEAD(&v2m->entry);
v2m->node = node;
ret = of_address_to_resource(node, 0, &v2m->res); ret = of_address_to_resource(node, 0, &v2m->res);
if (ret) { if (ret) {
pr_err("Failed to allocate v2m resource.\n"); pr_err("Failed to allocate v2m resource.\n");
...@@ -299,44 +358,13 @@ static int __init gicv2m_init_one(struct device_node *node, ...@@ -299,44 +358,13 @@ static int __init gicv2m_init_one(struct device_node *node,
goto err_iounmap; goto err_iounmap;
} }
inner_domain = irq_domain_add_tree(node, &gicv2m_domain_ops, v2m); list_add_tail(&v2m->entry, &v2m_nodes);
if (!inner_domain) {
pr_err("Failed to create GICv2m domain\n");
ret = -ENOMEM;
goto err_free_bm;
}
inner_domain->bus_token = DOMAIN_BUS_NEXUS;
inner_domain->parent = parent;
pci_domain = pci_msi_create_irq_domain(of_node_to_fwnode(node),
&gicv2m_msi_domain_info,
inner_domain);
plat_domain = platform_msi_create_irq_domain(of_node_to_fwnode(node),
&gicv2m_pmsi_domain_info,
inner_domain);
if (!pci_domain || !plat_domain) {
pr_err("Failed to create MSI domains\n");
ret = -ENOMEM;
goto err_free_domains;
}
spin_lock_init(&v2m->msi_cnt_lock);
pr_info("Node %s: range[%#lx:%#lx], SPI[%d:%d]\n", node->name, pr_info("Node %s: range[%#lx:%#lx], SPI[%d:%d]\n", node->name,
(unsigned long)v2m->res.start, (unsigned long)v2m->res.end, (unsigned long)v2m->res.start, (unsigned long)v2m->res.end,
v2m->spi_start, (v2m->spi_start + v2m->nr_spis)); v2m->spi_start, (v2m->spi_start + v2m->nr_spis));
return 0; return 0;
err_free_domains:
if (plat_domain)
irq_domain_remove(plat_domain);
if (pci_domain)
irq_domain_remove(pci_domain);
if (inner_domain)
irq_domain_remove(inner_domain);
err_free_bm:
kfree(v2m->bm);
err_iounmap: err_iounmap:
iounmap(v2m->base); iounmap(v2m->base);
err_free_v2m: err_free_v2m:
...@@ -366,5 +394,9 @@ int __init gicv2m_of_init(struct device_node *node, struct irq_domain *parent) ...@@ -366,5 +394,9 @@ int __init gicv2m_of_init(struct device_node *node, struct irq_domain *parent)
} }
} }
if (!ret)
ret = gicv2m_allocate_domains(parent);
if (ret)
gicv2m_teardown();
return ret; return ret;
} }
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment