diff options
Diffstat (limited to 'drivers/hwmon')
-rw-r--r-- | drivers/hwmon/tmp401.c | 55 | ||||
-rw-r--r-- | drivers/hwmon/tmp421.c | 45 |
2 files changed, 47 insertions, 53 deletions
diff --git a/drivers/hwmon/tmp401.c b/drivers/hwmon/tmp401.c index 7b34f2cd08bb..ee9673467c4a 100644 --- a/drivers/hwmon/tmp401.c +++ b/drivers/hwmon/tmp401.c | |||
@@ -488,46 +488,43 @@ static void tmp401_init_client(struct i2c_client *client) | |||
488 | i2c_smbus_write_byte_data(client, TMP401_CONFIG_WRITE, config); | 488 | i2c_smbus_write_byte_data(client, TMP401_CONFIG_WRITE, config); |
489 | } | 489 | } |
490 | 490 | ||
491 | static int tmp401_detect(struct i2c_client *client, int kind, | 491 | static int tmp401_detect(struct i2c_client *client, int _kind, |
492 | struct i2c_board_info *info) | 492 | struct i2c_board_info *info) |
493 | { | 493 | { |
494 | enum chips kind; | ||
494 | struct i2c_adapter *adapter = client->adapter; | 495 | struct i2c_adapter *adapter = client->adapter; |
496 | u8 reg; | ||
495 | 497 | ||
496 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) | 498 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
497 | return -ENODEV; | 499 | return -ENODEV; |
498 | 500 | ||
499 | /* Detect and identify the chip */ | 501 | /* Detect and identify the chip */ |
500 | if (kind <= 0) { | 502 | reg = i2c_smbus_read_byte_data(client, TMP401_MANUFACTURER_ID_REG); |
501 | u8 reg; | 503 | if (reg != TMP401_MANUFACTURER_ID) |
502 | 504 | return -ENODEV; | |
503 | reg = i2c_smbus_read_byte_data(client, | ||
504 | TMP401_MANUFACTURER_ID_REG); | ||
505 | if (reg != TMP401_MANUFACTURER_ID) | ||
506 | return -ENODEV; | ||
507 | |||
508 | reg = i2c_smbus_read_byte_data(client, TMP401_DEVICE_ID_REG); | ||
509 | |||
510 | switch (reg) { | ||
511 | case TMP401_DEVICE_ID: | ||
512 | kind = tmp401; | ||
513 | break; | ||
514 | case TMP411_DEVICE_ID: | ||
515 | kind = tmp411; | ||
516 | break; | ||
517 | default: | ||
518 | return -ENODEV; | ||
519 | } | ||
520 | 505 | ||
521 | reg = i2c_smbus_read_byte_data(client, TMP401_CONFIG_READ); | 506 | reg = i2c_smbus_read_byte_data(client, TMP401_DEVICE_ID_REG); |
522 | if (reg & 0x1b) | ||
523 | return -ENODEV; | ||
524 | 507 | ||
525 | reg = i2c_smbus_read_byte_data(client, | 508 | switch (reg) { |
526 | TMP401_CONVERSION_RATE_READ); | 509 | case TMP401_DEVICE_ID: |
527 | /* Datasheet says: 0x1-0x6 */ | 510 | kind = tmp401; |
528 | if (reg > 15) | 511 | break; |
529 | return -ENODEV; | 512 | case TMP411_DEVICE_ID: |
513 | kind = tmp411; | ||
514 | break; | ||
515 | default: | ||
516 | return -ENODEV; | ||
530 | } | 517 | } |
518 | |||
519 | reg = i2c_smbus_read_byte_data(client, TMP401_CONFIG_READ); | ||
520 | if (reg & 0x1b) | ||
521 | return -ENODEV; | ||
522 | |||
523 | reg = i2c_smbus_read_byte_data(client, TMP401_CONVERSION_RATE_READ); | ||
524 | /* Datasheet says: 0x1-0x6 */ | ||
525 | if (reg > 15) | ||
526 | return -ENODEV; | ||
527 | |||
531 | strlcpy(info->type, tmp401_id[kind - 1].name, I2C_NAME_SIZE); | 528 | strlcpy(info->type, tmp401_id[kind - 1].name, I2C_NAME_SIZE); |
532 | 529 | ||
533 | return 0; | 530 | return 0; |
diff --git a/drivers/hwmon/tmp421.c b/drivers/hwmon/tmp421.c index 20924343431b..bb5464a289ca 100644 --- a/drivers/hwmon/tmp421.c +++ b/drivers/hwmon/tmp421.c | |||
@@ -223,39 +223,36 @@ static int tmp421_init_client(struct i2c_client *client) | |||
223 | return 0; | 223 | return 0; |
224 | } | 224 | } |
225 | 225 | ||
226 | static int tmp421_detect(struct i2c_client *client, int kind, | 226 | static int tmp421_detect(struct i2c_client *client, int _kind, |
227 | struct i2c_board_info *info) | 227 | struct i2c_board_info *info) |
228 | { | 228 | { |
229 | enum chips kind; | ||
229 | struct i2c_adapter *adapter = client->adapter; | 230 | struct i2c_adapter *adapter = client->adapter; |
230 | const char *names[] = { "TMP421", "TMP422", "TMP423" }; | 231 | const char *names[] = { "TMP421", "TMP422", "TMP423" }; |
232 | u8 reg; | ||
231 | 233 | ||
232 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) | 234 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
233 | return -ENODEV; | 235 | return -ENODEV; |
234 | 236 | ||
235 | if (kind <= 0) { | 237 | reg = i2c_smbus_read_byte_data(client, TMP421_MANUFACTURER_ID_REG); |
236 | u8 reg; | 238 | if (reg != TMP421_MANUFACTURER_ID) |
237 | 239 | return -ENODEV; | |
238 | reg = i2c_smbus_read_byte_data(client, | 240 | |
239 | TMP421_MANUFACTURER_ID_REG); | 241 | reg = i2c_smbus_read_byte_data(client, TMP421_DEVICE_ID_REG); |
240 | if (reg != TMP421_MANUFACTURER_ID) | 242 | switch (reg) { |
241 | return -ENODEV; | 243 | case TMP421_DEVICE_ID: |
242 | 244 | kind = tmp421; | |
243 | reg = i2c_smbus_read_byte_data(client, | 245 | break; |
244 | TMP421_DEVICE_ID_REG); | 246 | case TMP422_DEVICE_ID: |
245 | switch (reg) { | 247 | kind = tmp422; |
246 | case TMP421_DEVICE_ID: | 248 | break; |
247 | kind = tmp421; | 249 | case TMP423_DEVICE_ID: |
248 | break; | 250 | kind = tmp423; |
249 | case TMP422_DEVICE_ID: | 251 | break; |
250 | kind = tmp422; | 252 | default: |
251 | break; | 253 | return -ENODEV; |
252 | case TMP423_DEVICE_ID: | ||
253 | kind = tmp423; | ||
254 | break; | ||
255 | default: | ||
256 | return -ENODEV; | ||
257 | } | ||
258 | } | 254 | } |
255 | |||
259 | strlcpy(info->type, tmp421_id[kind - 1].name, I2C_NAME_SIZE); | 256 | strlcpy(info->type, tmp421_id[kind - 1].name, I2C_NAME_SIZE); |
260 | dev_info(&adapter->dev, "Detected TI %s chip at 0x%02x\n", | 257 | dev_info(&adapter->dev, "Detected TI %s chip at 0x%02x\n", |
261 | names[kind - 1], client->addr); | 258 | names[kind - 1], client->addr); |