Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 9e37d3e2 authored by Guenter Roeck's avatar Guenter Roeck
Browse files

hwmon: (lm75) Handle cleanup with devm_add_action



Use devm_add_action() to register the function to restore the original
chip configuration. Use devm_hwmon_device_register_with_groups()
to register the hwmon device, and drop the remove function as no
longer needed.

Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent eacc48ce
Loading
Loading
Loading
Loading
+19 −19
Original line number Original line Diff line number Diff line
@@ -76,7 +76,6 @@ static const u8 LM75_REG_TEMP[3] = {
/* Each client has this additional data */
/* Each client has this additional data */
struct lm75_data {
struct lm75_data {
	struct i2c_client	*client;
	struct i2c_client	*client;
	struct device		*hwmon_dev;
	struct mutex		update_lock;
	struct mutex		update_lock;
	u8			orig_conf;
	u8			orig_conf;
	u8			resolution;	/* In bits, between 9 and 12 */
	u8			resolution;	/* In bits, between 9 and 12 */
@@ -185,10 +184,19 @@ static const struct thermal_zone_of_device_ops lm75_of_thermal_ops = {


/* device probe and removal */
/* device probe and removal */


static void lm75_remove(void *data)
{
	struct lm75_data *lm75 = data;
	struct i2c_client *client = lm75->client;

	i2c_smbus_write_byte_data(client, LM75_REG_CONF, lm75->orig_conf);
}

static int
static int
lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
{
{
	struct device *dev = &client->dev;
	struct device *dev = &client->dev;
	struct device *hwmon_dev;
	struct lm75_data *data;
	struct lm75_data *data;
	int status;
	int status;
	u8 set_mask, clr_mask;
	u8 set_mask, clr_mask;
@@ -298,29 +306,22 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
	new |= set_mask;
	new |= set_mask;
	if (status != new)
	if (status != new)
		lm75_write_value(client, LM75_REG_CONF, new);
		lm75_write_value(client, LM75_REG_CONF, new);

	devm_add_action(dev, lm75_remove, data);

	dev_dbg(dev, "Config %02x\n", new);
	dev_dbg(dev, "Config %02x\n", new);


	data->hwmon_dev = hwmon_device_register_with_groups(dev, client->name,
	hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
							   data, lm75_groups);
							   data, lm75_groups);
	if (IS_ERR(data->hwmon_dev))
	if (IS_ERR(hwmon_dev))
		return PTR_ERR(data->hwmon_dev);
		return PTR_ERR(hwmon_dev);


	devm_thermal_zone_of_sensor_register(data->hwmon_dev, 0,
	devm_thermal_zone_of_sensor_register(hwmon_dev, 0,
					     data->hwmon_dev,
					     hwmon_dev,
					     &lm75_of_thermal_ops);
					     &lm75_of_thermal_ops);


	dev_info(dev, "%s: sensor '%s'\n",
	dev_info(dev, "%s: sensor '%s'\n", dev_name(hwmon_dev), client->name);
		 dev_name(data->hwmon_dev), client->name);

	return 0;
}

static int lm75_remove(struct i2c_client *client)
{
	struct lm75_data *data = i2c_get_clientdata(client);


	hwmon_device_unregister(data->hwmon_dev);
	lm75_write_value(client, LM75_REG_CONF, data->orig_conf);
	return 0;
	return 0;
}
}


@@ -489,7 +490,6 @@ static struct i2c_driver lm75_driver = {
		.pm	= LM75_DEV_PM_OPS,
		.pm	= LM75_DEV_PM_OPS,
	},
	},
	.probe		= lm75_probe,
	.probe		= lm75_probe,
	.remove		= lm75_remove,
	.id_table	= lm75_ids,
	.id_table	= lm75_ids,
	.detect		= lm75_detect,
	.detect		= lm75_detect,
	.address_list	= normal_i2c,
	.address_list	= normal_i2c,