diff options
-rw-r--r-- | drivers/hwmon/w83l785ts.c | 70 |
1 files changed, 23 insertions, 47 deletions
diff --git a/drivers/hwmon/w83l785ts.c b/drivers/hwmon/w83l785ts.c index ea295b9fc4f4..9b6c4c10fba7 100644 --- a/drivers/hwmon/w83l785ts.c +++ b/drivers/hwmon/w83l785ts.c | |||
@@ -1,7 +1,7 @@ | |||
1 | /* | 1 | /* |
2 | * w83l785ts.c - Part of lm_sensors, Linux kernel modules for hardware | 2 | * w83l785ts.c - Part of lm_sensors, Linux kernel modules for hardware |
3 | * monitoring | 3 | * monitoring |
4 | * Copyright (C) 2003-2004 Jean Delvare <khali@linux-fr.org> | 4 | * Copyright (C) 2003-2009 Jean Delvare <khali@linux-fr.org> |
5 | * | 5 | * |
6 | * Inspired from the lm83 driver. The W83L785TS-S is a sensor chip made | 6 | * Inspired from the lm83 driver. The W83L785TS-S is a sensor chip made |
7 | * by Winbond. It reports a single external temperature with a 1 deg | 7 | * by Winbond. It reports a single external temperature with a 1 deg |
@@ -146,60 +146,36 @@ static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO, show_temp, NULL, 1); | |||
146 | */ | 146 | */ |
147 | 147 | ||
148 | /* Return 0 if detection is successful, -ENODEV otherwise */ | 148 | /* Return 0 if detection is successful, -ENODEV otherwise */ |
149 | static int w83l785ts_detect(struct i2c_client *new_client, int kind, | 149 | static int w83l785ts_detect(struct i2c_client *client, int kind, |
150 | struct i2c_board_info *info) | 150 | struct i2c_board_info *info) |
151 | { | 151 | { |
152 | struct i2c_adapter *adapter = new_client->adapter; | 152 | struct i2c_adapter *adapter = client->adapter; |
153 | u16 man_id; | ||
154 | u8 chip_id; | ||
153 | 155 | ||
154 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) | 156 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
155 | return -ENODEV; | 157 | return -ENODEV; |
156 | 158 | ||
157 | /* | 159 | /* detection */ |
158 | * Now we do the remaining detection. A negative kind means that | 160 | if ((w83l785ts_read_value(client, W83L785TS_REG_CONFIG, 0) & 0x80) |
159 | * the driver was loaded with no force parameter (default), so we | 161 | || (w83l785ts_read_value(client, W83L785TS_REG_TYPE, 0) & 0xFC)) { |
160 | * must both detect and identify the chip (actually there is only | 162 | dev_dbg(&adapter->dev, |
161 | * one possible kind of chip for now, W83L785TS-S). A zero kind means | 163 | "W83L785TS-S detection failed at 0x%02x\n", |
162 | * that the driver was loaded with the force parameter, the detection | 164 | client->addr); |
163 | * step shall be skipped. A positive kind means that the driver | 165 | return -ENODEV; |
164 | * was loaded with the force parameter and a given kind of chip is | ||
165 | * requested, so both the detection and the identification steps | ||
166 | * are skipped. | ||
167 | */ | ||
168 | if (kind < 0) { /* detection */ | ||
169 | if (((w83l785ts_read_value(new_client, | ||
170 | W83L785TS_REG_CONFIG, 0) & 0x80) != 0x00) | ||
171 | || ((w83l785ts_read_value(new_client, | ||
172 | W83L785TS_REG_TYPE, 0) & 0xFC) != 0x00)) { | ||
173 | dev_dbg(&adapter->dev, | ||
174 | "W83L785TS-S detection failed at 0x%02x.\n", | ||
175 | new_client->addr); | ||
176 | return -ENODEV; | ||
177 | } | ||
178 | } | 166 | } |
179 | 167 | ||
180 | if (kind <= 0) { /* identification */ | 168 | /* Identification */ |
181 | u16 man_id; | 169 | man_id = (w83l785ts_read_value(client, W83L785TS_REG_MAN_ID1, 0) << 8) |
182 | u8 chip_id; | 170 | + w83l785ts_read_value(client, W83L785TS_REG_MAN_ID2, 0); |
183 | 171 | chip_id = w83l785ts_read_value(client, W83L785TS_REG_CHIP_ID, 0); | |
184 | man_id = (w83l785ts_read_value(new_client, | 172 | |
185 | W83L785TS_REG_MAN_ID1, 0) << 8) + | 173 | if (man_id != 0x5CA3 /* Winbond */ |
186 | w83l785ts_read_value(new_client, | 174 | || chip_id != 0x70) { /* W83L785TS-S */ |
187 | W83L785TS_REG_MAN_ID2, 0); | 175 | dev_dbg(&adapter->dev, |
188 | chip_id = w83l785ts_read_value(new_client, | 176 | "Unsupported chip (man_id=0x%04X, chip_id=0x%02X)\n", |
189 | W83L785TS_REG_CHIP_ID, 0); | 177 | man_id, chip_id); |
190 | 178 | return -ENODEV; | |
191 | if (man_id == 0x5CA3) { /* Winbond */ | ||
192 | if (chip_id == 0x70) { /* W83L785TS-S */ | ||
193 | kind = w83l785ts; | ||
194 | } | ||
195 | } | ||
196 | |||
197 | if (kind <= 0) { /* identification failed */ | ||
198 | dev_info(&adapter->dev, | ||
199 | "Unsupported chip (man_id=0x%04X, " | ||
200 | "chip_id=0x%02X).\n", man_id, chip_id); | ||
201 | return -ENODEV; | ||
202 | } | ||
203 | } | 179 | } |
204 | 180 | ||
205 | strlcpy(info->type, "w83l785ts", I2C_NAME_SIZE); | 181 | strlcpy(info->type, "w83l785ts", I2C_NAME_SIZE); |