Commit 6d52b0e7 authored by Jonathan Cameron's avatar Jonathan Cameron Committed by Jonathan Cameron

iio: adc: palmas: Take probe fully device managed.

Review of a recent fix highlighted that this driver could be trivially
converted to be entirely devm managed.

That fix should be applied to resolve the fix in a fashion easy to back port
even though this change removes the relevant code.

[1] https://patchwork.kernel.org/project/linux-iio/patch/20230313205029.1881745-1-risca@dalakolonin.se/Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
Tested-by: default avatarPatrik Dahlström <risca@dalakolonin.se>
Reviewed-by: default avatarPatrik Dahlström <risca@dalakolonin.se>
Link: https://lore.kernel.org/r/20230318163039.56115-1-jic23@kernel.org
parent dc3d25f2
...@@ -493,6 +493,11 @@ static int palmas_gpadc_get_adc_dt_data(struct platform_device *pdev, ...@@ -493,6 +493,11 @@ static int palmas_gpadc_get_adc_dt_data(struct platform_device *pdev,
return 0; return 0;
} }
static void palmas_disable_wakeup(void *dev)
{
device_wakeup_disable(dev);
}
static int palmas_gpadc_probe(struct platform_device *pdev) static int palmas_gpadc_probe(struct platform_device *pdev)
{ {
struct palmas_gpadc *adc; struct palmas_gpadc *adc;
...@@ -532,36 +537,30 @@ static int palmas_gpadc_probe(struct platform_device *pdev) ...@@ -532,36 +537,30 @@ static int palmas_gpadc_probe(struct platform_device *pdev)
adc->auto_conversion_period = gpadc_pdata->auto_conversion_period_ms; adc->auto_conversion_period = gpadc_pdata->auto_conversion_period_ms;
adc->irq = palmas_irq_get_virq(adc->palmas, PALMAS_GPADC_EOC_SW_IRQ); adc->irq = palmas_irq_get_virq(adc->palmas, PALMAS_GPADC_EOC_SW_IRQ);
if (adc->irq < 0) { if (adc->irq < 0)
dev_err(adc->dev, return dev_err_probe(adc->dev, adc->irq, "get virq failed\n");
"get virq failed: %d\n", adc->irq);
ret = adc->irq; ret = devm_request_threaded_irq(&pdev->dev, adc->irq, NULL,
goto out; palmas_gpadc_irq,
} IRQF_ONESHOT, dev_name(adc->dev),
ret = request_threaded_irq(adc->irq, NULL, adc);
palmas_gpadc_irq, if (ret < 0)
IRQF_ONESHOT, dev_name(adc->dev), return dev_err_probe(adc->dev, ret,
adc); "request irq %d failed\n", adc->irq);
if (ret < 0) {
dev_err(adc->dev,
"request irq %d failed: %d\n", adc->irq, ret);
goto out;
}
if (gpadc_pdata->adc_wakeup1_data) { if (gpadc_pdata->adc_wakeup1_data) {
memcpy(&adc->wakeup1_data, gpadc_pdata->adc_wakeup1_data, memcpy(&adc->wakeup1_data, gpadc_pdata->adc_wakeup1_data,
sizeof(adc->wakeup1_data)); sizeof(adc->wakeup1_data));
adc->wakeup1_enable = true; adc->wakeup1_enable = true;
adc->irq_auto_0 = platform_get_irq(pdev, 1); adc->irq_auto_0 = platform_get_irq(pdev, 1);
ret = request_threaded_irq(adc->irq_auto_0, NULL, ret = devm_request_threaded_irq(&pdev->dev, adc->irq_auto_0,
palmas_gpadc_irq_auto, NULL, palmas_gpadc_irq_auto,
IRQF_ONESHOT, IRQF_ONESHOT,
"palmas-adc-auto-0", adc); "palmas-adc-auto-0", adc);
if (ret < 0) { if (ret < 0)
dev_err(adc->dev, "request auto0 irq %d failed: %d\n", return dev_err_probe(adc->dev, ret,
adc->irq_auto_0, ret); "request auto0 irq %d failed\n",
goto out_irq_free; adc->irq_auto_0);
}
} }
if (gpadc_pdata->adc_wakeup2_data) { if (gpadc_pdata->adc_wakeup2_data) {
...@@ -569,15 +568,14 @@ static int palmas_gpadc_probe(struct platform_device *pdev) ...@@ -569,15 +568,14 @@ static int palmas_gpadc_probe(struct platform_device *pdev)
sizeof(adc->wakeup2_data)); sizeof(adc->wakeup2_data));
adc->wakeup2_enable = true; adc->wakeup2_enable = true;
adc->irq_auto_1 = platform_get_irq(pdev, 2); adc->irq_auto_1 = platform_get_irq(pdev, 2);
ret = request_threaded_irq(adc->irq_auto_1, NULL, ret = devm_request_threaded_irq(&pdev->dev, adc->irq_auto_1,
palmas_gpadc_irq_auto, NULL, palmas_gpadc_irq_auto,
IRQF_ONESHOT, IRQF_ONESHOT,
"palmas-adc-auto-1", adc); "palmas-adc-auto-1", adc);
if (ret < 0) { if (ret < 0)
dev_err(adc->dev, "request auto1 irq %d failed: %d\n", return dev_err_probe(adc->dev, ret,
adc->irq_auto_1, ret); "request auto1 irq %d failed\n",
goto out_irq_auto0_free; adc->irq_auto_1);
}
} }
/* set the current source 0 (value 0/5/15/20 uA => 0..3) */ /* set the current source 0 (value 0/5/15/20 uA => 0..3) */
...@@ -608,11 +606,10 @@ static int palmas_gpadc_probe(struct platform_device *pdev) ...@@ -608,11 +606,10 @@ static int palmas_gpadc_probe(struct platform_device *pdev)
indio_dev->channels = palmas_gpadc_iio_channel; indio_dev->channels = palmas_gpadc_iio_channel;
indio_dev->num_channels = ARRAY_SIZE(palmas_gpadc_iio_channel); indio_dev->num_channels = ARRAY_SIZE(palmas_gpadc_iio_channel);
ret = iio_device_register(indio_dev); ret = devm_iio_device_register(&pdev->dev, indio_dev);
if (ret < 0) { if (ret < 0)
dev_err(adc->dev, "iio_device_register() failed: %d\n", ret); return dev_err_probe(adc->dev, ret,
goto out_irq_auto1_free; "iio_device_register() failed\n");
}
device_set_wakeup_capable(&pdev->dev, 1); device_set_wakeup_capable(&pdev->dev, 1);
for (i = 0; i < PALMAS_ADC_CH_MAX; i++) { for (i = 0; i < PALMAS_ADC_CH_MAX; i++) {
...@@ -620,36 +617,14 @@ static int palmas_gpadc_probe(struct platform_device *pdev) ...@@ -620,36 +617,14 @@ static int palmas_gpadc_probe(struct platform_device *pdev)
palmas_gpadc_calibrate(adc, i); palmas_gpadc_calibrate(adc, i);
} }
if (adc->wakeup1_enable || adc->wakeup2_enable) if (adc->wakeup1_enable || adc->wakeup2_enable) {
device_wakeup_enable(&pdev->dev); device_wakeup_enable(&pdev->dev);
ret = devm_add_action_or_reset(&pdev->dev,
return 0; palmas_disable_wakeup,
&pdev->dev);
out_irq_auto1_free: if (ret)
if (gpadc_pdata->adc_wakeup2_data) return ret;
free_irq(adc->irq_auto_1, adc); }
out_irq_auto0_free:
if (gpadc_pdata->adc_wakeup1_data)
free_irq(adc->irq_auto_0, adc);
out_irq_free:
free_irq(adc->irq, adc);
out:
return ret;
}
static int palmas_gpadc_remove(struct platform_device *pdev)
{
struct iio_dev *indio_dev = dev_get_drvdata(&pdev->dev);
struct palmas_gpadc *adc = iio_priv(indio_dev);
if (adc->wakeup1_enable || adc->wakeup2_enable)
device_wakeup_disable(&pdev->dev);
iio_device_unregister(indio_dev);
free_irq(adc->irq, adc);
if (adc->wakeup1_enable)
free_irq(adc->irq_auto_0, adc);
if (adc->wakeup2_enable)
free_irq(adc->irq_auto_1, adc);
return 0; return 0;
} }
...@@ -834,7 +809,6 @@ MODULE_DEVICE_TABLE(of, of_palmas_gpadc_match_tbl); ...@@ -834,7 +809,6 @@ MODULE_DEVICE_TABLE(of, of_palmas_gpadc_match_tbl);
static struct platform_driver palmas_gpadc_driver = { static struct platform_driver palmas_gpadc_driver = {
.probe = palmas_gpadc_probe, .probe = palmas_gpadc_probe,
.remove = palmas_gpadc_remove,
.driver = { .driver = {
.name = MOD_NAME, .name = MOD_NAME,
.pm = pm_sleep_ptr(&palmas_pm_ops), .pm = pm_sleep_ptr(&palmas_pm_ops),
......
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