Commit 7a9239fd authored by Jason Gunthorpe's avatar Jason Gunthorpe Committed by Greg Kroah-Hartman

gpio/mvebu: Use irq_domain_add_linear

commit 812d4788 upstream.

This fixes the irq allocation in this driver to not print:
 irq: Cannot allocate irq_descs @ IRQ34, assuming pre-allocated
 irq: Cannot allocate irq_descs @ IRQ66, assuming pre-allocated

Which happens because the driver already called irq_alloc_descs()
and so the change to use irq_domain_add_simple resulted in calling
irq_alloc_descs() twice.

Modernize the irq allocation in this driver to use the
irq_domain_add_linear flow directly and eliminate the use of
irq_domain_add_simple/legacy

Fixes: ce931f57 ("gpio/mvebu: convert to use irq_domain_add_simple()")
Signed-off-by: default avatarJason Gunthorpe <jgunthorpe@obsidianresearch.com>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 6de98e87
...@@ -293,10 +293,10 @@ static void mvebu_gpio_irq_ack(struct irq_data *d) ...@@ -293,10 +293,10 @@ static void mvebu_gpio_irq_ack(struct irq_data *d)
{ {
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
struct mvebu_gpio_chip *mvchip = gc->private; struct mvebu_gpio_chip *mvchip = gc->private;
u32 mask = ~(1 << (d->irq - gc->irq_base)); u32 mask = d->mask;
irq_gc_lock(gc); irq_gc_lock(gc);
writel_relaxed(mask, mvebu_gpioreg_edge_cause(mvchip)); writel_relaxed(~mask, mvebu_gpioreg_edge_cause(mvchip));
irq_gc_unlock(gc); irq_gc_unlock(gc);
} }
...@@ -305,7 +305,7 @@ static void mvebu_gpio_edge_irq_mask(struct irq_data *d) ...@@ -305,7 +305,7 @@ static void mvebu_gpio_edge_irq_mask(struct irq_data *d)
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
struct mvebu_gpio_chip *mvchip = gc->private; struct mvebu_gpio_chip *mvchip = gc->private;
struct irq_chip_type *ct = irq_data_get_chip_type(d); struct irq_chip_type *ct = irq_data_get_chip_type(d);
u32 mask = 1 << (d->irq - gc->irq_base); u32 mask = d->mask;
irq_gc_lock(gc); irq_gc_lock(gc);
ct->mask_cache_priv &= ~mask; ct->mask_cache_priv &= ~mask;
...@@ -319,8 +319,7 @@ static void mvebu_gpio_edge_irq_unmask(struct irq_data *d) ...@@ -319,8 +319,7 @@ static void mvebu_gpio_edge_irq_unmask(struct irq_data *d)
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
struct mvebu_gpio_chip *mvchip = gc->private; struct mvebu_gpio_chip *mvchip = gc->private;
struct irq_chip_type *ct = irq_data_get_chip_type(d); struct irq_chip_type *ct = irq_data_get_chip_type(d);
u32 mask = d->mask;
u32 mask = 1 << (d->irq - gc->irq_base);
irq_gc_lock(gc); irq_gc_lock(gc);
ct->mask_cache_priv |= mask; ct->mask_cache_priv |= mask;
...@@ -333,8 +332,7 @@ static void mvebu_gpio_level_irq_mask(struct irq_data *d) ...@@ -333,8 +332,7 @@ static void mvebu_gpio_level_irq_mask(struct irq_data *d)
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
struct mvebu_gpio_chip *mvchip = gc->private; struct mvebu_gpio_chip *mvchip = gc->private;
struct irq_chip_type *ct = irq_data_get_chip_type(d); struct irq_chip_type *ct = irq_data_get_chip_type(d);
u32 mask = d->mask;
u32 mask = 1 << (d->irq - gc->irq_base);
irq_gc_lock(gc); irq_gc_lock(gc);
ct->mask_cache_priv &= ~mask; ct->mask_cache_priv &= ~mask;
...@@ -347,8 +345,7 @@ static void mvebu_gpio_level_irq_unmask(struct irq_data *d) ...@@ -347,8 +345,7 @@ static void mvebu_gpio_level_irq_unmask(struct irq_data *d)
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
struct mvebu_gpio_chip *mvchip = gc->private; struct mvebu_gpio_chip *mvchip = gc->private;
struct irq_chip_type *ct = irq_data_get_chip_type(d); struct irq_chip_type *ct = irq_data_get_chip_type(d);
u32 mask = d->mask;
u32 mask = 1 << (d->irq - gc->irq_base);
irq_gc_lock(gc); irq_gc_lock(gc);
ct->mask_cache_priv |= mask; ct->mask_cache_priv |= mask;
...@@ -462,7 +459,7 @@ static void mvebu_gpio_irq_handler(struct irq_desc *desc) ...@@ -462,7 +459,7 @@ static void mvebu_gpio_irq_handler(struct irq_desc *desc)
for (i = 0; i < mvchip->chip.ngpio; i++) { for (i = 0; i < mvchip->chip.ngpio; i++) {
int irq; int irq;
irq = mvchip->irqbase + i; irq = irq_find_mapping(mvchip->domain, i);
if (!(cause & (1 << i))) if (!(cause & (1 << i)))
continue; continue;
...@@ -655,6 +652,7 @@ static int mvebu_gpio_probe(struct platform_device *pdev) ...@@ -655,6 +652,7 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
struct irq_chip_type *ct; struct irq_chip_type *ct;
struct clk *clk; struct clk *clk;
unsigned int ngpios; unsigned int ngpios;
bool have_irqs;
int soc_variant; int soc_variant;
int i, cpu, id; int i, cpu, id;
int err; int err;
...@@ -665,6 +663,9 @@ static int mvebu_gpio_probe(struct platform_device *pdev) ...@@ -665,6 +663,9 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
else else
soc_variant = MVEBU_GPIO_SOC_VARIANT_ORION; soc_variant = MVEBU_GPIO_SOC_VARIANT_ORION;
/* Some gpio controllers do not provide irq support */
have_irqs = of_irq_count(np) != 0;
mvchip = devm_kzalloc(&pdev->dev, sizeof(struct mvebu_gpio_chip), mvchip = devm_kzalloc(&pdev->dev, sizeof(struct mvebu_gpio_chip),
GFP_KERNEL); GFP_KERNEL);
if (!mvchip) if (!mvchip)
...@@ -697,7 +698,8 @@ static int mvebu_gpio_probe(struct platform_device *pdev) ...@@ -697,7 +698,8 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
mvchip->chip.get = mvebu_gpio_get; mvchip->chip.get = mvebu_gpio_get;
mvchip->chip.direction_output = mvebu_gpio_direction_output; mvchip->chip.direction_output = mvebu_gpio_direction_output;
mvchip->chip.set = mvebu_gpio_set; mvchip->chip.set = mvebu_gpio_set;
mvchip->chip.to_irq = mvebu_gpio_to_irq; if (have_irqs)
mvchip->chip.to_irq = mvebu_gpio_to_irq;
mvchip->chip.base = id * MVEBU_MAX_GPIO_PER_BANK; mvchip->chip.base = id * MVEBU_MAX_GPIO_PER_BANK;
mvchip->chip.ngpio = ngpios; mvchip->chip.ngpio = ngpios;
mvchip->chip.can_sleep = false; mvchip->chip.can_sleep = false;
...@@ -758,34 +760,30 @@ static int mvebu_gpio_probe(struct platform_device *pdev) ...@@ -758,34 +760,30 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
devm_gpiochip_add_data(&pdev->dev, &mvchip->chip, mvchip); devm_gpiochip_add_data(&pdev->dev, &mvchip->chip, mvchip);
/* Some gpio controllers do not provide irq support */ /* Some gpio controllers do not provide irq support */
if (!of_irq_count(np)) if (!have_irqs)
return 0; return 0;
/* Setup the interrupt handlers. Each chip can have up to 4 mvchip->domain =
* interrupt handlers, with each handler dealing with 8 GPIO irq_domain_add_linear(np, ngpios, &irq_generic_chip_ops, NULL);
* pins. */ if (!mvchip->domain) {
for (i = 0; i < 4; i++) { dev_err(&pdev->dev, "couldn't allocate irq domain %s (DT).\n",
int irq = platform_get_irq(pdev, i); mvchip->chip.label);
return -ENODEV;
if (irq < 0)
continue;
irq_set_chained_handler_and_data(irq, mvebu_gpio_irq_handler,
mvchip);
}
mvchip->irqbase = irq_alloc_descs(-1, 0, ngpios, -1);
if (mvchip->irqbase < 0) {
dev_err(&pdev->dev, "no irqs\n");
return mvchip->irqbase;
} }
gc = irq_alloc_generic_chip("mvebu_gpio_irq", 2, mvchip->irqbase, err = irq_alloc_domain_generic_chips(
mvchip->membase, handle_level_irq); mvchip->domain, ngpios, 2, np->name, handle_level_irq,
if (!gc) { IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_LEVEL, 0, 0);
dev_err(&pdev->dev, "Cannot allocate generic irq_chip\n"); if (err) {
return -ENOMEM; dev_err(&pdev->dev, "couldn't allocate irq chips %s (DT).\n",
mvchip->chip.label);
goto err_domain;
} }
/* NOTE: The common accessors cannot be used because of the percpu
* access to the mask registers
*/
gc = irq_get_domain_generic_chip(mvchip->domain, 0);
gc->private = mvchip; gc->private = mvchip;
ct = &gc->chip_types[0]; ct = &gc->chip_types[0];
ct->type = IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW; ct->type = IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW;
...@@ -803,27 +801,23 @@ static int mvebu_gpio_probe(struct platform_device *pdev) ...@@ -803,27 +801,23 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
ct->handler = handle_edge_irq; ct->handler = handle_edge_irq;
ct->chip.name = mvchip->chip.label; ct->chip.name = mvchip->chip.label;
irq_setup_generic_chip(gc, IRQ_MSK(ngpios), 0, /* Setup the interrupt handlers. Each chip can have up to 4
IRQ_NOREQUEST, IRQ_LEVEL | IRQ_NOPROBE); * interrupt handlers, with each handler dealing with 8 GPIO
* pins.
*/
for (i = 0; i < 4; i++) {
int irq = platform_get_irq(pdev, i);
/* Setup irq domain on top of the generic chip. */ if (irq < 0)
mvchip->domain = irq_domain_add_simple(np, mvchip->chip.ngpio, continue;
mvchip->irqbase, irq_set_chained_handler_and_data(irq, mvebu_gpio_irq_handler,
&irq_domain_simple_ops, mvchip);
mvchip);
if (!mvchip->domain) {
dev_err(&pdev->dev, "couldn't allocate irq domain %s (DT).\n",
mvchip->chip.label);
err = -ENODEV;
goto err_generic_chip;
} }
return 0; return 0;
err_generic_chip: err_domain:
irq_remove_generic_chip(gc, IRQ_MSK(ngpios), IRQ_NOREQUEST, irq_domain_remove(mvchip->domain);
IRQ_LEVEL | IRQ_NOPROBE);
kfree(gc);
return err; return err;
} }
......
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