aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/hwmon/tmp401.c55
-rw-r--r--drivers/hwmon/tmp421.c45
2 files changed, 47 insertions, 53 deletions
diff --git a/drivers/hwmon/tmp401.c b/drivers/hwmon/tmp401.c
index 7b34f2cd08b..ee9673467c4 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
491static int tmp401_detect(struct i2c_client *client, int kind, 491static 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 20924343431..bb5464a289c 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
226static int tmp421_detect(struct i2c_client *client, int kind, 226static 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);