Skip to content

Commit

Permalink
iio: magn: ak8975: refactor regulator handlers
Browse files Browse the repository at this point in the history
Move the regulator_get() calls directly into the probe() function,
keep only the power_on()/power_off() functions to flick the
regulators on/off.

Signed-off-by: Linus Walleij <[email protected]>
Signed-off-by: Jonathan Cameron <[email protected]>
  • Loading branch information
linusw authored and jic23 committed Jun 30, 2016
1 parent b21d3f3 commit 9e6c16d
Showing 1 changed file with 18 additions and 25 deletions.
43 changes: 18 additions & 25 deletions drivers/iio/magnetometer/ak8975.c
Original file line number Diff line number Diff line change
Expand Up @@ -383,44 +383,28 @@ struct ak8975_data {
};

/* Enable attached power regulator if any. */
static int ak8975_power_on(struct i2c_client *client)
static int ak8975_power_on(const struct ak8975_data *data)
{
const struct iio_dev *indio_dev = i2c_get_clientdata(client);
struct ak8975_data *data = iio_priv(indio_dev);
int ret;

data->vdd = devm_regulator_get(&client->dev, "vdd");
if (IS_ERR(data->vdd)) {
ret = PTR_ERR(data->vdd);
} else {
ret = regulator_enable(data->vdd);
}
ret = regulator_enable(data->vdd);
if (ret) {
dev_warn(&client->dev,
dev_warn(&data->client->dev,
"Failed to enable specified Vdd supply\n");
return ret;
}

data->vid = devm_regulator_get(&client->dev, "vid");
if (IS_ERR(data->vid)) {
ret = PTR_ERR(data->vid);
} else {
ret = regulator_enable(data->vid);
}
ret = regulator_enable(data->vid);
if (ret) {
dev_warn(&client->dev,
dev_warn(&data->client->dev,
"Failed to enable specified Vid supply\n");
return ret;
}
return 0;
}

/* Disable attached power regulator if any. */
static void ak8975_power_off(const struct i2c_client *client)
static void ak8975_power_off(const struct ak8975_data *data)
{
const struct iio_dev *indio_dev = i2c_get_clientdata(client);
const struct ak8975_data *data = iio_priv(indio_dev);

regulator_disable(data->vid);
regulator_disable(data->vdd);
}
Expand Down Expand Up @@ -937,7 +921,15 @@ static int ak8975_probe(struct i2c_client *client,

data->def = &ak_def_array[chipset];

err = ak8975_power_on(client);
/* Fetch the regulators */
data->vdd = devm_regulator_get(&client->dev, "vdd");
if (IS_ERR(data->vdd))
return PTR_ERR(data->vdd);
data->vid = devm_regulator_get(&client->dev, "vid");
if (IS_ERR(data->vid))
return PTR_ERR(data->vid);

err = ak8975_power_on(data);
if (err)
return err;

Expand Down Expand Up @@ -982,17 +974,18 @@ static int ak8975_probe(struct i2c_client *client,
cleanup_buffer:
iio_triggered_buffer_cleanup(indio_dev);
power_off:
ak8975_power_off(client);
ak8975_power_off(data);
return err;
}

static int ak8975_remove(struct i2c_client *client)
{
struct iio_dev *indio_dev = i2c_get_clientdata(client);
struct ak8975_data *data = iio_priv(indio_dev);

iio_device_unregister(indio_dev);
iio_triggered_buffer_cleanup(indio_dev);
ak8975_power_off(client);
ak8975_power_off(data);

return 0;
}
Expand Down

0 comments on commit 9e6c16d

Please sign in to comment.