mirror of https://github.com/torvalds/linux.git
spi: spi-nxp-fspi: remove the goto in probe
Remove all the goto in probe to simplify the driver. Signed-off-by: Haibo Chen <haibo.chen@nxp.com> Link: https://patch.msgid.link/20250428-flexspipatch-v3-1-61d5e8f591bc@nxp.com Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
92a09c4746
commit
48900813ab
|
|
@ -1161,10 +1161,10 @@ static int nxp_fspi_probe(struct platform_device *pdev)
|
||||||
struct device_node *np = dev->of_node;
|
struct device_node *np = dev->of_node;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
struct nxp_fspi *f;
|
struct nxp_fspi *f;
|
||||||
int ret;
|
int ret, irq;
|
||||||
u32 reg;
|
u32 reg;
|
||||||
|
|
||||||
ctlr = spi_alloc_host(&pdev->dev, sizeof(*f));
|
ctlr = devm_spi_alloc_host(&pdev->dev, sizeof(*f));
|
||||||
if (!ctlr)
|
if (!ctlr)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
|
|
@ -1174,10 +1174,8 @@ static int nxp_fspi_probe(struct platform_device *pdev)
|
||||||
f = spi_controller_get_devdata(ctlr);
|
f = spi_controller_get_devdata(ctlr);
|
||||||
f->dev = dev;
|
f->dev = dev;
|
||||||
f->devtype_data = (struct nxp_fspi_devtype_data *)device_get_match_data(dev);
|
f->devtype_data = (struct nxp_fspi_devtype_data *)device_get_match_data(dev);
|
||||||
if (!f->devtype_data) {
|
if (!f->devtype_data)
|
||||||
ret = -ENODEV;
|
return -ENODEV;
|
||||||
goto err_put_ctrl;
|
|
||||||
}
|
|
||||||
|
|
||||||
platform_set_drvdata(pdev, f);
|
platform_set_drvdata(pdev, f);
|
||||||
|
|
||||||
|
|
@ -1186,11 +1184,8 @@ static int nxp_fspi_probe(struct platform_device *pdev)
|
||||||
f->iobase = devm_platform_ioremap_resource(pdev, 0);
|
f->iobase = devm_platform_ioremap_resource(pdev, 0);
|
||||||
else
|
else
|
||||||
f->iobase = devm_platform_ioremap_resource_byname(pdev, "fspi_base");
|
f->iobase = devm_platform_ioremap_resource_byname(pdev, "fspi_base");
|
||||||
|
if (IS_ERR(f->iobase))
|
||||||
if (IS_ERR(f->iobase)) {
|
return PTR_ERR(f->iobase);
|
||||||
ret = PTR_ERR(f->iobase);
|
|
||||||
goto err_put_ctrl;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* find the resources - controller memory mapped space */
|
/* find the resources - controller memory mapped space */
|
||||||
if (is_acpi_node(dev_fwnode(f->dev)))
|
if (is_acpi_node(dev_fwnode(f->dev)))
|
||||||
|
|
@ -1198,11 +1193,8 @@ static int nxp_fspi_probe(struct platform_device *pdev)
|
||||||
else
|
else
|
||||||
res = platform_get_resource_byname(pdev,
|
res = platform_get_resource_byname(pdev,
|
||||||
IORESOURCE_MEM, "fspi_mmap");
|
IORESOURCE_MEM, "fspi_mmap");
|
||||||
|
if (!res)
|
||||||
if (!res) {
|
return -ENODEV;
|
||||||
ret = -ENODEV;
|
|
||||||
goto err_put_ctrl;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* assign memory mapped starting address and mapped size. */
|
/* assign memory mapped starting address and mapped size. */
|
||||||
f->memmap_phy = res->start;
|
f->memmap_phy = res->start;
|
||||||
|
|
@ -1211,69 +1203,46 @@ static int nxp_fspi_probe(struct platform_device *pdev)
|
||||||
/* find the clocks */
|
/* find the clocks */
|
||||||
if (dev_of_node(&pdev->dev)) {
|
if (dev_of_node(&pdev->dev)) {
|
||||||
f->clk_en = devm_clk_get(dev, "fspi_en");
|
f->clk_en = devm_clk_get(dev, "fspi_en");
|
||||||
if (IS_ERR(f->clk_en)) {
|
if (IS_ERR(f->clk_en))
|
||||||
ret = PTR_ERR(f->clk_en);
|
return PTR_ERR(f->clk_en);
|
||||||
goto err_put_ctrl;
|
|
||||||
}
|
|
||||||
|
|
||||||
f->clk = devm_clk_get(dev, "fspi");
|
f->clk = devm_clk_get(dev, "fspi");
|
||||||
if (IS_ERR(f->clk)) {
|
if (IS_ERR(f->clk))
|
||||||
ret = PTR_ERR(f->clk);
|
return PTR_ERR(f->clk);
|
||||||
goto err_put_ctrl;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = nxp_fspi_clk_prep_enable(f);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(dev, "can not enable the clock\n");
|
|
||||||
goto err_put_ctrl;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* find the irq */
|
||||||
|
irq = platform_get_irq(pdev, 0);
|
||||||
|
if (irq < 0)
|
||||||
|
return dev_err_probe(dev, irq, "Failed to get irq source");
|
||||||
|
|
||||||
|
ret = nxp_fspi_clk_prep_enable(f);
|
||||||
|
if (ret)
|
||||||
|
return dev_err_probe(dev, ret, "Can't enable the clock\n");
|
||||||
|
|
||||||
/* Clear potential interrupts */
|
/* Clear potential interrupts */
|
||||||
reg = fspi_readl(f, f->iobase + FSPI_INTR);
|
reg = fspi_readl(f, f->iobase + FSPI_INTR);
|
||||||
if (reg)
|
if (reg)
|
||||||
fspi_writel(f, reg, f->iobase + FSPI_INTR);
|
fspi_writel(f, reg, f->iobase + FSPI_INTR);
|
||||||
|
|
||||||
/* find the irq */
|
nxp_fspi_default_setup(f);
|
||||||
ret = platform_get_irq(pdev, 0);
|
|
||||||
if (ret < 0)
|
|
||||||
goto err_disable_clk;
|
|
||||||
|
|
||||||
ret = devm_request_irq(dev, ret,
|
ret = devm_request_irq(dev, irq,
|
||||||
nxp_fspi_irq_handler, 0, pdev->name, f);
|
nxp_fspi_irq_handler, 0, pdev->name, f);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_err(dev, "failed to request irq: %d\n", ret);
|
nxp_fspi_clk_disable_unprep(f);
|
||||||
goto err_disable_clk;
|
return dev_err_probe(dev, ret, "Failed to request irq\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
mutex_init(&f->lock);
|
devm_mutex_init(dev, &f->lock);
|
||||||
|
|
||||||
ctlr->bus_num = -1;
|
ctlr->bus_num = -1;
|
||||||
ctlr->num_chipselect = NXP_FSPI_MAX_CHIPSELECT;
|
ctlr->num_chipselect = NXP_FSPI_MAX_CHIPSELECT;
|
||||||
ctlr->mem_ops = &nxp_fspi_mem_ops;
|
ctlr->mem_ops = &nxp_fspi_mem_ops;
|
||||||
ctlr->mem_caps = &nxp_fspi_mem_caps;
|
ctlr->mem_caps = &nxp_fspi_mem_caps;
|
||||||
|
|
||||||
nxp_fspi_default_setup(f);
|
|
||||||
|
|
||||||
ctlr->dev.of_node = np;
|
ctlr->dev.of_node = np;
|
||||||
|
|
||||||
ret = devm_spi_register_controller(&pdev->dev, ctlr);
|
return devm_spi_register_controller(&pdev->dev, ctlr);
|
||||||
if (ret)
|
|
||||||
goto err_destroy_mutex;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
err_destroy_mutex:
|
|
||||||
mutex_destroy(&f->lock);
|
|
||||||
|
|
||||||
err_disable_clk:
|
|
||||||
nxp_fspi_clk_disable_unprep(f);
|
|
||||||
|
|
||||||
err_put_ctrl:
|
|
||||||
spi_controller_put(ctlr);
|
|
||||||
|
|
||||||
dev_err(dev, "NXP FSPI probe failed\n");
|
|
||||||
return ret;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void nxp_fspi_remove(struct platform_device *pdev)
|
static void nxp_fspi_remove(struct platform_device *pdev)
|
||||||
|
|
@ -1285,8 +1254,6 @@ static void nxp_fspi_remove(struct platform_device *pdev)
|
||||||
|
|
||||||
nxp_fspi_clk_disable_unprep(f);
|
nxp_fspi_clk_disable_unprep(f);
|
||||||
|
|
||||||
mutex_destroy(&f->lock);
|
|
||||||
|
|
||||||
if (f->ahb_addr)
|
if (f->ahb_addr)
|
||||||
iounmap(f->ahb_addr);
|
iounmap(f->ahb_addr);
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue