Techwizz/kernel-fxtec-pro1x
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

mmc: davinci: fix unwinding in probe

Browse source 
Unwiding from an error in davinci_mmcsd_probe was a mess. Some errors were
not handled and not all paths unwound correctly. Also using devm_ where
possible to simplify things.

Signed-off-by: David Lechner <david@lechnology.com>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
This commit is contained in:
David Lechner 2016-04-05 12:31:49 -05:00 committed by Ulf Hansson
parent 2edeb8540b
commit 62ac52b2fb
1 changed files with 40 additions and 60 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

100
drivers/mmc/host/davinci_mmc.c
View file

@ -1205,7 +1205,7 @@ static int __init davinci_mmcsd_probe(struct platform_device *pdev)
struct mmc_davinci_host *host = NULL; struct mmc_davinci_host *host = NULL;
struct mmc_host *mmc = NULL; struct mmc_host *mmc = NULL;
struct resource *r, *mem = NULL; struct resource *r, *mem = NULL;
int ret = 0, irq = 0; int ret, irq;
size_t mem_size; size_t mem_size;
const struct platform_device_id *id_entry; const struct platform_device_id *id_entry;
@ -1215,38 +1215,40 @@ static int __init davinci_mmcsd_probe(struct platform_device *pdev)
return -ENOENT; return -ENOENT;
} }
ret = -ENODEV;
r = platform_get_resource(pdev, IORESOURCE_MEM, 0); r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
irq = platform_get_irq(pdev, 0); irq = platform_get_irq(pdev, 0);
if (!r || irq == NO_IRQ) if (!r || irq == NO_IRQ)
goto out; return -ENODEV;
ret = -EBUSY;
mem_size = resource_size(r); mem_size = resource_size(r);
mem = request_mem_region(r->start, mem_size, pdev->name); mem = devm_request_mem_region(&pdev->dev, r->start, mem_size,
pdev->name);
if (!mem) if (!mem)
goto out; return -EBUSY;
ret = -ENOMEM;
mmc = mmc_alloc_host(sizeof(struct mmc_davinci_host), &pdev->dev); mmc = mmc_alloc_host(sizeof(struct mmc_davinci_host), &pdev->dev);
if (!mmc) if (!mmc)
goto out; return -ENOMEM;
host = mmc_priv(mmc); host = mmc_priv(mmc);
host->mmc = mmc; /* Important */ host->mmc = mmc; /* Important */
host->mem_res = mem; host->mem_res = mem;
host->base = ioremap(mem->start, mem_size); host->base = devm_ioremap(&pdev->dev, mem->start, mem_size);
if (!host->base) if (!host->base) {
goto out; ret = -ENOMEM;
goto ioremap_fail;
}
ret = -ENXIO; host->clk = devm_clk_get(&pdev->dev, NULL);
host->clk = clk_get(&pdev->dev, NULL);
if (IS_ERR(host->clk)) { if (IS_ERR(host->clk)) {
ret = PTR_ERR(host->clk); ret = PTR_ERR(host->clk);
goto out; goto clk_get_fail;
} }
clk_enable(host->clk); ret = clk_enable(host->clk);
if (ret)
goto clk_enable_fail;
host->mmc_input_clk = clk_get_rate(host->clk); host->mmc_input_clk = clk_get_rate(host->clk);
init_mmcsd_host(host); init_mmcsd_host(host);
@ -1264,7 +1266,7 @@ static int __init davinci_mmcsd_probe(struct platform_device *pdev)
if (host->use_dma) { if (host->use_dma) {
ret = davinci_acquire_dma_channels(host); ret = davinci_acquire_dma_channels(host);
if (ret == -EPROBE_DEFER) if (ret == -EPROBE_DEFER)
goto out; goto dma_probe_defer;
else if (ret) else if (ret)
host->use_dma = 0; host->use_dma = 0;
} }
@ -1321,15 +1323,17 @@ static int __init davinci_mmcsd_probe(struct platform_device *pdev)
ret = mmc_add_host(mmc); ret = mmc_add_host(mmc);
if (ret < 0) if (ret < 0)
goto out; goto mmc_add_host_fail;
ret = request_irq(irq, mmc_davinci_irq, 0, mmc_hostname(mmc), host); ret = devm_request_irq(&pdev->dev, irq, mmc_davinci_irq, 0,
mmc_hostname(mmc), host);
if (ret) if (ret)
goto out; goto request_irq_fail;
if (host->sdio_irq >= 0) { if (host->sdio_irq >= 0) {
ret = request_irq(host->sdio_irq, mmc_davinci_sdio_irq, 0, ret = devm_request_irq(&pdev->dev, host->sdio_irq,
mmc_hostname(mmc), host); mmc_davinci_sdio_irq, 0,
mmc_hostname(mmc), host);
if (!ret) if (!ret)
mmc->caps |= MMC_CAP_SDIO_IRQ; mmc->caps |= MMC_CAP_SDIO_IRQ;
} }
@ -1342,28 +1346,18 @@ static int __init davinci_mmcsd_probe(struct platform_device *pdev)
return 0; return 0;
out: request_irq_fail:
mmc_remove_host(mmc);
mmc_add_host_fail:
mmc_davinci_cpufreq_deregister(host); mmc_davinci_cpufreq_deregister(host);
cpu_freq_fail: cpu_freq_fail:
if (host) { davinci_release_dma_channels(host);
davinci_release_dma_channels(host); dma_probe_defer:
clk_disable(host->clk);
if (host->clk) { clk_enable_fail:
clk_disable(host->clk); clk_get_fail:
clk_put(host->clk); ioremap_fail:
} mmc_free_host(mmc);
if (host->base)
iounmap(host->base);
}
if (mmc)
mmc_free_host(mmc);
if (mem)
release_resource(mem);
dev_dbg(&pdev->dev, "probe err %d\n", ret);
return ret; return ret;
} }
@ -1372,25 +1366,11 @@ static int __exit davinci_mmcsd_remove(struct platform_device *pdev)
{ {
struct mmc_davinci_host *host = platform_get_drvdata(pdev); struct mmc_davinci_host *host = platform_get_drvdata(pdev);
if (host) { mmc_remove_host(host->mmc);
mmc_davinci_cpufreq_deregister(host); mmc_davinci_cpufreq_deregister(host);
davinci_release_dma_channels(host);
mmc_remove_host(host->mmc); clk_disable(host->clk);
free_irq(host->mmc_irq, host); mmc_free_host(host->mmc);
if (host->mmc->caps & MMC_CAP_SDIO_IRQ)
free_irq(host->sdio_irq, host);
davinci_release_dma_channels(host);
clk_disable(host->clk);
clk_put(host->clk);
iounmap(host->base);
release_resource(host->mem_res);
mmc_free_host(host->mmc);
}
return 0; return 0;
} }