Skip to content

Commit

Permalink
staging: iio: ad9832: convert probe to device-managed
Browse files Browse the repository at this point in the history
This change does a conversion of the driver to use device-managed init
functions. The 2 regulators and the clock inits are converted to use
devm_add_action_or_reset() callbacks for de-initializing them when the
driver unloads.

And finally the devm_iio_device_register() function can be use to register
the device.

The remove hook can finally be removed and the spi_set_drvdata() call can
also be removed as the private data is no longer used.

Signed-off-by: Alexandru Ardelean <[email protected]>
Link: https://lore.kernel.org/r/[email protected]
Signed-off-by: Jonathan Cameron <[email protected]>
  • Loading branch information
commodo authored and jic23 committed Oct 17, 2021
1 parent 8a16c76 commit 9678844
Showing 1 changed file with 36 additions and 46 deletions.
82 changes: 36 additions & 46 deletions drivers/staging/iio/frequency/ad9832.c
Original file line number Diff line number Diff line change
Expand Up @@ -294,6 +294,16 @@ static const struct iio_info ad9832_info = {
.attrs = &ad9832_attribute_group,
};

static void ad9832_reg_disable(void *reg)
{
regulator_disable(reg);
}

static void ad9832_clk_disable(void *clk)
{
clk_disable_unprepare(clk);
}

static int ad9832_probe(struct spi_device *spi)
{
struct ad9832_platform_data *pdata = dev_get_platdata(&spi->dev);
Expand All @@ -310,7 +320,6 @@ static int ad9832_probe(struct spi_device *spi)
if (!indio_dev)
return -ENOMEM;

spi_set_drvdata(spi, indio_dev);
st = iio_priv(indio_dev);

st->avdd = devm_regulator_get(&spi->dev, "avdd");
Expand All @@ -323,27 +332,35 @@ static int ad9832_probe(struct spi_device *spi)
return ret;
}

ret = devm_add_action_or_reset(&spi->dev, ad9832_reg_disable, st->avdd);
if (ret)
return ret;

st->dvdd = devm_regulator_get(&spi->dev, "dvdd");
if (IS_ERR(st->dvdd)) {
ret = PTR_ERR(st->dvdd);
goto error_disable_avdd;
}
if (IS_ERR(st->dvdd))
return PTR_ERR(st->dvdd);

ret = regulator_enable(st->dvdd);
if (ret) {
dev_err(&spi->dev, "Failed to enable specified DVDD supply\n");
goto error_disable_avdd;
return ret;
}

ret = devm_add_action_or_reset(&spi->dev, ad9832_reg_disable, st->dvdd);
if (ret)
return ret;

st->mclk = devm_clk_get(&spi->dev, "mclk");
if (IS_ERR(st->mclk)) {
ret = PTR_ERR(st->mclk);
goto error_disable_dvdd;
}
if (IS_ERR(st->mclk))
return PTR_ERR(st->mclk);

ret = clk_prepare_enable(st->mclk);
if (ret < 0)
goto error_disable_dvdd;
return ret;

ret = devm_add_action_or_reset(&spi->dev, ad9832_clk_disable, st->mclk);
if (ret)
return ret;

st->spi = spi;
mutex_init(&st->lock);
Expand Down Expand Up @@ -394,60 +411,34 @@ static int ad9832_probe(struct spi_device *spi)
ret = spi_sync(st->spi, &st->msg);
if (ret) {
dev_err(&spi->dev, "device init failed\n");
goto error_unprepare_mclk;
return ret;
}

ret = ad9832_write_frequency(st, AD9832_FREQ0HM, pdata->freq0);
if (ret)
goto error_unprepare_mclk;
return ret;

ret = ad9832_write_frequency(st, AD9832_FREQ1HM, pdata->freq1);
if (ret)
goto error_unprepare_mclk;
return ret;

ret = ad9832_write_phase(st, AD9832_PHASE0H, pdata->phase0);
if (ret)
goto error_unprepare_mclk;
return ret;

ret = ad9832_write_phase(st, AD9832_PHASE1H, pdata->phase1);
if (ret)
goto error_unprepare_mclk;
return ret;

ret = ad9832_write_phase(st, AD9832_PHASE2H, pdata->phase2);
if (ret)
goto error_unprepare_mclk;
return ret;

ret = ad9832_write_phase(st, AD9832_PHASE3H, pdata->phase3);
if (ret)
goto error_unprepare_mclk;

ret = iio_device_register(indio_dev);
if (ret)
goto error_unprepare_mclk;

return 0;

error_unprepare_mclk:
clk_disable_unprepare(st->mclk);
error_disable_dvdd:
regulator_disable(st->dvdd);
error_disable_avdd:
regulator_disable(st->avdd);

return ret;
}

static int ad9832_remove(struct spi_device *spi)
{
struct iio_dev *indio_dev = spi_get_drvdata(spi);
struct ad9832_state *st = iio_priv(indio_dev);

iio_device_unregister(indio_dev);
clk_disable_unprepare(st->mclk);
regulator_disable(st->dvdd);
regulator_disable(st->avdd);
return ret;

return 0;
return devm_iio_device_register(&spi->dev, indio_dev);
}

static const struct spi_device_id ad9832_id[] = {
Expand All @@ -462,7 +453,6 @@ static struct spi_driver ad9832_driver = {
.name = "ad9832",
},
.probe = ad9832_probe,
.remove = ad9832_remove,
.id_table = ad9832_id,
};
module_spi_driver(ad9832_driver);
Expand Down

0 comments on commit 9678844

Please sign in to comment.