hwmon: (lm90) Refactor reading of config2 register
Several vendors implement a second configuration register, which we check during device detection. Refactor the code to avoid duplication. Signed-off-by: Jean Delvare <khali@linux-fr.org> Cc: Stijn Devriendt <sdevrien@cisco.com> Cc: Guenter Roeck <guenter.roeck@ericsson.com> Signed-off-by: Guenter Roeck <guenter.roeck@ericsson.com>
This commit is contained in:
parent
6d101c588f
commit
f90be42fb3
@ -1111,7 +1111,7 @@ static int lm90_detect(struct i2c_client *new_client,
|
|||||||
struct i2c_adapter *adapter = new_client->adapter;
|
struct i2c_adapter *adapter = new_client->adapter;
|
||||||
int address = new_client->addr;
|
int address = new_client->addr;
|
||||||
const char *name = NULL;
|
const char *name = NULL;
|
||||||
int man_id, chip_id, reg_config1, reg_convrate;
|
int man_id, chip_id, reg_config1, reg_config2, reg_convrate;
|
||||||
|
|
||||||
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
|
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
@ -1127,15 +1127,16 @@ static int lm90_detect(struct i2c_client *new_client,
|
|||||||
LM90_REG_R_CONVRATE)) < 0)
|
LM90_REG_R_CONVRATE)) < 0)
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
|
|
||||||
if ((address == 0x4C || address == 0x4D)
|
if (man_id == 0x01 || man_id == 0x5C || man_id == 0x41) {
|
||||||
&& man_id == 0x01) { /* National Semiconductor */
|
|
||||||
int reg_config2;
|
|
||||||
|
|
||||||
reg_config2 = i2c_smbus_read_byte_data(new_client,
|
reg_config2 = i2c_smbus_read_byte_data(new_client,
|
||||||
LM90_REG_R_CONFIG2);
|
LM90_REG_R_CONFIG2);
|
||||||
if (reg_config2 < 0)
|
if (reg_config2 < 0)
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
|
} else
|
||||||
|
reg_config2 = 0; /* Make compiler happy */
|
||||||
|
|
||||||
|
if ((address == 0x4C || address == 0x4D)
|
||||||
|
&& man_id == 0x01) { /* National Semiconductor */
|
||||||
if ((reg_config1 & 0x2A) == 0x00
|
if ((reg_config1 & 0x2A) == 0x00
|
||||||
&& (reg_config2 & 0xF8) == 0x00
|
&& (reg_config2 & 0xF8) == 0x00
|
||||||
&& reg_convrate <= 0x09) {
|
&& reg_convrate <= 0x09) {
|
||||||
@ -1264,13 +1265,6 @@ static int lm90_detect(struct i2c_client *new_client,
|
|||||||
} else
|
} else
|
||||||
if (address == 0x4C
|
if (address == 0x4C
|
||||||
&& man_id == 0x5C) { /* Winbond/Nuvoton */
|
&& man_id == 0x5C) { /* Winbond/Nuvoton */
|
||||||
int reg_config2;
|
|
||||||
|
|
||||||
reg_config2 = i2c_smbus_read_byte_data(new_client,
|
|
||||||
LM90_REG_R_CONFIG2);
|
|
||||||
if (reg_config2 < 0)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
if ((reg_config1 & 0x2A) == 0x00
|
if ((reg_config1 & 0x2A) == 0x00
|
||||||
&& (reg_config2 & 0xF8) == 0x00) {
|
&& (reg_config2 & 0xF8) == 0x00) {
|
||||||
if (chip_id == 0x01 /* W83L771W/G */
|
if (chip_id == 0x01 /* W83L771W/G */
|
||||||
@ -1285,13 +1279,6 @@ static int lm90_detect(struct i2c_client *new_client,
|
|||||||
} else
|
} else
|
||||||
if (address >= 0x48 && address <= 0x4F
|
if (address >= 0x48 && address <= 0x4F
|
||||||
&& man_id == 0xA1) { /* NXP Semiconductor/Philips */
|
&& man_id == 0xA1) { /* NXP Semiconductor/Philips */
|
||||||
int reg_config2;
|
|
||||||
|
|
||||||
reg_config2 = i2c_smbus_read_byte_data(new_client,
|
|
||||||
LM90_REG_R_CONFIG2);
|
|
||||||
if (reg_config2 < 0)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
if (chip_id == 0x00
|
if (chip_id == 0x00
|
||||||
&& (reg_config1 & 0x2A) == 0x00
|
&& (reg_config1 & 0x2A) == 0x00
|
||||||
&& (reg_config2 & 0xFE) == 0x00
|
&& (reg_config2 & 0xFE) == 0x00
|
||||||
|
Loading…
x
Reference in New Issue
Block a user