Commit 4fe86cdf authored by Andrey Smirnov's avatar Andrey Smirnov Committed by Jonathan Cameron

iio: imx7d_adc: Simplify imx7d_adc_probe() with imx7d_adc_resume()

Initialization sequence performed in imx7d_adc_resume() is exactly the
same as the one being done in imx7d_adc_probe(). Make use of the
former in the latter to avoid code duplication. Rename
imx7d_adc_resume() to imx7d_adc_enable() for clarity while at it.
Signed-off-by: default avatarAndrey Smirnov <andrew.smirnov@gmail.com>
Cc: Jonathan Cameron <jic23@kernel.org>
Cc: Hartmut Knaack <knaack.h@gmx.de>
Cc: Lars-Peter Clausen <lars@metafoo.de>
Cc: Peter Meerwald-Stadler <pmeerw@pmeerw.net>
Cc: Chris Healy <cphealy@gmail.com>
Cc: linux-iio@vger.kernel.org
Cc: linux-kernel@vger.kernel.org
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 49deef1b
...@@ -434,6 +434,33 @@ static void imx7d_adc_power_down(struct imx7d_adc *info) ...@@ -434,6 +434,33 @@ static void imx7d_adc_power_down(struct imx7d_adc *info)
writel(adc_cfg, info->regs + IMX7D_REG_ADC_ADC_CFG); writel(adc_cfg, info->regs + IMX7D_REG_ADC_ADC_CFG);
} }
static int imx7d_adc_enable(struct device *dev)
{
struct iio_dev *indio_dev = dev_get_drvdata(dev);
struct imx7d_adc *info = iio_priv(indio_dev);
int ret;
ret = regulator_enable(info->vref);
if (ret) {
dev_err(info->dev,
"Can't enable adc reference top voltage, err = %d\n",
ret);
return ret;
}
ret = clk_prepare_enable(info->clk);
if (ret) {
dev_err(info->dev,
"Could not prepare or enable clock.\n");
regulator_disable(info->vref);
return ret;
}
imx7d_adc_hw_init(info);
return 0;
}
static int imx7d_adc_probe(struct platform_device *pdev) static int imx7d_adc_probe(struct platform_device *pdev)
{ {
struct imx7d_adc *info; struct imx7d_adc *info;
...@@ -479,14 +506,6 @@ static int imx7d_adc_probe(struct platform_device *pdev) ...@@ -479,14 +506,6 @@ static int imx7d_adc_probe(struct platform_device *pdev)
return ret; return ret;
} }
ret = regulator_enable(info->vref);
if (ret) {
dev_err(dev,
"Can't enable adc reference top voltage, err = %d\n",
ret);
return ret;
}
platform_set_drvdata(pdev, indio_dev); platform_set_drvdata(pdev, indio_dev);
init_completion(&info->completion); init_completion(&info->completion);
...@@ -498,38 +517,30 @@ static int imx7d_adc_probe(struct platform_device *pdev) ...@@ -498,38 +517,30 @@ static int imx7d_adc_probe(struct platform_device *pdev)
indio_dev->channels = imx7d_adc_iio_channels; indio_dev->channels = imx7d_adc_iio_channels;
indio_dev->num_channels = ARRAY_SIZE(imx7d_adc_iio_channels); indio_dev->num_channels = ARRAY_SIZE(imx7d_adc_iio_channels);
ret = clk_prepare_enable(info->clk);
if (ret) {
dev_err(dev, "Could not prepare or enable the clock.\n");
goto error_adc_clk_enable;
}
ret = devm_request_irq(dev, irq, ret = devm_request_irq(dev, irq,
imx7d_adc_isr, 0, imx7d_adc_isr, 0,
dev_name(dev), info); dev_name(dev), info);
if (ret < 0) { if (ret < 0) {
dev_err(dev, "Failed requesting irq, irq = %d\n", irq); dev_err(dev, "Failed requesting irq, irq = %d\n", irq);
goto error_iio_device_register; return ret;
} }
imx7d_adc_feature_config(info); imx7d_adc_feature_config(info);
imx7d_adc_hw_init(info);
ret = imx7d_adc_enable(&indio_dev->dev);
if (ret)
return ret;
ret = iio_device_register(indio_dev); ret = iio_device_register(indio_dev);
if (ret) { if (ret) {
imx7d_adc_power_down(info); imx7d_adc_power_down(info);
clk_disable_unprepare(info->clk);
regulator_disable(info->vref);
dev_err(&pdev->dev, "Couldn't register the device.\n"); dev_err(&pdev->dev, "Couldn't register the device.\n");
goto error_iio_device_register; return ret;
} }
return 0; return 0;
error_iio_device_register:
clk_disable_unprepare(info->clk);
error_adc_clk_enable:
regulator_disable(info->vref);
return ret;
} }
static int imx7d_adc_remove(struct platform_device *pdev) static int imx7d_adc_remove(struct platform_device *pdev)
...@@ -560,34 +571,7 @@ static int __maybe_unused imx7d_adc_suspend(struct device *dev) ...@@ -560,34 +571,7 @@ static int __maybe_unused imx7d_adc_suspend(struct device *dev)
return 0; return 0;
} }
static int __maybe_unused imx7d_adc_resume(struct device *dev) static SIMPLE_DEV_PM_OPS(imx7d_adc_pm_ops, imx7d_adc_suspend, imx7d_adc_enable);
{
struct iio_dev *indio_dev = dev_get_drvdata(dev);
struct imx7d_adc *info = iio_priv(indio_dev);
int ret;
ret = regulator_enable(info->vref);
if (ret) {
dev_err(info->dev,
"Can't enable adc reference top voltage, err = %d\n",
ret);
return ret;
}
ret = clk_prepare_enable(info->clk);
if (ret) {
dev_err(info->dev,
"Could not prepare or enable clock.\n");
regulator_disable(info->vref);
return ret;
}
imx7d_adc_hw_init(info);
return 0;
}
static SIMPLE_DEV_PM_OPS(imx7d_adc_pm_ops, imx7d_adc_suspend, imx7d_adc_resume);
static struct platform_driver imx7d_adc_driver = { static struct platform_driver imx7d_adc_driver = {
.probe = imx7d_adc_probe, .probe = imx7d_adc_probe,
......
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