Commit 4a08d6c8 authored by Lionel Debieve's avatar Lionel Debieve Committed by Mark Brown

spi: stm32-qspi: properly manage probe errors

Fix resource release issues when driver probe operation fails.
Signed-off-by: default avatarLionel Debieve <lionel.debieve@st.com>
Signed-off-by: default avatarEtienne Carriere <etienne.carriere@st.com>
Signed-off-by: default avatarPatrice Chotard <patrice.chotard@st.com>
Link: https://lore.kernel.org/r/20200203135048.1299-3-patrice.chotard@st.comSigned-off-by: default avatarMark Brown <broonie@kernel.org>
parent 875014cb
...@@ -565,7 +565,7 @@ static int stm32_qspi_probe(struct platform_device *pdev) ...@@ -565,7 +565,7 @@ static int stm32_qspi_probe(struct platform_device *pdev)
qspi->io_base = devm_ioremap_resource(dev, res); qspi->io_base = devm_ioremap_resource(dev, res);
if (IS_ERR(qspi->io_base)) { if (IS_ERR(qspi->io_base)) {
ret = PTR_ERR(qspi->io_base); ret = PTR_ERR(qspi->io_base);
goto err; goto err_master_put;
} }
qspi->phys_base = res->start; qspi->phys_base = res->start;
...@@ -574,24 +574,26 @@ static int stm32_qspi_probe(struct platform_device *pdev) ...@@ -574,24 +574,26 @@ static int stm32_qspi_probe(struct platform_device *pdev)
qspi->mm_base = devm_ioremap_resource(dev, res); qspi->mm_base = devm_ioremap_resource(dev, res);
if (IS_ERR(qspi->mm_base)) { if (IS_ERR(qspi->mm_base)) {
ret = PTR_ERR(qspi->mm_base); ret = PTR_ERR(qspi->mm_base);
goto err; goto err_master_put;
} }
qspi->mm_size = resource_size(res); qspi->mm_size = resource_size(res);
if (qspi->mm_size > STM32_QSPI_MAX_MMAP_SZ) { if (qspi->mm_size > STM32_QSPI_MAX_MMAP_SZ) {
ret = -EINVAL; ret = -EINVAL;
goto err; goto err_master_put;
} }
irq = platform_get_irq(pdev, 0); irq = platform_get_irq(pdev, 0);
if (irq < 0) if (irq < 0) {
return irq; ret = irq;
goto err_master_put;
}
ret = devm_request_irq(dev, irq, stm32_qspi_irq, 0, ret = devm_request_irq(dev, irq, stm32_qspi_irq, 0,
dev_name(dev), qspi); dev_name(dev), qspi);
if (ret) { if (ret) {
dev_err(dev, "failed to request irq\n"); dev_err(dev, "failed to request irq\n");
goto err; goto err_master_put;
} }
init_completion(&qspi->data_completion); init_completion(&qspi->data_completion);
...@@ -599,26 +601,26 @@ static int stm32_qspi_probe(struct platform_device *pdev) ...@@ -599,26 +601,26 @@ static int stm32_qspi_probe(struct platform_device *pdev)
qspi->clk = devm_clk_get(dev, NULL); qspi->clk = devm_clk_get(dev, NULL);
if (IS_ERR(qspi->clk)) { if (IS_ERR(qspi->clk)) {
ret = PTR_ERR(qspi->clk); ret = PTR_ERR(qspi->clk);
goto err; goto err_master_put;
} }
qspi->clk_rate = clk_get_rate(qspi->clk); qspi->clk_rate = clk_get_rate(qspi->clk);
if (!qspi->clk_rate) { if (!qspi->clk_rate) {
ret = -EINVAL; ret = -EINVAL;
goto err; goto err_master_put;
} }
ret = clk_prepare_enable(qspi->clk); ret = clk_prepare_enable(qspi->clk);
if (ret) { if (ret) {
dev_err(dev, "can not enable the clock\n"); dev_err(dev, "can not enable the clock\n");
goto err; goto err_master_put;
} }
rstc = devm_reset_control_get_exclusive(dev, NULL); rstc = devm_reset_control_get_exclusive(dev, NULL);
if (IS_ERR(rstc)) { if (IS_ERR(rstc)) {
ret = PTR_ERR(rstc); ret = PTR_ERR(rstc);
if (ret == -EPROBE_DEFER) if (ret == -EPROBE_DEFER)
goto err; goto err_qspi_release;
} else { } else {
reset_control_assert(rstc); reset_control_assert(rstc);
udelay(2); udelay(2);
...@@ -629,7 +631,7 @@ static int stm32_qspi_probe(struct platform_device *pdev) ...@@ -629,7 +631,7 @@ static int stm32_qspi_probe(struct platform_device *pdev)
platform_set_drvdata(pdev, qspi); platform_set_drvdata(pdev, qspi);
ret = stm32_qspi_dma_setup(qspi); ret = stm32_qspi_dma_setup(qspi);
if (ret) if (ret)
goto err; goto err_qspi_release;
mutex_init(&qspi->lock); mutex_init(&qspi->lock);
...@@ -645,8 +647,9 @@ static int stm32_qspi_probe(struct platform_device *pdev) ...@@ -645,8 +647,9 @@ static int stm32_qspi_probe(struct platform_device *pdev)
if (!ret) if (!ret)
return 0; return 0;
err: err_qspi_release:
stm32_qspi_release(qspi); stm32_qspi_release(qspi);
err_master_put:
spi_master_put(qspi->ctrl); spi_master_put(qspi->ctrl);
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