diff options
Diffstat (limited to 'drivers/hwmon/ads7828.c')
| -rw-r--r-- | drivers/hwmon/ads7828.c | 89 |
1 files changed, 38 insertions, 51 deletions
diff --git a/drivers/hwmon/ads7828.c b/drivers/hwmon/ads7828.c index 5c8b6e0ff47c..5c39b4af1b23 100644 --- a/drivers/hwmon/ads7828.c +++ b/drivers/hwmon/ads7828.c | |||
| @@ -64,7 +64,6 @@ static unsigned int ads7828_lsb_resol; /* resolution of the ADC sample lsb */ | |||
| 64 | 64 | ||
| 65 | /* Each client has this additional data */ | 65 | /* Each client has this additional data */ |
| 66 | struct ads7828_data { | 66 | struct ads7828_data { |
| 67 | struct i2c_client client; | ||
| 68 | struct device *hwmon_dev; | 67 | struct device *hwmon_dev; |
| 69 | struct mutex update_lock; /* mutex protect updates */ | 68 | struct mutex update_lock; /* mutex protect updates */ |
| 70 | char valid; /* !=0 if following fields are valid */ | 69 | char valid; /* !=0 if following fields are valid */ |
| @@ -73,7 +72,10 @@ struct ads7828_data { | |||
| 73 | }; | 72 | }; |
| 74 | 73 | ||
| 75 | /* Function declaration - necessary due to function dependencies */ | 74 | /* Function declaration - necessary due to function dependencies */ |
| 76 | static int ads7828_detect(struct i2c_adapter *adapter, int address, int kind); | 75 | static int ads7828_detect(struct i2c_client *client, int kind, |
| 76 | struct i2c_board_info *info); | ||
| 77 | static int ads7828_probe(struct i2c_client *client, | ||
| 78 | const struct i2c_device_id *id); | ||
| 77 | 79 | ||
| 78 | /* The ADS7828 returns the 12-bit sample in two bytes, | 80 | /* The ADS7828 returns the 12-bit sample in two bytes, |
| 79 | these are read as a word then byte-swapped */ | 81 | these are read as a word then byte-swapped */ |
| @@ -156,58 +158,43 @@ static const struct attribute_group ads7828_group = { | |||
| 156 | .attrs = ads7828_attributes, | 158 | .attrs = ads7828_attributes, |
| 157 | }; | 159 | }; |
| 158 | 160 | ||
| 159 | static int ads7828_attach_adapter(struct i2c_adapter *adapter) | 161 | static int ads7828_remove(struct i2c_client *client) |
| 160 | { | ||
| 161 | if (!(adapter->class & I2C_CLASS_HWMON)) | ||
| 162 | return 0; | ||
| 163 | return i2c_probe(adapter, &addr_data, ads7828_detect); | ||
| 164 | } | ||
| 165 | |||
| 166 | static int ads7828_detach_client(struct i2c_client *client) | ||
| 167 | { | 162 | { |
| 168 | struct ads7828_data *data = i2c_get_clientdata(client); | 163 | struct ads7828_data *data = i2c_get_clientdata(client); |
| 169 | hwmon_device_unregister(data->hwmon_dev); | 164 | hwmon_device_unregister(data->hwmon_dev); |
| 170 | sysfs_remove_group(&client->dev.kobj, &ads7828_group); | 165 | sysfs_remove_group(&client->dev.kobj, &ads7828_group); |
| 171 | i2c_detach_client(client); | ||
| 172 | kfree(i2c_get_clientdata(client)); | 166 | kfree(i2c_get_clientdata(client)); |
| 173 | return 0; | 167 | return 0; |
| 174 | } | 168 | } |
| 175 | 169 | ||
| 170 | static const struct i2c_device_id ads7828_id[] = { | ||
| 171 | { "ads7828", ads7828 }, | ||
| 172 | { } | ||
| 173 | }; | ||
| 174 | MODULE_DEVICE_TABLE(i2c, ads7828_id); | ||
| 175 | |||
| 176 | /* This is the driver that will be inserted */ | 176 | /* This is the driver that will be inserted */ |
| 177 | static struct i2c_driver ads7828_driver = { | 177 | static struct i2c_driver ads7828_driver = { |
| 178 | .class = I2C_CLASS_HWMON, | ||
| 178 | .driver = { | 179 | .driver = { |
| 179 | .name = "ads7828", | 180 | .name = "ads7828", |
| 180 | }, | 181 | }, |
| 181 | .attach_adapter = ads7828_attach_adapter, | 182 | .probe = ads7828_probe, |
| 182 | .detach_client = ads7828_detach_client, | 183 | .remove = ads7828_remove, |
| 184 | .id_table = ads7828_id, | ||
| 185 | .detect = ads7828_detect, | ||
| 186 | .address_data = &addr_data, | ||
| 183 | }; | 187 | }; |
| 184 | 188 | ||
| 185 | /* This function is called by i2c_probe */ | 189 | /* Return 0 if detection is successful, -ENODEV otherwise */ |
| 186 | static int ads7828_detect(struct i2c_adapter *adapter, int address, int kind) | 190 | static int ads7828_detect(struct i2c_client *client, int kind, |
| 191 | struct i2c_board_info *info) | ||
| 187 | { | 192 | { |
| 188 | struct i2c_client *client; | 193 | struct i2c_adapter *adapter = client->adapter; |
| 189 | struct ads7828_data *data; | ||
| 190 | int err = 0; | ||
| 191 | const char *name = ""; | ||
| 192 | 194 | ||
| 193 | /* Check we have a valid client */ | 195 | /* Check we have a valid client */ |
| 194 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_READ_WORD_DATA)) | 196 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_READ_WORD_DATA)) |
| 195 | goto exit; | 197 | return -ENODEV; |
| 196 | |||
| 197 | /* OK. For now, we presume we have a valid client. We now create the | ||
| 198 | client structure, even though we cannot fill it completely yet. | ||
| 199 | But it allows us to access ads7828_read_value. */ | ||
| 200 | data = kzalloc(sizeof(struct ads7828_data), GFP_KERNEL); | ||
| 201 | if (!data) { | ||
| 202 | err = -ENOMEM; | ||
| 203 | goto exit; | ||
| 204 | } | ||
| 205 | |||
| 206 | client = &data->client; | ||
| 207 | i2c_set_clientdata(client, data); | ||
| 208 | client->addr = address; | ||
| 209 | client->adapter = adapter; | ||
| 210 | client->driver = &ads7828_driver; | ||
| 211 | 198 | ||
| 212 | /* Now, we do the remaining detection. There is no identification | 199 | /* Now, we do the remaining detection. There is no identification |
| 213 | dedicated register so attempt to sanity check using knowledge of | 200 | dedicated register so attempt to sanity check using knowledge of |
| @@ -225,32 +212,34 @@ static int ads7828_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 225 | printk(KERN_DEBUG | 212 | printk(KERN_DEBUG |
| 226 | "%s : Doesn't look like an ads7828 device\n", | 213 | "%s : Doesn't look like an ads7828 device\n", |
| 227 | __func__); | 214 | __func__); |
| 228 | goto exit_free; | 215 | return -ENODEV; |
| 229 | } | 216 | } |
| 230 | } | 217 | } |
| 231 | } | 218 | } |
| 219 | strlcpy(info->type, "ads7828", I2C_NAME_SIZE); | ||
| 232 | 220 | ||
| 233 | /* Determine the chip type - only one kind supported! */ | 221 | return 0; |
| 234 | if (kind <= 0) | 222 | } |
| 235 | kind = ads7828; | ||
| 236 | 223 | ||
| 237 | if (kind == ads7828) | 224 | static int ads7828_probe(struct i2c_client *client, |
| 238 | name = "ads7828"; | 225 | const struct i2c_device_id *id) |
| 226 | { | ||
| 227 | struct ads7828_data *data; | ||
| 228 | int err; | ||
| 239 | 229 | ||
| 240 | /* Fill in the remaining client fields, put it into the global list */ | 230 | data = kzalloc(sizeof(struct ads7828_data), GFP_KERNEL); |
| 241 | strlcpy(client->name, name, I2C_NAME_SIZE); | 231 | if (!data) { |
| 232 | err = -ENOMEM; | ||
| 233 | goto exit; | ||
| 234 | } | ||
| 242 | 235 | ||
| 236 | i2c_set_clientdata(client, data); | ||
| 243 | mutex_init(&data->update_lock); | 237 | mutex_init(&data->update_lock); |
| 244 | 238 | ||
| 245 | /* Tell the I2C layer a new client has arrived */ | ||
| 246 | err = i2c_attach_client(client); | ||
| 247 | if (err) | ||
| 248 | goto exit_free; | ||
| 249 | |||
| 250 | /* Register sysfs hooks */ | 239 | /* Register sysfs hooks */ |
| 251 | err = sysfs_create_group(&client->dev.kobj, &ads7828_group); | 240 | err = sysfs_create_group(&client->dev.kobj, &ads7828_group); |
| 252 | if (err) | 241 | if (err) |
| 253 | goto exit_detach; | 242 | goto exit_free; |
| 254 | 243 | ||
| 255 | data->hwmon_dev = hwmon_device_register(&client->dev); | 244 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 256 | if (IS_ERR(data->hwmon_dev)) { | 245 | if (IS_ERR(data->hwmon_dev)) { |
| @@ -262,8 +251,6 @@ static int ads7828_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 262 | 251 | ||
| 263 | exit_remove: | 252 | exit_remove: |
| 264 | sysfs_remove_group(&client->dev.kobj, &ads7828_group); | 253 | sysfs_remove_group(&client->dev.kobj, &ads7828_group); |
| 265 | exit_detach: | ||
| 266 | i2c_detach_client(client); | ||
| 267 | exit_free: | 254 | exit_free: |
| 268 | kfree(data); | 255 | kfree(data); |
| 269 | exit: | 256 | exit: |
