luck/tmp_suning_uos_patched
1
0
Fork 1
Code Issues Pull Requests Packages Projects Releases Wiki Activity

gpio: mvebu: Fix probe cleanup on error

Browse Source 
Ensure that when there is an error during probe that the gpiochip is
removed and the generic irq chip is removed.

Signed-off-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
Andrew Lunn 2015-01-10 00:34:48 +01:00 committed by Linus Walleij
parent a4319a611b
commit f1d2d081e8
1 changed files with 17 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
drivers/gpio/gpio-mvebu.c
View File

@ -667,6 +667,7 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
unsigned int ngpios; unsigned int ngpios;
int soc_variant; int soc_variant;
int i, cpu, id; int i, cpu, id;
int err;
match = of_match_device(mvebu_gpio_of_match, &pdev->dev); match = of_match_device(mvebu_gpio_of_match, &pdev->dev);
if (match) if (match)
@ -785,14 +786,16 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
mvchip->irqbase = irq_alloc_descs(-1, 0, ngpios, -1); mvchip->irqbase = irq_alloc_descs(-1, 0, ngpios, -1);
if (mvchip->irqbase < 0) { if (mvchip->irqbase < 0) {
dev_err(&pdev->dev, "no irqs\n"); dev_err(&pdev->dev, "no irqs\n");
return mvchip->irqbase; err = mvchip->irqbase;
goto err_gpiochip_add;
} }
gc = irq_alloc_generic_chip("mvebu_gpio_irq", 2, mvchip->irqbase, gc = irq_alloc_generic_chip("mvebu_gpio_irq", 2, mvchip->irqbase,
mvchip->membase, handle_level_irq); mvchip->membase, handle_level_irq);
if (!gc) { if (!gc) {
dev_err(&pdev->dev, "Cannot allocate generic irq_chip\n"); dev_err(&pdev->dev, "Cannot allocate generic irq_chip\n");
return -ENOMEM; err = -ENOMEM;
goto err_gpiochip_add;
} }
gc->private = mvchip; gc->private = mvchip;
@ -823,13 +826,21 @@ static int mvebu_gpio_probe(struct platform_device *pdev)
if (!mvchip->domain) { if (!mvchip->domain) {
dev_err(&pdev->dev, "couldn't allocate irq domain %s (DT).\n", dev_err(&pdev->dev, "couldn't allocate irq domain %s (DT).\n",
mvchip->chip.label); mvchip->chip.label);
irq_remove_generic_chip(gc, IRQ_MSK(ngpios), IRQ_NOREQUEST, err = -ENODEV;
IRQ_LEVEL | IRQ_NOPROBE); goto err_generic_chip;
kfree(gc);
return -ENODEV;
} }
return 0; return 0;
err_generic_chip:
irq_remove_generic_chip(gc, IRQ_MSK(ngpios), IRQ_NOREQUEST,
IRQ_LEVEL | IRQ_NOPROBE);
kfree(gc);
err_gpiochip_add:
gpiochip_remove(&mvchip->chip);
return err;
} }
static struct platform_driver mvebu_gpio_driver = { static struct platform_driver mvebu_gpio_driver = {