Commit f6421115 authored by Wolfram Sang's avatar Wolfram Sang Committed by Guenter Roeck

hwmon: (w83792d) convert to use devm_i2c_new_dummy_device

And simplify the error handling.
Signed-off-by: default avatarWolfram Sang <wsa+renesas@sang-engineering.com>
Link: https://lore.kernel.org/r/20190903181256.13450-3-wsa+renesas@sang-engineering.comSigned-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent 358d2071
...@@ -924,7 +924,7 @@ store_sf2_level(struct device *dev, struct device_attribute *attr, ...@@ -924,7 +924,7 @@ store_sf2_level(struct device *dev, struct device_attribute *attr,
static int static int
w83792d_detect_subclients(struct i2c_client *new_client) w83792d_detect_subclients(struct i2c_client *new_client)
{ {
int i, id, err; int i, id;
int address = new_client->addr; int address = new_client->addr;
u8 val; u8 val;
struct i2c_adapter *adapter = new_client->adapter; struct i2c_adapter *adapter = new_client->adapter;
...@@ -938,8 +938,7 @@ w83792d_detect_subclients(struct i2c_client *new_client) ...@@ -938,8 +938,7 @@ w83792d_detect_subclients(struct i2c_client *new_client)
dev_err(&new_client->dev, dev_err(&new_client->dev,
"invalid subclient address %d; must be 0x48-0x4f\n", "invalid subclient address %d; must be 0x48-0x4f\n",
force_subclients[i]); force_subclients[i]);
err = -ENODEV; return -ENODEV;
goto ERROR_SC_0;
} }
} }
w83792d_write_value(new_client, W83792D_REG_I2C_SUBADDR, w83792d_write_value(new_client, W83792D_REG_I2C_SUBADDR,
...@@ -949,28 +948,21 @@ w83792d_detect_subclients(struct i2c_client *new_client) ...@@ -949,28 +948,21 @@ w83792d_detect_subclients(struct i2c_client *new_client)
val = w83792d_read_value(new_client, W83792D_REG_I2C_SUBADDR); val = w83792d_read_value(new_client, W83792D_REG_I2C_SUBADDR);
if (!(val & 0x08)) if (!(val & 0x08))
data->lm75[0] = i2c_new_dummy(adapter, 0x48 + (val & 0x7)); data->lm75[0] = devm_i2c_new_dummy_device(&new_client->dev, adapter,
0x48 + (val & 0x7));
if (!(val & 0x80)) { if (!(val & 0x80)) {
if ((data->lm75[0] != NULL) && if (!IS_ERR(data->lm75[0]) &&
((val & 0x7) == ((val >> 4) & 0x7))) { ((val & 0x7) == ((val >> 4) & 0x7))) {
dev_err(&new_client->dev, dev_err(&new_client->dev,
"duplicate addresses 0x%x, use force_subclient\n", "duplicate addresses 0x%x, use force_subclient\n",
data->lm75[0]->addr); data->lm75[0]->addr);
err = -ENODEV; return -ENODEV;
goto ERROR_SC_1;
} }
data->lm75[1] = i2c_new_dummy(adapter, data->lm75[1] = devm_i2c_new_dummy_device(&new_client->dev, adapter,
0x48 + ((val >> 4) & 0x7)); 0x48 + ((val >> 4) & 0x7));
} }
return 0; return 0;
/* Undo inits in case of errors */
ERROR_SC_1:
i2c_unregister_device(data->lm75[0]);
ERROR_SC_0:
return err;
} }
static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, show_in, NULL, 0); static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, show_in, NULL, 0);
...@@ -1396,7 +1388,7 @@ w83792d_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -1396,7 +1388,7 @@ w83792d_probe(struct i2c_client *client, const struct i2c_device_id *id)
/* Register sysfs hooks */ /* Register sysfs hooks */
err = sysfs_create_group(&dev->kobj, &w83792d_group); err = sysfs_create_group(&dev->kobj, &w83792d_group);
if (err) if (err)
goto exit_i2c_unregister; return err;
/* /*
* Read GPIO enable register to check if pins for fan 4,5 are used as * Read GPIO enable register to check if pins for fan 4,5 are used as
...@@ -1441,9 +1433,6 @@ w83792d_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -1441,9 +1433,6 @@ w83792d_probe(struct i2c_client *client, const struct i2c_device_id *id)
sysfs_remove_group(&dev->kobj, &w83792d_group); sysfs_remove_group(&dev->kobj, &w83792d_group);
for (i = 0; i < ARRAY_SIZE(w83792d_group_fan); i++) for (i = 0; i < ARRAY_SIZE(w83792d_group_fan); i++)
sysfs_remove_group(&dev->kobj, &w83792d_group_fan[i]); sysfs_remove_group(&dev->kobj, &w83792d_group_fan[i]);
exit_i2c_unregister:
i2c_unregister_device(data->lm75[0]);
i2c_unregister_device(data->lm75[1]);
return err; return err;
} }
...@@ -1459,9 +1448,6 @@ w83792d_remove(struct i2c_client *client) ...@@ -1459,9 +1448,6 @@ w83792d_remove(struct i2c_client *client)
sysfs_remove_group(&client->dev.kobj, sysfs_remove_group(&client->dev.kobj,
&w83792d_group_fan[i]); &w83792d_group_fan[i]);
i2c_unregister_device(data->lm75[0]);
i2c_unregister_device(data->lm75[1]);
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