Commit 1f17a444 authored by Guenter Roeck's avatar Guenter Roeck

hwmon: (lm90) Use devm_add_action for cleanup

Use devm_add_action where possible to simplify error handling and
cleanup on remove.
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent e65365fe
...@@ -369,7 +369,6 @@ struct lm90_data { ...@@ -369,7 +369,6 @@ struct lm90_data {
struct device *hwmon_dev; struct device *hwmon_dev;
const struct attribute_group *groups[6]; const struct attribute_group *groups[6];
struct mutex update_lock; struct mutex update_lock;
struct regulator *regulator;
char valid; /* zero until following fields are valid */ char valid; /* zero until following fields are valid */
unsigned long last_updated; /* in jiffies */ unsigned long last_updated; /* in jiffies */
int kind; int kind;
...@@ -1404,8 +1403,11 @@ static int lm90_detect(struct i2c_client *client, ...@@ -1404,8 +1403,11 @@ static int lm90_detect(struct i2c_client *client,
return 0; return 0;
} }
static void lm90_restore_conf(struct i2c_client *client, struct lm90_data *data) static void lm90_restore_conf(void *_data)
{ {
struct lm90_data *data = _data;
struct i2c_client *client = data->client;
/* Restore initial configuration */ /* Restore initial configuration */
i2c_smbus_write_byte_data(client, LM90_REG_W_CONVRATE, i2c_smbus_write_byte_data(client, LM90_REG_W_CONVRATE,
data->convrate_orig); data->convrate_orig);
...@@ -1456,6 +1458,8 @@ static void lm90_init_client(struct i2c_client *client, struct lm90_data *data) ...@@ -1456,6 +1458,8 @@ static void lm90_init_client(struct i2c_client *client, struct lm90_data *data)
config &= 0xBF; /* run */ config &= 0xBF; /* run */
if (config != data->config_orig) /* Only write if changed */ if (config != data->config_orig) /* Only write if changed */
i2c_smbus_write_byte_data(client, LM90_REG_W_CONFIG1, config); i2c_smbus_write_byte_data(client, LM90_REG_W_CONFIG1, config);
devm_add_action(&client->dev, lm90_restore_conf, data);
} }
static bool lm90_is_tripped(struct i2c_client *client, u16 *status) static bool lm90_is_tripped(struct i2c_client *client, u16 *status)
...@@ -1506,6 +1510,16 @@ static irqreturn_t lm90_irq_thread(int irq, void *dev_id) ...@@ -1506,6 +1510,16 @@ static irqreturn_t lm90_irq_thread(int irq, void *dev_id)
return IRQ_NONE; return IRQ_NONE;
} }
static void lm90_remove_pec(void *dev)
{
device_remove_file(dev, &dev_attr_pec);
}
static void lm90_regulator_disable(void *regulator)
{
regulator_disable(regulator);
}
static int lm90_probe(struct i2c_client *client, static int lm90_probe(struct i2c_client *client,
const struct i2c_device_id *id) const struct i2c_device_id *id)
{ {
...@@ -1526,6 +1540,8 @@ static int lm90_probe(struct i2c_client *client, ...@@ -1526,6 +1540,8 @@ static int lm90_probe(struct i2c_client *client,
return err; return err;
} }
devm_add_action(dev, lm90_regulator_disable, regulator);
data = devm_kzalloc(dev, sizeof(struct lm90_data), GFP_KERNEL); data = devm_kzalloc(dev, sizeof(struct lm90_data), GFP_KERNEL);
if (!data) if (!data)
return -ENOMEM; return -ENOMEM;
...@@ -1534,8 +1550,6 @@ static int lm90_probe(struct i2c_client *client, ...@@ -1534,8 +1550,6 @@ static int lm90_probe(struct i2c_client *client,
i2c_set_clientdata(client, data); i2c_set_clientdata(client, data);
mutex_init(&data->update_lock); mutex_init(&data->update_lock);
data->regulator = regulator;
/* Set the device type */ /* Set the device type */
data->kind = id->driver_data; data->kind = id->driver_data;
if (data->kind == adm1032) { if (data->kind == adm1032) {
...@@ -1577,15 +1591,14 @@ static int lm90_probe(struct i2c_client *client, ...@@ -1577,15 +1591,14 @@ static int lm90_probe(struct i2c_client *client,
if (client->flags & I2C_CLIENT_PEC) { if (client->flags & I2C_CLIENT_PEC) {
err = device_create_file(dev, &dev_attr_pec); err = device_create_file(dev, &dev_attr_pec);
if (err) if (err)
goto exit_restore; return err;
devm_add_action(dev, lm90_remove_pec, dev);
} }
data->hwmon_dev = hwmon_device_register_with_groups(dev, client->name, data->hwmon_dev = hwmon_device_register_with_groups(dev, client->name,
data, data->groups); data, data->groups);
if (IS_ERR(data->hwmon_dev)) { if (IS_ERR(data->hwmon_dev))
err = PTR_ERR(data->hwmon_dev); return PTR_ERR(data->hwmon_dev);
goto exit_remove_pec;
}
if (client->irq) { if (client->irq) {
dev_dbg(dev, "IRQ: %d\n", client->irq); dev_dbg(dev, "IRQ: %d\n", client->irq);
...@@ -1603,12 +1616,6 @@ static int lm90_probe(struct i2c_client *client, ...@@ -1603,12 +1616,6 @@ static int lm90_probe(struct i2c_client *client,
exit_unregister: exit_unregister:
hwmon_device_unregister(data->hwmon_dev); hwmon_device_unregister(data->hwmon_dev);
exit_remove_pec:
device_remove_file(dev, &dev_attr_pec);
exit_restore:
lm90_restore_conf(client, data);
regulator_disable(data->regulator);
return err; return err;
} }
...@@ -1617,9 +1624,6 @@ static int lm90_remove(struct i2c_client *client) ...@@ -1617,9 +1624,6 @@ static int lm90_remove(struct i2c_client *client)
struct lm90_data *data = i2c_get_clientdata(client); struct lm90_data *data = i2c_get_clientdata(client);
hwmon_device_unregister(data->hwmon_dev); hwmon_device_unregister(data->hwmon_dev);
device_remove_file(&client->dev, &dev_attr_pec);
lm90_restore_conf(client, data);
regulator_disable(data->regulator);
return 0; return 0;
} }
......
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