Takashi Iwai 4b10b5
From 0187294d227dfc42889e1da8f8ce1e44fc25f147 Mon Sep 17 00:00:00 2001
Takashi Iwai 4b10b5
From: Dinghao Liu <dinghao.liu@zju.edu.cn>
Takashi Iwai 4b10b5
Date: Tue, 26 May 2020 18:47:17 +0800
Takashi Iwai 4b10b5
Subject: [PATCH] iio: magnetometer: ak8974: Fix runtime PM imbalance on error
Takashi Iwai 4b10b5
Git-commit: 0187294d227dfc42889e1da8f8ce1e44fc25f147
Takashi Iwai 4b10b5
Patch-mainline: v5.8-rc6
Takashi Iwai 4b10b5
References: git-fixes
Takashi Iwai 4b10b5
Takashi Iwai 4b10b5
When devm_regmap_init_i2c() returns an error code, a pairing
Takashi Iwai 4b10b5
runtime PM usage counter decrement is needed to keep the
Takashi Iwai 4b10b5
counter balanced. For error paths after ak8974_set_power(),
Takashi Iwai 4b10b5
ak8974_detect() and ak8974_reset(), things are the same.
Takashi Iwai 4b10b5
Takashi Iwai 4b10b5
However, When iio_triggered_buffer_setup() returns an error
Takashi Iwai 4b10b5
code, there will be two PM usgae counter decrements.
Takashi Iwai 4b10b5
Takashi Iwai 4b10b5
Signed-off-by: Dinghao Liu <dinghao.liu@zju.edu.cn>
Takashi Iwai 4b10b5
Fixes: 7c94a8b2ee8c ("iio: magn: add a driver for AK8974")
Takashi Iwai 4b10b5
Reviewed-by: Linus Walleij <linus.walleij@linaro.org>
Takashi Iwai 4b10b5
Cc: <Stable@vger.kernel.org>
Takashi Iwai 4b10b5
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
Takashi Iwai 4b10b5
Acked-by: Takashi Iwai <tiwai@suse.de>
Takashi Iwai 4b10b5
Takashi Iwai 4b10b5
---
Takashi Iwai 4b10b5
 drivers/iio/magnetometer/ak8974.c |   19 ++++++++++---------
Takashi Iwai 4b10b5
 1 file changed, 10 insertions(+), 9 deletions(-)
Takashi Iwai 4b10b5
Takashi Iwai 4b10b5
--- a/drivers/iio/magnetometer/ak8974.c
Takashi Iwai 4b10b5
+++ b/drivers/iio/magnetometer/ak8974.c
Takashi Iwai 4b10b5
@@ -764,19 +764,21 @@ static int ak8974_probe(struct i2c_clien
Takashi Iwai 4b10b5
 	ak8974->map = devm_regmap_init_i2c(i2c, &ak8974_regmap_config);
Takashi Iwai 4b10b5
 	if (IS_ERR(ak8974->map)) {
Takashi Iwai 4b10b5
 		dev_err(&i2c->dev, "failed to allocate register map\n");
Takashi Iwai 4b10b5
+		pm_runtime_put_noidle(&i2c->dev);
Takashi Iwai 4b10b5
+		pm_runtime_disable(&i2c->dev);
Takashi Iwai 4b10b5
 		return PTR_ERR(ak8974->map);
Takashi Iwai 4b10b5
 	}
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
 	ret = ak8974_set_power(ak8974, AK8974_PWR_ON);
Takashi Iwai 4b10b5
 	if (ret) {
Takashi Iwai 4b10b5
 		dev_err(&i2c->dev, "could not power on\n");
Takashi Iwai 4b10b5
-		goto power_off;
Takashi Iwai 4b10b5
+		goto disable_pm;
Takashi Iwai 4b10b5
 	}
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
 	ret = ak8974_detect(ak8974);
Takashi Iwai 4b10b5
 	if (ret) {
Takashi Iwai 4b10b5
 		dev_err(&i2c->dev, "neither AK8974 nor AMI30x found\n");
Takashi Iwai 4b10b5
-		goto power_off;
Takashi Iwai 4b10b5
+		goto disable_pm;
Takashi Iwai 4b10b5
 	}
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
 	ret = ak8974_selftest(ak8974);
Takashi Iwai 4b10b5
@@ -786,14 +788,9 @@ static int ak8974_probe(struct i2c_clien
Takashi Iwai 4b10b5
 	ret = ak8974_reset(ak8974);
Takashi Iwai 4b10b5
 	if (ret) {
Takashi Iwai 4b10b5
 		dev_err(&i2c->dev, "AK8974 reset failed\n");
Takashi Iwai 4b10b5
-		goto power_off;
Takashi Iwai 4b10b5
+		goto disable_pm;
Takashi Iwai 4b10b5
 	}
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
-	pm_runtime_set_autosuspend_delay(&i2c->dev,
Takashi Iwai 4b10b5
-					 AK8974_AUTOSUSPEND_DELAY);
Takashi Iwai 4b10b5
-	pm_runtime_use_autosuspend(&i2c->dev);
Takashi Iwai 4b10b5
-	pm_runtime_put(&i2c->dev);
Takashi Iwai 4b10b5
-
Takashi Iwai 4b10b5
 	indio_dev->dev.parent = &i2c->dev;
Takashi Iwai 4b10b5
 	indio_dev->channels = ak8974_channels;
Takashi Iwai 4b10b5
 	indio_dev->num_channels = ARRAY_SIZE(ak8974_channels);
Takashi Iwai 4b10b5
@@ -846,6 +843,11 @@ no_irq:
Takashi Iwai 4b10b5
 		goto cleanup_buffer;
Takashi Iwai 4b10b5
 	}
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
+	pm_runtime_set_autosuspend_delay(&i2c->dev,
Takashi Iwai 4b10b5
+					 AK8974_AUTOSUSPEND_DELAY);
Takashi Iwai 4b10b5
+	pm_runtime_use_autosuspend(&i2c->dev);
Takashi Iwai 4b10b5
+	pm_runtime_put(&i2c->dev);
Takashi Iwai 4b10b5
+
Takashi Iwai 4b10b5
 	return 0;
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
 cleanup_buffer:
Takashi Iwai 4b10b5
@@ -854,7 +856,6 @@ disable_pm:
Takashi Iwai 4b10b5
 	pm_runtime_put_noidle(&i2c->dev);
Takashi Iwai 4b10b5
 	pm_runtime_disable(&i2c->dev);
Takashi Iwai 4b10b5
 	ak8974_set_power(ak8974, AK8974_PWR_OFF);
Takashi Iwai 4b10b5
-power_off:
Takashi Iwai 4b10b5
 	regulator_bulk_disable(ARRAY_SIZE(ak8974->regs), ak8974->regs);
Takashi Iwai 4b10b5
 
Takashi Iwai 4b10b5
 	return ret;