提交 bab2bf44 编写于 作者: J Jean Delvare

hwmon: (w83781d) Clean up detect function

As kind is now hard-coded to -1, there is room for code clean-ups.
Signed-off-by: NJean Delvare <khali@linux-fr.org>
上级 dbe73c8f
...@@ -1054,11 +1054,11 @@ static int ...@@ -1054,11 +1054,11 @@ static int
w83781d_detect(struct i2c_client *client, int kind, w83781d_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info) struct i2c_board_info *info)
{ {
int val1 = 0, val2; int val1, val2;
struct w83781d_data *isa = w83781d_data_if_isa(); struct w83781d_data *isa = w83781d_data_if_isa();
struct i2c_adapter *adapter = client->adapter; struct i2c_adapter *adapter = client->adapter;
int address = client->addr; int address = client->addr;
const char *client_name = ""; const char *client_name;
enum vendor { winbond, asus } vendid; enum vendor { winbond, asus } vendid;
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
...@@ -1070,98 +1070,73 @@ w83781d_detect(struct i2c_client *client, int kind, ...@@ -1070,98 +1070,73 @@ w83781d_detect(struct i2c_client *client, int kind,
if (isa) if (isa)
mutex_lock(&isa->update_lock); mutex_lock(&isa->update_lock);
/* The w8378?d may be stuck in some other bank than bank 0. This may if (i2c_smbus_read_byte_data(client, W83781D_REG_CONFIG) & 0x80) {
make reading other information impossible. Specify a force=... or dev_dbg(&adapter->dev,
force_*=... parameter, and the Winbond will be reset to the right "Detection of w83781d chip failed at step 3\n");
bank. */ goto err_nodev;
if (kind < 0) { }
if (i2c_smbus_read_byte_data
(client, W83781D_REG_CONFIG) & 0x80) { val1 = i2c_smbus_read_byte_data(client, W83781D_REG_BANK);
dev_dbg(&adapter->dev, "Detection of w83781d chip " val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN);
"failed at step 3\n"); /* Check for Winbond or Asus ID if in bank 0 */
goto err_nodev; if (!(val1 & 0x07) &&
} ((!(val1 & 0x80) && val2 != 0xa3 && val2 != 0xc3) ||
val1 = i2c_smbus_read_byte_data(client, W83781D_REG_BANK); ( (val1 & 0x80) && val2 != 0x5c && val2 != 0x12))) {
val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN); dev_dbg(&adapter->dev,
/* Check for Winbond or Asus ID if in bank 0 */ "Detection of w83781d chip failed at step 4\n");
if ((!(val1 & 0x07)) && goto err_nodev;
(((!(val1 & 0x80)) && (val2 != 0xa3) && (val2 != 0xc3)) }
|| ((val1 & 0x80) && (val2 != 0x5c) && (val2 != 0x12)))) { /* If Winbond SMBus, check address at 0x48.
dev_dbg(&adapter->dev, "Detection of w83781d chip " Asus doesn't support, except for as99127f rev.2 */
"failed at step 4\n"); if ((!(val1 & 0x80) && val2 == 0xa3) ||
( (val1 & 0x80) && val2 == 0x5c)) {
if (i2c_smbus_read_byte_data(client, W83781D_REG_I2C_ADDR)
!= address) {
dev_dbg(&adapter->dev,
"Detection of w83781d chip failed at step 5\n");
goto err_nodev; goto err_nodev;
} }
/* If Winbond SMBus, check address at 0x48.
Asus doesn't support, except for as99127f rev.2 */
if ((!(val1 & 0x80) && (val2 == 0xa3)) ||
((val1 & 0x80) && (val2 == 0x5c))) {
if (i2c_smbus_read_byte_data
(client, W83781D_REG_I2C_ADDR) != address) {
dev_dbg(&adapter->dev, "Detection of w83781d "
"chip failed at step 5\n");
goto err_nodev;
}
}
} }
/* We have either had a force parameter, or we have already detected the /* Put it now into bank 0 and Vendor ID High Byte */
Winbond. Put it now into bank 0 and Vendor ID High Byte */
i2c_smbus_write_byte_data(client, W83781D_REG_BANK, i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
(i2c_smbus_read_byte_data(client, W83781D_REG_BANK) (i2c_smbus_read_byte_data(client, W83781D_REG_BANK)
& 0x78) | 0x80); & 0x78) | 0x80);
/* Determine the chip type. */ /* Get the vendor ID */
if (kind <= 0) { val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN);
/* get vendor ID */ if (val2 == 0x5c)
val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN); vendid = winbond;
if (val2 == 0x5c) else if (val2 == 0x12)
vendid = winbond; vendid = asus;
else if (val2 == 0x12) else {
vendid = asus; dev_dbg(&adapter->dev,
else { "w83781d chip vendor is neither Winbond nor Asus\n");
dev_dbg(&adapter->dev, "w83781d chip vendor is " goto err_nodev;
"neither Winbond nor Asus\n");
goto err_nodev;
}
val1 = i2c_smbus_read_byte_data(client, W83781D_REG_WCHIPID);
if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond)
kind = w83781d;
else if (val1 == 0x30 && vendid == winbond)
kind = w83782d;
else if (val1 == 0x40 && vendid == winbond && address == 0x2d)
kind = w83783s;
else if (val1 == 0x31)
kind = as99127f;
else {
if (kind == 0)
dev_warn(&adapter->dev, "Ignoring 'force' "
"parameter for unknown chip at "
"address 0x%02x\n", address);
goto err_nodev;
}
if ((kind == w83781d || kind == w83782d)
&& w83781d_alias_detect(client, val1)) {
dev_dbg(&adapter->dev, "Device at 0x%02x appears to "
"be the same as ISA device\n", address);
goto err_nodev;
}
} }
if (isa) /* Determine the chip type. */
mutex_unlock(&isa->update_lock); val1 = i2c_smbus_read_byte_data(client, W83781D_REG_WCHIPID);
if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond)
if (kind == w83781d) {
client_name = "w83781d"; client_name = "w83781d";
} else if (kind == w83782d) { else if (val1 == 0x30 && vendid == winbond)
client_name = "w83782d"; client_name = "w83782d";
} else if (kind == w83783s) { else if (val1 == 0x40 && vendid == winbond && address == 0x2d)
client_name = "w83783s"; client_name = "w83783s";
} else if (kind == as99127f) { else if (val1 == 0x31)
client_name = "as99127f"; client_name = "as99127f";
else
goto err_nodev;
if (val1 <= 0x30 && w83781d_alias_detect(client, val1)) {
dev_dbg(&adapter->dev, "Device at 0x%02x appears to "
"be the same as ISA device\n", address);
goto err_nodev;
} }
if (isa)
mutex_unlock(&isa->update_lock);
strlcpy(info->type, client_name, I2C_NAME_SIZE); strlcpy(info->type, client_name, I2C_NAME_SIZE);
return 0; return 0;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册