projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
hwmon: (w83781d) Drop W83627HF support
[deliverable/linux.git] / drivers / hwmon / w83781d.c
1 /*
2 w83781d.c - Part of lm_sensors, Linux kernel modules for hardware
3 monitoring
4 Copyright (c) 1998 - 2001 Frodo Looijaard <frodol@dds.nl>,
5 Philip Edelbrock <phil@netroedge.com>,
6 and Mark Studebaker <mdsxyz123@yahoo.com>
7 Copyright (c) 2007 Jean Delvare <khali@linux-fr.org>
8
9 This program is free software; you can redistribute it and/or modify
10 it under the terms of the GNU General Public License as published by
11 the Free Software Foundation; either version 2 of the License, or
12 (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful,
15 but WITHOUT ANY WARRANTY; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License
20 along with this program; if not, write to the Free Software
21 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 */
23
24 /*
25 Supports following chips:
26
27 Chip #vin #fanin #pwm #temp wchipid vendid i2c ISA
28 as99127f 7 3 0 3 0x31 0x12c3 yes no
29 as99127f rev.2 (type_name = as99127f) 0x31 0x5ca3 yes no
30 w83781d 7 3 0 3 0x10-1 0x5ca3 yes yes
31 w83782d 9 3 2-4 3 0x30 0x5ca3 yes yes
32 w83783s 5-6 3 2 1-2 0x40 0x5ca3 yes no
33
34 */
35
36 #include <linux/module.h>
37 #include <linux/init.h>
38 #include <linux/slab.h>
39 #include <linux/jiffies.h>
40 #include <linux/i2c.h>
41 #include <linux/platform_device.h>
42 #include <linux/ioport.h>
43 #include <linux/hwmon.h>
44 #include <linux/hwmon-vid.h>
45 #include <linux/hwmon-sysfs.h>
46 #include <linux/sysfs.h>
47 #include <linux/err.h>
48 #include <linux/mutex.h>
49 #include <asm/io.h>
50 #include "lm75.h"
51
52 /* ISA device, if found */
53 static struct platform_device *pdev;
54
55 /* Addresses to scan */
56 static unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d,
57 0x2e, 0x2f, I2C_CLIENT_END };
58 static unsigned short isa_address = 0x290;
59
60 /* Insmod parameters */
61 I2C_CLIENT_INSMOD_4(w83781d, w83782d, w83783s, as99127f);
62 I2C_CLIENT_MODULE_PARM(force_subclients, "List of subclient addresses: "
63 "{bus, clientaddr, subclientaddr1, subclientaddr2}");
64
65 static int reset;
66 module_param(reset, bool, 0);
67 MODULE_PARM_DESC(reset, "Set to one to reset chip on load");
68
69 static int init = 1;
70 module_param(init, bool, 0);
71 MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");
72
73 /* Constants specified below */
74
75 /* Length of ISA address segment */
76 #define W83781D_EXTENT 8
77
78 /* Where are the ISA address/data registers relative to the base address */
79 #define W83781D_ADDR_REG_OFFSET 5
80 #define W83781D_DATA_REG_OFFSET 6
81
82 /* The device registers */
83 /* in nr from 0 to 8 */
84 #define W83781D_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
85 (0x554 + (((nr) - 7) * 2)))
86 #define W83781D_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
87 (0x555 + (((nr) - 7) * 2)))
88 #define W83781D_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \
89 (0x550 + (nr) - 7))
90
91 /* fan nr from 0 to 2 */
92 #define W83781D_REG_FAN_MIN(nr) (0x3b + (nr))
93 #define W83781D_REG_FAN(nr) (0x28 + (nr))
94
95 #define W83781D_REG_BANK 0x4E
96 #define W83781D_REG_TEMP2_CONFIG 0x152
97 #define W83781D_REG_TEMP3_CONFIG 0x252
98 /* temp nr from 1 to 3 */
99 #define W83781D_REG_TEMP(nr) ((nr == 3) ? (0x0250) : \
100 ((nr == 2) ? (0x0150) : \
101 (0x27)))
102 #define W83781D_REG_TEMP_HYST(nr) ((nr == 3) ? (0x253) : \
103 ((nr == 2) ? (0x153) : \
104 (0x3A)))
105 #define W83781D_REG_TEMP_OVER(nr) ((nr == 3) ? (0x255) : \
106 ((nr == 2) ? (0x155) : \
107 (0x39)))
108
109 #define W83781D_REG_CONFIG 0x40
110
111 /* Interrupt status (W83781D, AS99127F) */
112 #define W83781D_REG_ALARM1 0x41
113 #define W83781D_REG_ALARM2 0x42
114
115 /* Real-time status (W83782D, W83783S) */
116 #define W83782D_REG_ALARM1 0x459
117 #define W83782D_REG_ALARM2 0x45A
118 #define W83782D_REG_ALARM3 0x45B
119
120 #define W83781D_REG_BEEP_CONFIG 0x4D
121 #define W83781D_REG_BEEP_INTS1 0x56
122 #define W83781D_REG_BEEP_INTS2 0x57
123 #define W83781D_REG_BEEP_INTS3 0x453 /* not on W83781D */
124
125 #define W83781D_REG_VID_FANDIV 0x47
126
127 #define W83781D_REG_CHIPID 0x49
128 #define W83781D_REG_WCHIPID 0x58
129 #define W83781D_REG_CHIPMAN 0x4F
130 #define W83781D_REG_PIN 0x4B
131
132 /* 782D/783S only */
133 #define W83781D_REG_VBAT 0x5D
134
135 /* PWM 782D (1-4) and 783S (1-2) only */
136 static const u8 W83781D_REG_PWM[] = { 0x5B, 0x5A, 0x5E, 0x5F };
137 #define W83781D_REG_PWMCLK12 0x5C
138 #define W83781D_REG_PWMCLK34 0x45C
139
140 #define W83781D_REG_I2C_ADDR 0x48
141 #define W83781D_REG_I2C_SUBADDR 0x4A
142
143 /* The following are undocumented in the data sheets however we
144 received the information in an email from Winbond tech support */
145 /* Sensor selection - not on 781d */
146 #define W83781D_REG_SCFG1 0x5D
147 static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };
148
149 #define W83781D_REG_SCFG2 0x59
150 static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 };
151
152 #define W83781D_DEFAULT_BETA 3435
153
154 /* RT Table registers */
155 #define W83781D_REG_RT_IDX 0x50
156 #define W83781D_REG_RT_VAL 0x51
157
158 /* Conversions */
159 #define IN_TO_REG(val) SENSORS_LIMIT(((val) + 8) / 16, 0, 255)
160 #define IN_FROM_REG(val) ((val) * 16)
161
162 static inline u8
163 FAN_TO_REG(long rpm, int div)
164 {
165 if (rpm == 0)
166 return 255;
167 rpm = SENSORS_LIMIT(rpm, 1, 1000000);
168 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
169 }
170
171 static inline long
172 FAN_FROM_REG(u8 val, int div)
173 {
174 if (val == 0)
175 return -1;
176 if (val == 255)
177 return 0;
178 return 1350000 / (val * div);
179 }
180
181 #define TEMP_TO_REG(val) SENSORS_LIMIT((val) / 1000, -127, 128)
182 #define TEMP_FROM_REG(val) ((val) * 1000)
183
184 #define BEEP_MASK_FROM_REG(val,type) ((type) == as99127f ? \
185 (val) ^ 0x7fff : (val))
186 #define BEEP_MASK_TO_REG(val,type) ((type) == as99127f ? \
187 (~(val)) & 0x7fff : (val) & 0xffffff)
188
189 #define DIV_FROM_REG(val) (1 << (val))
190
191 static inline u8
192 DIV_TO_REG(long val, enum chips type)
193 {
194 int i;
195 val = SENSORS_LIMIT(val, 1,
196 ((type == w83781d
197 || type == as99127f) ? 8 : 128)) >> 1;
198 for (i = 0; i < 7; i++) {
199 if (val == 0)
200 break;
201 val >>= 1;
202 }
203 return i;
204 }
205
206 /* There are some complications in a module like this. First off, W83781D chips
207 may be both present on the SMBus and the ISA bus, and we have to handle
208 those cases separately at some places. Second, there might be several
209 W83781D chips available (well, actually, that is probably never done; but
210 it is a clean illustration of how to handle a case like that). Finally,
211 a specific chip may be attached to *both* ISA and SMBus, and we would
212 not like to detect it double. Fortunately, in the case of the W83781D at
213 least, a register tells us what SMBus address we are on, so that helps
214 a bit - except if there could be more than one SMBus. Groan. No solution
215 for this yet. */
216
217 /* For ISA chips, we abuse the i2c_client addr and name fields. We also use
218 the driver field to differentiate between I2C and ISA chips. */
219 struct w83781d_data {
220 struct i2c_client client;
221 struct device *hwmon_dev;
222 struct mutex lock;
223 enum chips type;
224
225 struct mutex update_lock;
226 char valid; /* !=0 if following fields are valid */
227 unsigned long last_updated; /* In jiffies */
228
229 struct i2c_client *lm75[2]; /* for secondary I2C addresses */
230 /* array of 2 pointers to subclients */
231
232 u8 in[9]; /* Register value - 8 & 9 for 782D only */
233 u8 in_max[9]; /* Register value - 8 & 9 for 782D only */
234 u8 in_min[9]; /* Register value - 8 & 9 for 782D only */
235 u8 fan[3]; /* Register value */
236 u8 fan_min[3]; /* Register value */
237 s8 temp; /* Register value */
238 s8 temp_max; /* Register value */
239 s8 temp_max_hyst; /* Register value */
240 u16 temp_add[2]; /* Register value */
241 u16 temp_max_add[2]; /* Register value */
242 u16 temp_max_hyst_add[2]; /* Register value */
243 u8 fan_div[3]; /* Register encoding, shifted right */
244 u8 vid; /* Register encoding, combined */
245 u32 alarms; /* Register encoding, combined */
246 u32 beep_mask; /* Register encoding, combined */
247 u8 beep_enable; /* Boolean */
248 u8 pwm[4]; /* Register value */
249 u8 pwm2_enable; /* Boolean */
250 u16 sens[3]; /* 782D/783S only.
251 1 = pentium diode; 2 = 3904 diode;
252 4 = thermistor */
253 u8 vrm;
254 };
255
256 static int w83781d_attach_adapter(struct i2c_adapter *adapter);
257 static int w83781d_detect(struct i2c_adapter *adapter, int address, int kind);
258 static int w83781d_detach_client(struct i2c_client *client);
259
260 static int __devinit w83781d_isa_probe(struct platform_device *pdev);
261 static int __devexit w83781d_isa_remove(struct platform_device *pdev);
262
263 static int w83781d_read_value(struct w83781d_data *data, u16 reg);
264 static int w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value);
265 static struct w83781d_data *w83781d_update_device(struct device *dev);
266 static void w83781d_init_device(struct device *dev);
267
268 static struct i2c_driver w83781d_driver = {
269 .driver = {
270 .name = "w83781d",
271 },
272 .id = I2C_DRIVERID_W83781D,
273 .attach_adapter = w83781d_attach_adapter,
274 .detach_client = w83781d_detach_client,
275 };
276
277 static struct platform_driver w83781d_isa_driver = {
278 .driver = {
279 .owner = THIS_MODULE,
280 .name = "w83781d",
281 },
282 .probe = w83781d_isa_probe,
283 .remove = w83781d_isa_remove,
284 };
285
286
287 /* following are the sysfs callback functions */
288 #define show_in_reg(reg) \
289 static ssize_t show_##reg (struct device *dev, struct device_attribute *da, \
290 char *buf) \
291 { \
292 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
293 struct w83781d_data *data = w83781d_update_device(dev); \
294 return sprintf(buf, "%ld\n", \
295 (long)IN_FROM_REG(data->reg[attr->index])); \
296 }
297 show_in_reg(in);
298 show_in_reg(in_min);
299 show_in_reg(in_max);
300
301 #define store_in_reg(REG, reg) \
302 static ssize_t store_in_##reg (struct device *dev, struct device_attribute \
303 *da, const char *buf, size_t count) \
304 { \
305 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
306 struct w83781d_data *data = dev_get_drvdata(dev); \
307 int nr = attr->index; \
308 u32 val; \
309 \
310 val = simple_strtoul(buf, NULL, 10); \
311 \
312 mutex_lock(&data->update_lock); \
313 data->in_##reg[nr] = IN_TO_REG(val); \
314 w83781d_write_value(data, W83781D_REG_IN_##REG(nr), data->in_##reg[nr]); \
315 \
316 mutex_unlock(&data->update_lock); \
317 return count; \
318 }
319 store_in_reg(MIN, min);
320 store_in_reg(MAX, max);
321
322 #define sysfs_in_offsets(offset) \
323 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
324 show_in, NULL, offset); \
325 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
326 show_in_min, store_in_min, offset); \
327 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
328 show_in_max, store_in_max, offset)
329
330 sysfs_in_offsets(0);
331 sysfs_in_offsets(1);
332 sysfs_in_offsets(2);
333 sysfs_in_offsets(3);
334 sysfs_in_offsets(4);
335 sysfs_in_offsets(5);
336 sysfs_in_offsets(6);
337 sysfs_in_offsets(7);
338 sysfs_in_offsets(8);
339
340 #define show_fan_reg(reg) \
341 static ssize_t show_##reg (struct device *dev, struct device_attribute *da, \
342 char *buf) \
343 { \
344 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
345 struct w83781d_data *data = w83781d_update_device(dev); \
346 return sprintf(buf,"%ld\n", \
347 FAN_FROM_REG(data->reg[attr->index], \
348 DIV_FROM_REG(data->fan_div[attr->index]))); \
349 }
350 show_fan_reg(fan);
351 show_fan_reg(fan_min);
352
353 static ssize_t
354 store_fan_min(struct device *dev, struct device_attribute *da,
355 const char *buf, size_t count)
356 {
357 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
358 struct w83781d_data *data = dev_get_drvdata(dev);
359 int nr = attr->index;
360 u32 val;
361
362 val = simple_strtoul(buf, NULL, 10);
363
364 mutex_lock(&data->update_lock);
365 data->fan_min[nr] =
366 FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
367 w83781d_write_value(data, W83781D_REG_FAN_MIN(nr),
368 data->fan_min[nr]);
369
370 mutex_unlock(&data->update_lock);
371 return count;
372 }
373
374 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
375 static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR,
376 show_fan_min, store_fan_min, 0);
377 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
378 static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR,
379 show_fan_min, store_fan_min, 1);
380 static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
381 static SENSOR_DEVICE_ATTR(fan3_min, S_IRUGO | S_IWUSR,
382 show_fan_min, store_fan_min, 2);
383
384 #define show_temp_reg(reg) \
385 static ssize_t show_##reg (struct device *dev, struct device_attribute *da, \
386 char *buf) \
387 { \
388 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
389 struct w83781d_data *data = w83781d_update_device(dev); \
390 int nr = attr->index; \
391 if (nr >= 2) { /* TEMP2 and TEMP3 */ \
392 return sprintf(buf,"%d\n", \
393 LM75_TEMP_FROM_REG(data->reg##_add[nr-2])); \
394 } else { /* TEMP1 */ \
395 return sprintf(buf,"%ld\n", (long)TEMP_FROM_REG(data->reg)); \
396 } \
397 }
398 show_temp_reg(temp);
399 show_temp_reg(temp_max);
400 show_temp_reg(temp_max_hyst);
401
402 #define store_temp_reg(REG, reg) \
403 static ssize_t store_temp_##reg (struct device *dev, \
404 struct device_attribute *da, const char *buf, size_t count) \
405 { \
406 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
407 struct w83781d_data *data = dev_get_drvdata(dev); \
408 int nr = attr->index; \
409 long val; \
410 \
411 val = simple_strtol(buf, NULL, 10); \
412 \
413 mutex_lock(&data->update_lock); \
414 \
415 if (nr >= 2) { /* TEMP2 and TEMP3 */ \
416 data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \
417 w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
418 data->temp_##reg##_add[nr-2]); \
419 } else { /* TEMP1 */ \
420 data->temp_##reg = TEMP_TO_REG(val); \
421 w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
422 data->temp_##reg); \
423 } \
424 \
425 mutex_unlock(&data->update_lock); \
426 return count; \
427 }
428 store_temp_reg(OVER, max);
429 store_temp_reg(HYST, max_hyst);
430
431 #define sysfs_temp_offsets(offset) \
432 static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
433 show_temp, NULL, offset); \
434 static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
435 show_temp_max, store_temp_max, offset); \
436 static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR, \
437 show_temp_max_hyst, store_temp_max_hyst, offset);
438
439 sysfs_temp_offsets(1);
440 sysfs_temp_offsets(2);
441 sysfs_temp_offsets(3);
442
443 static ssize_t
444 show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf)
445 {
446 struct w83781d_data *data = w83781d_update_device(dev);
447 return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
448 }
449
450 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);
451
452 static ssize_t
453 show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf)
454 {
455 struct w83781d_data *data = dev_get_drvdata(dev);
456 return sprintf(buf, "%ld\n", (long) data->vrm);
457 }
458
459 static ssize_t
460 store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
461 {
462 struct w83781d_data *data = dev_get_drvdata(dev);
463 u32 val;
464
465 val = simple_strtoul(buf, NULL, 10);
466 data->vrm = val;
467
468 return count;
469 }
470
471 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);
472
473 static ssize_t
474 show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf)
475 {
476 struct w83781d_data *data = w83781d_update_device(dev);
477 return sprintf(buf, "%u\n", data->alarms);
478 }
479
480 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);
481
482 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
483 char *buf)
484 {
485 struct w83781d_data *data = w83781d_update_device(dev);
486 int bitnr = to_sensor_dev_attr(attr)->index;
487 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
488 }
489
490 /* The W83781D has a single alarm bit for temp2 and temp3 */
491 static ssize_t show_temp3_alarm(struct device *dev,
492 struct device_attribute *attr, char *buf)
493 {
494 struct w83781d_data *data = w83781d_update_device(dev);
495 int bitnr = (data->type == w83781d) ? 5 : 13;
496 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
497 }
498
499 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
500 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
501 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
502 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
503 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
504 static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
505 static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
506 static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16);
507 static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17);
508 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
509 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
510 static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
511 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
512 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
513 static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_temp3_alarm, NULL, 0);
514
515 static ssize_t show_beep_mask (struct device *dev, struct device_attribute *attr, char *buf)
516 {
517 struct w83781d_data *data = w83781d_update_device(dev);
518 return sprintf(buf, "%ld\n",
519 (long)BEEP_MASK_FROM_REG(data->beep_mask, data->type));
520 }
521 static ssize_t show_beep_enable (struct device *dev, struct device_attribute *attr, char *buf)
522 {
523 struct w83781d_data *data = w83781d_update_device(dev);
524 return sprintf(buf, "%ld\n", (long)data->beep_enable);
525 }
526
527 static ssize_t
528 store_beep_mask(struct device *dev, struct device_attribute *attr,
529 const char *buf, size_t count)
530 {
531 struct w83781d_data *data = dev_get_drvdata(dev);
532 u32 val;
533
534 val = simple_strtoul(buf, NULL, 10);
535
536 mutex_lock(&data->update_lock);
537 data->beep_mask = BEEP_MASK_TO_REG(val, data->type);
538 w83781d_write_value(data, W83781D_REG_BEEP_INTS1,
539 data->beep_mask & 0xff);
540 w83781d_write_value(data, W83781D_REG_BEEP_INTS2,
541 ((data->beep_mask >> 8) & 0x7f)
542 | data->beep_enable << 7);
543 if (data->type != w83781d && data->type != as99127f) {
544 w83781d_write_value(data, W83781D_REG_BEEP_INTS3,
545 ((data->beep_mask) >> 16) & 0xff);
546 }
547 mutex_unlock(&data->update_lock);
548
549 return count;
550 }
551
552 static ssize_t
553 store_beep_enable(struct device *dev, struct device_attribute *attr,
554 const char *buf, size_t count)
555 {
556 struct w83781d_data *data = dev_get_drvdata(dev);
557 u32 val;
558
559 val = simple_strtoul(buf, NULL, 10);
560 if (val != 0 && val != 1)
561 return -EINVAL;
562
563 mutex_lock(&data->update_lock);
564 data->beep_enable = val;
565 val = w83781d_read_value(data, W83781D_REG_BEEP_INTS2) & 0x7f;
566 val |= data->beep_enable << 7;
567 w83781d_write_value(data, W83781D_REG_BEEP_INTS2, val);
568 mutex_unlock(&data->update_lock);
569
570 return count;
571 }
572
573 static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR,
574 show_beep_mask, store_beep_mask);
575 static DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR,
576 show_beep_enable, store_beep_enable);
577
578 static ssize_t show_beep(struct device *dev, struct device_attribute *attr,
579 char *buf)
580 {
581 struct w83781d_data *data = w83781d_update_device(dev);
582 int bitnr = to_sensor_dev_attr(attr)->index;
583 return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
584 }
585
586 static ssize_t
587 store_beep(struct device *dev, struct device_attribute *attr,
588 const char *buf, size_t count)
589 {
590 struct w83781d_data *data = dev_get_drvdata(dev);
591 int bitnr = to_sensor_dev_attr(attr)->index;
592 unsigned long bit;
593 u8 reg;
594
595 bit = simple_strtoul(buf, NULL, 10);
596 if (bit & ~1)
597 return -EINVAL;
598
599 mutex_lock(&data->update_lock);
600 if (bit)
601 data->beep_mask |= (1 << bitnr);
602 else
603 data->beep_mask &= ~(1 << bitnr);
604
605 if (bitnr < 8) {
606 reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
607 if (bit)
608 reg |= (1 << bitnr);
609 else
610 reg &= ~(1 << bitnr);
611 w83781d_write_value(data, W83781D_REG_BEEP_INTS1, reg);
612 } else if (bitnr < 16) {
613 reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
614 if (bit)
615 reg |= (1 << (bitnr - 8));
616 else
617 reg &= ~(1 << (bitnr - 8));
618 w83781d_write_value(data, W83781D_REG_BEEP_INTS2, reg);
619 } else {
620 reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS3);
621 if (bit)
622 reg |= (1 << (bitnr - 16));
623 else
624 reg &= ~(1 << (bitnr - 16));
625 w83781d_write_value(data, W83781D_REG_BEEP_INTS3, reg);
626 }
627 mutex_unlock(&data->update_lock);
628
629 return count;
630 }
631
632 /* The W83781D has a single beep bit for temp2 and temp3 */
633 static ssize_t show_temp3_beep(struct device *dev,
634 struct device_attribute *attr, char *buf)
635 {
636 struct w83781d_data *data = w83781d_update_device(dev);
637 int bitnr = (data->type == w83781d) ? 5 : 13;
638 return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
639 }
640
641 static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR,
642 show_beep, store_beep, 0);
643 static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR,
644 show_beep, store_beep, 1);
645 static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR,
646 show_beep, store_beep, 2);
647 static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR,
648 show_beep, store_beep, 3);
649 static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR,
650 show_beep, store_beep, 8);
651 static SENSOR_DEVICE_ATTR(in5_beep, S_IRUGO | S_IWUSR,
652 show_beep, store_beep, 9);
653 static SENSOR_DEVICE_ATTR(in6_beep, S_IRUGO | S_IWUSR,
654 show_beep, store_beep, 10);
655 static SENSOR_DEVICE_ATTR(in7_beep, S_IRUGO | S_IWUSR,
656 show_beep, store_beep, 16);
657 static SENSOR_DEVICE_ATTR(in8_beep, S_IRUGO | S_IWUSR,
658 show_beep, store_beep, 17);
659 static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR,
660 show_beep, store_beep, 6);
661 static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR,
662 show_beep, store_beep, 7);
663 static SENSOR_DEVICE_ATTR(fan3_beep, S_IRUGO | S_IWUSR,
664 show_beep, store_beep, 11);
665 static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR,
666 show_beep, store_beep, 4);
667 static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR,
668 show_beep, store_beep, 5);
669 static SENSOR_DEVICE_ATTR(temp3_beep, S_IRUGO,
670 show_temp3_beep, store_beep, 13);
671
672 static ssize_t
673 show_fan_div(struct device *dev, struct device_attribute *da, char *buf)
674 {
675 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
676 struct w83781d_data *data = w83781d_update_device(dev);
677 return sprintf(buf, "%ld\n",
678 (long) DIV_FROM_REG(data->fan_div[attr->index]));
679 }
680
681 /* Note: we save and restore the fan minimum here, because its value is
682 determined in part by the fan divisor. This follows the principle of
683 least surprise; the user doesn't expect the fan minimum to change just
684 because the divisor changed. */
685 static ssize_t
686 store_fan_div(struct device *dev, struct device_attribute *da,
687 const char *buf, size_t count)
688 {
689 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
690 struct w83781d_data *data = dev_get_drvdata(dev);
691 unsigned long min;
692 int nr = attr->index;
693 u8 reg;
694 unsigned long val = simple_strtoul(buf, NULL, 10);
695
696 mutex_lock(&data->update_lock);
697
698 /* Save fan_min */
699 min = FAN_FROM_REG(data->fan_min[nr],
700 DIV_FROM_REG(data->fan_div[nr]));
701
702 data->fan_div[nr] = DIV_TO_REG(val, data->type);
703
704 reg = (w83781d_read_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
705 & (nr==0 ? 0xcf : 0x3f))
706 | ((data->fan_div[nr] & 0x03) << (nr==0 ? 4 : 6));
707 w83781d_write_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
708
709 /* w83781d and as99127f don't have extended divisor bits */
710 if (data->type != w83781d && data->type != as99127f) {
711 reg = (w83781d_read_value(data, W83781D_REG_VBAT)
712 & ~(1 << (5 + nr)))
713 | ((data->fan_div[nr] & 0x04) << (3 + nr));
714 w83781d_write_value(data, W83781D_REG_VBAT, reg);
715 }
716
717 /* Restore fan_min */
718 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
719 w83781d_write_value(data, W83781D_REG_FAN_MIN(nr), data->fan_min[nr]);
720
721 mutex_unlock(&data->update_lock);
722 return count;
723 }
724
725 static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
726 show_fan_div, store_fan_div, 0);
727 static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
728 show_fan_div, store_fan_div, 1);
729 static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO | S_IWUSR,
730 show_fan_div, store_fan_div, 2);
731
732 static ssize_t
733 show_pwm(struct device *dev, struct device_attribute *da, char *buf)
734 {
735 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
736 struct w83781d_data *data = w83781d_update_device(dev);
737 return sprintf(buf, "%d\n", (int)data->pwm[attr->index]);
738 }
739
740 static ssize_t
741 show_pwm2_enable(struct device *dev, struct device_attribute *da, char *buf)
742 {
743 struct w83781d_data *data = w83781d_update_device(dev);
744 return sprintf(buf, "%d\n", (int)data->pwm2_enable);
745 }
746
747 static ssize_t
748 store_pwm(struct device *dev, struct device_attribute *da, const char *buf,
749 size_t count)
750 {
751 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
752 struct w83781d_data *data = dev_get_drvdata(dev);
753 int nr = attr->index;
754 u32 val;
755
756 val = simple_strtoul(buf, NULL, 10);
757
758 mutex_lock(&data->update_lock);
759 data->pwm[nr] = SENSORS_LIMIT(val, 0, 255);
760 w83781d_write_value(data, W83781D_REG_PWM[nr], data->pwm[nr]);
761 mutex_unlock(&data->update_lock);
762 return count;
763 }
764
765 static ssize_t
766 store_pwm2_enable(struct device *dev, struct device_attribute *da,
767 const char *buf, size_t count)
768 {
769 struct w83781d_data *data = dev_get_drvdata(dev);
770 u32 val, reg;
771
772 val = simple_strtoul(buf, NULL, 10);
773
774 mutex_lock(&data->update_lock);
775
776 switch (val) {
777 case 0:
778 case 1:
779 reg = w83781d_read_value(data, W83781D_REG_PWMCLK12);
780 w83781d_write_value(data, W83781D_REG_PWMCLK12,
781 (reg & 0xf7) | (val << 3));
782
783 reg = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
784 w83781d_write_value(data, W83781D_REG_BEEP_CONFIG,
785 (reg & 0xef) | (!val << 4));
786
787 data->pwm2_enable = val;
788 break;
789
790 default:
791 mutex_unlock(&data->update_lock);
792 return -EINVAL;
793 }
794
795 mutex_unlock(&data->update_lock);
796 return count;
797 }
798
799 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 0);
800 static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 1);
801 static SENSOR_DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 2);
802 static SENSOR_DEVICE_ATTR(pwm4, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 3);
803 /* only PWM2 can be enabled/disabled */
804 static DEVICE_ATTR(pwm2_enable, S_IRUGO | S_IWUSR,
805 show_pwm2_enable, store_pwm2_enable);
806
807 static ssize_t
808 show_sensor(struct device *dev, struct device_attribute *da, char *buf)
809 {
810 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
811 struct w83781d_data *data = w83781d_update_device(dev);
812 return sprintf(buf, "%d\n", (int)data->sens[attr->index]);
813 }
814
815 static ssize_t
816 store_sensor(struct device *dev, struct device_attribute *da,
817 const char *buf, size_t count)
818 {
819 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
820 struct w83781d_data *data = dev_get_drvdata(dev);
821 int nr = attr->index;
822 u32 val, tmp;
823
824 val = simple_strtoul(buf, NULL, 10);
825
826 mutex_lock(&data->update_lock);
827
828 switch (val) {
829 case 1: /* PII/Celeron diode */
830 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
831 w83781d_write_value(data, W83781D_REG_SCFG1,
832 tmp | BIT_SCFG1[nr]);
833 tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
834 w83781d_write_value(data, W83781D_REG_SCFG2,
835 tmp | BIT_SCFG2[nr]);
836 data->sens[nr] = val;
837 break;
838 case 2: /* 3904 */
839 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
840 w83781d_write_value(data, W83781D_REG_SCFG1,
841 tmp | BIT_SCFG1[nr]);
842 tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
843 w83781d_write_value(data, W83781D_REG_SCFG2,
844 tmp & ~BIT_SCFG2[nr]);
845 data->sens[nr] = val;
846 break;
847 case W83781D_DEFAULT_BETA:
848 dev_warn(dev, "Sensor type %d is deprecated, please use 4 "
849 "instead\n", W83781D_DEFAULT_BETA);
850 /* fall through */
851 case 4: /* thermistor */
852 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
853 w83781d_write_value(data, W83781D_REG_SCFG1,
854 tmp & ~BIT_SCFG1[nr]);
855 data->sens[nr] = val;
856 break;
857 default:
858 dev_err(dev, "Invalid sensor type %ld; must be 1, 2, or 4\n",
859 (long) val);
860 break;
861 }
862
863 mutex_unlock(&data->update_lock);
864 return count;
865 }
866
867 static SENSOR_DEVICE_ATTR(temp1_type, S_IRUGO | S_IWUSR,
868 show_sensor, store_sensor, 0);
869 static SENSOR_DEVICE_ATTR(temp2_type, S_IRUGO | S_IWUSR,
870 show_sensor, store_sensor, 1);
871 static SENSOR_DEVICE_ATTR(temp3_type, S_IRUGO | S_IWUSR,
872 show_sensor, store_sensor, 2);
873
874 /* I2C devices get this name attribute automatically, but for ISA devices
875 we must create it by ourselves. */
876 static ssize_t
877 show_name(struct device *dev, struct device_attribute *devattr, char *buf)
878 {
879 struct w83781d_data *data = dev_get_drvdata(dev);
880 return sprintf(buf, "%s\n", data->client.name);
881 }
882 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
883
884 /* This function is called when:
885 * w83781d_driver is inserted (when this module is loaded), for each
886 available adapter
887 * when a new adapter is inserted (and w83781d_driver is still present) */
888 static int
889 w83781d_attach_adapter(struct i2c_adapter *adapter)
890 {
891 if (!(adapter->class & I2C_CLASS_HWMON))
892 return 0;
893 return i2c_probe(adapter, &addr_data, w83781d_detect);
894 }
895
896 /* Assumes that adapter is of I2C, not ISA variety.
897 * OTHERWISE DON'T CALL THIS
898 */
899 static int
900 w83781d_detect_subclients(struct i2c_adapter *adapter, int address, int kind,
901 struct i2c_client *new_client)
902 {
903 int i, val1 = 0, id;
904 int err;
905 const char *client_name = "";
906 struct w83781d_data *data = i2c_get_clientdata(new_client);
907
908 data->lm75[0] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
909 if (!(data->lm75[0])) {
910 err = -ENOMEM;
911 goto ERROR_SC_0;
912 }
913
914 id = i2c_adapter_id(adapter);
915
916 if (force_subclients[0] == id && force_subclients[1] == address) {
917 for (i = 2; i <= 3; i++) {
918 if (force_subclients[i] < 0x48 ||
919 force_subclients[i] > 0x4f) {
920 dev_err(&new_client->dev, "Invalid subclient "
921 "address %d; must be 0x48-0x4f\n",
922 force_subclients[i]);
923 err = -EINVAL;
924 goto ERROR_SC_1;
925 }
926 }
927 w83781d_write_value(data, W83781D_REG_I2C_SUBADDR,
928 (force_subclients[2] & 0x07) |
929 ((force_subclients[3] & 0x07) << 4));
930 data->lm75[0]->addr = force_subclients[2];
931 } else {
932 val1 = w83781d_read_value(data, W83781D_REG_I2C_SUBADDR);
933 data->lm75[0]->addr = 0x48 + (val1 & 0x07);
934 }
935
936 if (kind != w83783s) {
937 data->lm75[1] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
938 if (!(data->lm75[1])) {
939 err = -ENOMEM;
940 goto ERROR_SC_1;
941 }
942
943 if (force_subclients[0] == id &&
944 force_subclients[1] == address) {
945 data->lm75[1]->addr = force_subclients[3];
946 } else {
947 data->lm75[1]->addr = 0x48 + ((val1 >> 4) & 0x07);
948 }
949 if (data->lm75[0]->addr == data->lm75[1]->addr) {
950 dev_err(&new_client->dev,
951 "Duplicate addresses 0x%x for subclients.\n",
952 data->lm75[0]->addr);
953 err = -EBUSY;
954 goto ERROR_SC_2;
955 }
956 }
957
958 if (kind == w83781d)
959 client_name = "w83781d subclient";
960 else if (kind == w83782d)
961 client_name = "w83782d subclient";
962 else if (kind == w83783s)
963 client_name = "w83783s subclient";
964 else if (kind == as99127f)
965 client_name = "as99127f subclient";
966
967 for (i = 0; i <= 1; i++) {
968 /* store all data in w83781d */
969 i2c_set_clientdata(data->lm75[i], NULL);
970 data->lm75[i]->adapter = adapter;
971 data->lm75[i]->driver = &w83781d_driver;
972 data->lm75[i]->flags = 0;
973 strlcpy(data->lm75[i]->name, client_name,
974 I2C_NAME_SIZE);
975 if ((err = i2c_attach_client(data->lm75[i]))) {
976 dev_err(&new_client->dev, "Subclient %d "
977 "registration at address 0x%x "
978 "failed.\n", i, data->lm75[i]->addr);
979 if (i == 1)
980 goto ERROR_SC_3;
981 goto ERROR_SC_2;
982 }
983 if (kind == w83783s)
984 break;
985 }
986
987 return 0;
988
989 /* Undo inits in case of errors */
990 ERROR_SC_3:
991 i2c_detach_client(data->lm75[0]);
992 ERROR_SC_2:
993 kfree(data->lm75[1]);
994 ERROR_SC_1:
995 kfree(data->lm75[0]);
996 ERROR_SC_0:
997 return err;
998 }
999
1000 #define IN_UNIT_ATTRS(X) \
1001 &sensor_dev_attr_in##X##_input.dev_attr.attr, \
1002 &sensor_dev_attr_in##X##_min.dev_attr.attr, \
1003 &sensor_dev_attr_in##X##_max.dev_attr.attr, \
1004 &sensor_dev_attr_in##X##_alarm.dev_attr.attr, \
1005 &sensor_dev_attr_in##X##_beep.dev_attr.attr
1006
1007 #define FAN_UNIT_ATTRS(X) \
1008 &sensor_dev_attr_fan##X##_input.dev_attr.attr, \
1009 &sensor_dev_attr_fan##X##_min.dev_attr.attr, \
1010 &sensor_dev_attr_fan##X##_div.dev_attr.attr, \
1011 &sensor_dev_attr_fan##X##_alarm.dev_attr.attr, \
1012 &sensor_dev_attr_fan##X##_beep.dev_attr.attr
1013
1014 #define TEMP_UNIT_ATTRS(X) \
1015 &sensor_dev_attr_temp##X##_input.dev_attr.attr, \
1016 &sensor_dev_attr_temp##X##_max.dev_attr.attr, \
1017 &sensor_dev_attr_temp##X##_max_hyst.dev_attr.attr, \
1018 &sensor_dev_attr_temp##X##_alarm.dev_attr.attr, \
1019 &sensor_dev_attr_temp##X##_beep.dev_attr.attr
1020
1021 static struct attribute* w83781d_attributes[] = {
1022 IN_UNIT_ATTRS(0),
1023 IN_UNIT_ATTRS(2),
1024 IN_UNIT_ATTRS(3),
1025 IN_UNIT_ATTRS(4),
1026 IN_UNIT_ATTRS(5),
1027 IN_UNIT_ATTRS(6),
1028 FAN_UNIT_ATTRS(1),
1029 FAN_UNIT_ATTRS(2),
1030 FAN_UNIT_ATTRS(3),
1031 TEMP_UNIT_ATTRS(1),
1032 TEMP_UNIT_ATTRS(2),
1033 &dev_attr_cpu0_vid.attr,
1034 &dev_attr_vrm.attr,
1035 &dev_attr_alarms.attr,
1036 &dev_attr_beep_mask.attr,
1037 &dev_attr_beep_enable.attr,
1038 NULL
1039 };
1040 static const struct attribute_group w83781d_group = {
1041 .attrs = w83781d_attributes,
1042 };
1043
1044 static struct attribute *w83781d_attributes_opt[] = {
1045 IN_UNIT_ATTRS(1),
1046 IN_UNIT_ATTRS(7),
1047 IN_UNIT_ATTRS(8),
1048 TEMP_UNIT_ATTRS(3),
1049 &sensor_dev_attr_pwm1.dev_attr.attr,
1050 &sensor_dev_attr_pwm2.dev_attr.attr,
1051 &sensor_dev_attr_pwm3.dev_attr.attr,
1052 &sensor_dev_attr_pwm4.dev_attr.attr,
1053 &dev_attr_pwm2_enable.attr,
1054 &sensor_dev_attr_temp1_type.dev_attr.attr,
1055 &sensor_dev_attr_temp2_type.dev_attr.attr,
1056 &sensor_dev_attr_temp3_type.dev_attr.attr,
1057 NULL
1058 };
1059 static const struct attribute_group w83781d_group_opt = {
1060 .attrs = w83781d_attributes_opt,
1061 };
1062
1063 /* No clean up is done on error, it's up to the caller */
1064 static int
1065 w83781d_create_files(struct device *dev, int kind, int is_isa)
1066 {
1067 int err;
1068
1069 if ((err = sysfs_create_group(&dev->kobj, &w83781d_group)))
1070 return err;
1071
1072 if (kind != w83783s) {
1073 if ((err = device_create_file(dev,
1074 &sensor_dev_attr_in1_input.dev_attr))
1075 || (err = device_create_file(dev,
1076 &sensor_dev_attr_in1_min.dev_attr))
1077 || (err = device_create_file(dev,
1078 &sensor_dev_attr_in1_max.dev_attr))
1079 || (err = device_create_file(dev,
1080 &sensor_dev_attr_in1_alarm.dev_attr))
1081 || (err = device_create_file(dev,
1082 &sensor_dev_attr_in1_beep.dev_attr)))
1083 return err;
1084 }
1085 if (kind != as99127f && kind != w83781d && kind != w83783s) {
1086 if ((err = device_create_file(dev,
1087 &sensor_dev_attr_in7_input.dev_attr))
1088 || (err = device_create_file(dev,
1089 &sensor_dev_attr_in7_min.dev_attr))
1090 || (err = device_create_file(dev,
1091 &sensor_dev_attr_in7_max.dev_attr))
1092 || (err = device_create_file(dev,
1093 &sensor_dev_attr_in7_alarm.dev_attr))
1094 || (err = device_create_file(dev,
1095 &sensor_dev_attr_in7_beep.dev_attr))
1096 || (err = device_create_file(dev,
1097 &sensor_dev_attr_in8_input.dev_attr))
1098 || (err = device_create_file(dev,
1099 &sensor_dev_attr_in8_min.dev_attr))
1100 || (err = device_create_file(dev,
1101 &sensor_dev_attr_in8_max.dev_attr))
1102 || (err = device_create_file(dev,
1103 &sensor_dev_attr_in8_alarm.dev_attr))
1104 || (err = device_create_file(dev,
1105 &sensor_dev_attr_in8_beep.dev_attr)))
1106 return err;
1107 }
1108 if (kind != w83783s) {
1109 if ((err = device_create_file(dev,
1110 &sensor_dev_attr_temp3_input.dev_attr))
1111 || (err = device_create_file(dev,
1112 &sensor_dev_attr_temp3_max.dev_attr))
1113 || (err = device_create_file(dev,
1114 &sensor_dev_attr_temp3_max_hyst.dev_attr))
1115 || (err = device_create_file(dev,
1116 &sensor_dev_attr_temp3_alarm.dev_attr))
1117 || (err = device_create_file(dev,
1118 &sensor_dev_attr_temp3_beep.dev_attr)))
1119 return err;
1120
1121 if (kind != w83781d) {
1122 err = sysfs_chmod_file(&dev->kobj,
1123 &sensor_dev_attr_temp3_alarm.dev_attr.attr,
1124 S_IRUGO | S_IWUSR);
1125 if (err)
1126 return err;
1127 }
1128 }
1129
1130 if (kind != w83781d && kind != as99127f) {
1131 if ((err = device_create_file(dev,
1132 &sensor_dev_attr_pwm1.dev_attr))
1133 || (err = device_create_file(dev,
1134 &sensor_dev_attr_pwm2.dev_attr))
1135 || (err = device_create_file(dev, &dev_attr_pwm2_enable)))
1136 return err;
1137 }
1138 if (kind == w83782d && !is_isa) {
1139 if ((err = device_create_file(dev,
1140 &sensor_dev_attr_pwm3.dev_attr))
1141 || (err = device_create_file(dev,
1142 &sensor_dev_attr_pwm4.dev_attr)))
1143 return err;
1144 }
1145
1146 if (kind != as99127f && kind != w83781d) {
1147 if ((err = device_create_file(dev,
1148 &sensor_dev_attr_temp1_type.dev_attr))
1149 || (err = device_create_file(dev,
1150 &sensor_dev_attr_temp2_type.dev_attr)))
1151 return err;
1152 if (kind != w83783s) {
1153 if ((err = device_create_file(dev,
1154 &sensor_dev_attr_temp3_type.dev_attr)))
1155 return err;
1156 }
1157 }
1158
1159 if (is_isa) {
1160 err = device_create_file(&pdev->dev, &dev_attr_name);
1161 if (err)
1162 return err;
1163 }
1164
1165 return 0;
1166 }
1167
1168 static int
1169 w83781d_detect(struct i2c_adapter *adapter, int address, int kind)
1170 {
1171 int val1 = 0, val2;
1172 struct i2c_client *client;
1173 struct device *dev;
1174 struct w83781d_data *data;
1175 int err;
1176 const char *client_name = "";
1177 enum vendor { winbond, asus } vendid;
1178
1179 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
1180 err = -EINVAL;
1181 goto ERROR1;
1182 }
1183
1184 /* OK. For now, we presume we have a valid client. We now create the
1185 client structure, even though we cannot fill it completely yet.
1186 But it allows us to access w83781d_{read,write}_value. */
1187
1188 if (!(data = kzalloc(sizeof(struct w83781d_data), GFP_KERNEL))) {
1189 err = -ENOMEM;
1190 goto ERROR1;
1191 }
1192
1193 client = &data->client;
1194 i2c_set_clientdata(client, data);
1195 client->addr = address;
1196 mutex_init(&data->lock);
1197 client->adapter = adapter;
1198 client->driver = &w83781d_driver;
1199 dev = &client->dev;
1200
1201 /* Now, we do the remaining detection. */
1202
1203 /* The w8378?d may be stuck in some other bank than bank 0. This may
1204 make reading other information impossible. Specify a force=... or
1205 force_*=... parameter, and the Winbond will be reset to the right
1206 bank. */
1207 if (kind < 0) {
1208 if (w83781d_read_value(data, W83781D_REG_CONFIG) & 0x80) {
1209 dev_dbg(&adapter->dev, "Detection of w83781d chip "
1210 "failed at step 3\n");
1211 err = -ENODEV;
1212 goto ERROR2;
1213 }
1214 val1 = w83781d_read_value(data, W83781D_REG_BANK);
1215 val2 = w83781d_read_value(data, W83781D_REG_CHIPMAN);
1216 /* Check for Winbond or Asus ID if in bank 0 */
1217 if ((!(val1 & 0x07)) &&
1218 (((!(val1 & 0x80)) && (val2 != 0xa3) && (val2 != 0xc3))
1219 || ((val1 & 0x80) && (val2 != 0x5c) && (val2 != 0x12)))) {
1220 dev_dbg(&adapter->dev, "Detection of w83781d chip "
1221 "failed at step 4\n");
1222 err = -ENODEV;
1223 goto ERROR2;
1224 }
1225 /* If Winbond SMBus, check address at 0x48.
1226 Asus doesn't support, except for as99127f rev.2 */
1227 if ((!(val1 & 0x80) && (val2 == 0xa3)) ||
1228 ((val1 & 0x80) && (val2 == 0x5c))) {
1229 if (w83781d_read_value
1230 (data, W83781D_REG_I2C_ADDR) != address) {
1231 dev_dbg(&adapter->dev, "Detection of w83781d "
1232 "chip failed at step 5\n");
1233 err = -ENODEV;
1234 goto ERROR2;
1235 }
1236 }
1237 }
1238
1239 /* We have either had a force parameter, or we have already detected the
1240 Winbond. Put it now into bank 0 and Vendor ID High Byte */
1241 w83781d_write_value(data, W83781D_REG_BANK,
1242 (w83781d_read_value(data, W83781D_REG_BANK)
1243 & 0x78) | 0x80);
1244
1245 /* Determine the chip type. */
1246 if (kind <= 0) {
1247 /* get vendor ID */
1248 val2 = w83781d_read_value(data, W83781D_REG_CHIPMAN);
1249 if (val2 == 0x5c)
1250 vendid = winbond;
1251 else if (val2 == 0x12)
1252 vendid = asus;
1253 else {
1254 dev_dbg(&adapter->dev, "w83781d chip vendor is "
1255 "neither Winbond nor Asus\n");
1256 err = -ENODEV;
1257 goto ERROR2;
1258 }
1259
1260 val1 = w83781d_read_value(data, W83781D_REG_WCHIPID);
1261 if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond)
1262 kind = w83781d;
1263 else if (val1 == 0x30 && vendid == winbond)
1264 kind = w83782d;
1265 else if (val1 == 0x40 && vendid == winbond && address == 0x2d)
1266 kind = w83783s;
1267 else if (val1 == 0x31)
1268 kind = as99127f;
1269 else {
1270 if (kind == 0)
1271 dev_warn(&adapter->dev, "Ignoring 'force' "
1272 "parameter for unknown chip at "
1273 "address 0x%02x\n", address);
1274 err = -EINVAL;
1275 goto ERROR2;
1276 }
1277 }
1278
1279 if (kind == w83781d) {
1280 client_name = "w83781d";
1281 } else if (kind == w83782d) {
1282 client_name = "w83782d";
1283 } else if (kind == w83783s) {
1284 client_name = "w83783s";
1285 } else if (kind == as99127f) {
1286 client_name = "as99127f";
1287 }
1288
1289 /* Fill in the remaining client fields and put into the global list */
1290 strlcpy(client->name, client_name, I2C_NAME_SIZE);
1291 data->type = kind;
1292
1293 /* Tell the I2C layer a new client has arrived */
1294 if ((err = i2c_attach_client(client)))
1295 goto ERROR2;
1296
1297 /* attach secondary i2c lm75-like clients */
1298 if ((err = w83781d_detect_subclients(adapter, address,
1299 kind, client)))
1300 goto ERROR3;
1301
1302 /* Initialize the chip */
1303 w83781d_init_device(dev);
1304
1305 /* Register sysfs hooks */
1306 err = w83781d_create_files(dev, kind, 0);
1307 if (err)
1308 goto ERROR4;
1309
1310 data->hwmon_dev = hwmon_device_register(dev);
1311 if (IS_ERR(data->hwmon_dev)) {
1312 err = PTR_ERR(data->hwmon_dev);
1313 goto ERROR4;
1314 }
1315
1316 return 0;
1317
1318 ERROR4:
1319 sysfs_remove_group(&dev->kobj, &w83781d_group);
1320 sysfs_remove_group(&dev->kobj, &w83781d_group_opt);
1321
1322 if (data->lm75[1]) {
1323 i2c_detach_client(data->lm75[1]);
1324 kfree(data->lm75[1]);
1325 }
1326 if (data->lm75[0]) {
1327 i2c_detach_client(data->lm75[0]);
1328 kfree(data->lm75[0]);
1329 }
1330 ERROR3:
1331 i2c_detach_client(client);
1332 ERROR2:
1333 kfree(data);
1334 ERROR1:
1335 return err;
1336 }
1337
1338 static int
1339 w83781d_detach_client(struct i2c_client *client)
1340 {
1341 struct w83781d_data *data = i2c_get_clientdata(client);
1342 int err;
1343
1344 /* main client */
1345 if (data) {
1346 hwmon_device_unregister(data->hwmon_dev);
1347 sysfs_remove_group(&client->dev.kobj, &w83781d_group);
1348 sysfs_remove_group(&client->dev.kobj, &w83781d_group_opt);
1349 }
1350
1351 if ((err = i2c_detach_client(client)))
1352 return err;
1353
1354 /* main client */
1355 if (data)
1356 kfree(data);
1357
1358 /* subclient */
1359 else
1360 kfree(client);
1361
1362 return 0;
1363 }
1364
1365 static int __devinit
1366 w83781d_isa_probe(struct platform_device *pdev)
1367 {
1368 int err, reg;
1369 struct w83781d_data *data;
1370 struct resource *res;
1371 const char *name;
1372
1373 /* Reserve the ISA region */
1374 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1375 if (!request_region(res->start, W83781D_EXTENT, "w83781d")) {
1376 err = -EBUSY;
1377 goto exit;
1378 }
1379
1380 if (!(data = kzalloc(sizeof(struct w83781d_data), GFP_KERNEL))) {
1381 err = -ENOMEM;
1382 goto exit_release_region;
1383 }
1384 mutex_init(&data->lock);
1385 data->client.addr = res->start;
1386 i2c_set_clientdata(&data->client, data);
1387 platform_set_drvdata(pdev, data);
1388
1389 reg = w83781d_read_value(data, W83781D_REG_WCHIPID);
1390 switch (reg) {
1391 case 0x30:
1392 data->type = w83782d;
1393 name = "w83782d";
1394 break;
1395 default:
1396 data->type = w83781d;
1397 name = "w83781d";
1398 }
1399 strlcpy(data->client.name, name, I2C_NAME_SIZE);
1400
1401 /* Initialize the W83781D chip */
1402 w83781d_init_device(&pdev->dev);
1403
1404 /* Register sysfs hooks */
1405 err = w83781d_create_files(&pdev->dev, data->type, 1);
1406 if (err)
1407 goto exit_remove_files;
1408
1409 data->hwmon_dev = hwmon_device_register(&pdev->dev);
1410 if (IS_ERR(data->hwmon_dev)) {
1411 err = PTR_ERR(data->hwmon_dev);
1412 goto exit_remove_files;
1413 }
1414
1415 return 0;
1416
1417 exit_remove_files:
1418 sysfs_remove_group(&pdev->dev.kobj, &w83781d_group);
1419 sysfs_remove_group(&pdev->dev.kobj, &w83781d_group_opt);
1420 device_remove_file(&pdev->dev, &dev_attr_name);
1421 kfree(data);
1422 exit_release_region:
1423 release_region(res->start, W83781D_EXTENT);
1424 exit:
1425 return err;
1426 }
1427
1428 static int __devexit
1429 w83781d_isa_remove(struct platform_device *pdev)
1430 {
1431 struct w83781d_data *data = platform_get_drvdata(pdev);
1432
1433 hwmon_device_unregister(data->hwmon_dev);
1434 sysfs_remove_group(&pdev->dev.kobj, &w83781d_group);
1435 sysfs_remove_group(&pdev->dev.kobj, &w83781d_group_opt);
1436 device_remove_file(&pdev->dev, &dev_attr_name);
1437 release_region(data->client.addr, W83781D_EXTENT);
1438 kfree(data);
1439
1440 return 0;
1441 }
1442
1443 /* The SMBus locks itself, usually, but nothing may access the Winbond between
1444 bank switches. ISA access must always be locked explicitly!
1445 We ignore the W83781D BUSY flag at this moment - it could lead to deadlocks,
1446 would slow down the W83781D access and should not be necessary.
1447 There are some ugly typecasts here, but the good news is - they should
1448 nowhere else be necessary! */
1449 static int
1450 w83781d_read_value(struct w83781d_data *data, u16 reg)
1451 {
1452 struct i2c_client *client = &data->client;
1453 int res, word_sized, bank;
1454 struct i2c_client *cl;
1455
1456 mutex_lock(&data->lock);
1457 if (!client->driver) { /* ISA device */
1458 word_sized = (((reg & 0xff00) == 0x100)
1459 || ((reg & 0xff00) == 0x200))
1460 && (((reg & 0x00ff) == 0x50)
1461 || ((reg & 0x00ff) == 0x53)
1462 || ((reg & 0x00ff) == 0x55));
1463 if (reg & 0xff00) {
1464 outb_p(W83781D_REG_BANK,
1465 client->addr + W83781D_ADDR_REG_OFFSET);
1466 outb_p(reg >> 8,
1467 client->addr + W83781D_DATA_REG_OFFSET);
1468 }
1469 outb_p(reg & 0xff, client->addr + W83781D_ADDR_REG_OFFSET);
1470 res = inb_p(client->addr + W83781D_DATA_REG_OFFSET);
1471 if (word_sized) {
1472 outb_p((reg & 0xff) + 1,
1473 client->addr + W83781D_ADDR_REG_OFFSET);
1474 res =
1475 (res << 8) + inb_p(client->addr +
1476 W83781D_DATA_REG_OFFSET);
1477 }
1478 if (reg & 0xff00) {
1479 outb_p(W83781D_REG_BANK,
1480 client->addr + W83781D_ADDR_REG_OFFSET);
1481 outb_p(0, client->addr + W83781D_DATA_REG_OFFSET);
1482 }
1483 } else {
1484 bank = (reg >> 8) & 0x0f;
1485 if (bank > 2)
1486 /* switch banks */
1487 i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
1488 bank);
1489 if (bank == 0 || bank > 2) {
1490 res = i2c_smbus_read_byte_data(client, reg & 0xff);
1491 } else {
1492 /* switch to subclient */
1493 cl = data->lm75[bank - 1];
1494 /* convert from ISA to LM75 I2C addresses */
1495 switch (reg & 0xff) {
1496 case 0x50: /* TEMP */
1497 res = swab16(i2c_smbus_read_word_data(cl, 0));
1498 break;
1499 case 0x52: /* CONFIG */
1500 res = i2c_smbus_read_byte_data(cl, 1);
1501 break;
1502 case 0x53: /* HYST */
1503 res = swab16(i2c_smbus_read_word_data(cl, 2));
1504 break;
1505 case 0x55: /* OVER */
1506 default:
1507 res = swab16(i2c_smbus_read_word_data(cl, 3));
1508 break;
1509 }
1510 }
1511 if (bank > 2)
1512 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
1513 }
1514 mutex_unlock(&data->lock);
1515 return res;
1516 }
1517
1518 static int
1519 w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value)
1520 {
1521 struct i2c_client *client = &data->client;
1522 int word_sized, bank;
1523 struct i2c_client *cl;
1524
1525 mutex_lock(&data->lock);
1526 if (!client->driver) { /* ISA device */
1527 word_sized = (((reg & 0xff00) == 0x100)
1528 || ((reg & 0xff00) == 0x200))
1529 && (((reg & 0x00ff) == 0x53)
1530 || ((reg & 0x00ff) == 0x55));
1531 if (reg & 0xff00) {
1532 outb_p(W83781D_REG_BANK,
1533 client->addr + W83781D_ADDR_REG_OFFSET);
1534 outb_p(reg >> 8,
1535 client->addr + W83781D_DATA_REG_OFFSET);
1536 }
1537 outb_p(reg & 0xff, client->addr + W83781D_ADDR_REG_OFFSET);
1538 if (word_sized) {
1539 outb_p(value >> 8,
1540 client->addr + W83781D_DATA_REG_OFFSET);
1541 outb_p((reg & 0xff) + 1,
1542 client->addr + W83781D_ADDR_REG_OFFSET);
1543 }
1544 outb_p(value & 0xff, client->addr + W83781D_DATA_REG_OFFSET);
1545 if (reg & 0xff00) {
1546 outb_p(W83781D_REG_BANK,
1547 client->addr + W83781D_ADDR_REG_OFFSET);
1548 outb_p(0, client->addr + W83781D_DATA_REG_OFFSET);
1549 }
1550 } else {
1551 bank = (reg >> 8) & 0x0f;
1552 if (bank > 2)
1553 /* switch banks */
1554 i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
1555 bank);
1556 if (bank == 0 || bank > 2) {
1557 i2c_smbus_write_byte_data(client, reg & 0xff,
1558 value & 0xff);
1559 } else {
1560 /* switch to subclient */
1561 cl = data->lm75[bank - 1];
1562 /* convert from ISA to LM75 I2C addresses */
1563 switch (reg & 0xff) {
1564 case 0x52: /* CONFIG */
1565 i2c_smbus_write_byte_data(cl, 1, value & 0xff);
1566 break;
1567 case 0x53: /* HYST */
1568 i2c_smbus_write_word_data(cl, 2, swab16(value));
1569 break;
1570 case 0x55: /* OVER */
1571 i2c_smbus_write_word_data(cl, 3, swab16(value));
1572 break;
1573 }
1574 }
1575 if (bank > 2)
1576 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
1577 }
1578 mutex_unlock(&data->lock);
1579 return 0;
1580 }
1581
1582 static void
1583 w83781d_init_device(struct device *dev)
1584 {
1585 struct w83781d_data *data = dev_get_drvdata(dev);
1586 int i, p;
1587 int type = data->type;
1588 u8 tmp;
1589
1590 if (reset && type != as99127f) { /* this resets registers we don't have
1591 documentation for on the as99127f */
1592 /* Resetting the chip has been the default for a long time,
1593 but it causes the BIOS initializations (fan clock dividers,
1594 thermal sensor types...) to be lost, so it is now optional.
1595 It might even go away if nobody reports it as being useful,
1596 as I see very little reason why this would be needed at
1597 all. */
1598 dev_info(dev, "If reset=1 solved a problem you were "
1599 "having, please report!\n");
1600
1601 /* save these registers */
1602 i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
1603 p = w83781d_read_value(data, W83781D_REG_PWMCLK12);
1604 /* Reset all except Watchdog values and last conversion values
1605 This sets fan-divs to 2, among others */
1606 w83781d_write_value(data, W83781D_REG_CONFIG, 0x80);
1607 /* Restore the registers and disable power-on abnormal beep.
1608 This saves FAN 1/2/3 input/output values set by BIOS. */
1609 w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
1610 w83781d_write_value(data, W83781D_REG_PWMCLK12, p);
1611 /* Disable master beep-enable (reset turns it on).
1612 Individual beep_mask should be reset to off but for some reason
1613 disabling this bit helps some people not get beeped */
1614 w83781d_write_value(data, W83781D_REG_BEEP_INTS2, 0);
1615 }
1616
1617 /* Disable power-on abnormal beep, as advised by the datasheet.
1618 Already done if reset=1. */
1619 if (init && !reset && type != as99127f) {
1620 i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
1621 w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
1622 }
1623
1624 data->vrm = vid_which_vrm();
1625
1626 if ((type != w83781d) && (type != as99127f)) {
1627 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
1628 for (i = 1; i <= 3; i++) {
1629 if (!(tmp & BIT_SCFG1[i - 1])) {
1630 data->sens[i - 1] = 4;
1631 } else {
1632 if (w83781d_read_value
1633 (data,
1634 W83781D_REG_SCFG2) & BIT_SCFG2[i - 1])
1635 data->sens[i - 1] = 1;
1636 else
1637 data->sens[i - 1] = 2;
1638 }
1639 if (type == w83783s && i == 2)
1640 break;
1641 }
1642 }
1643
1644 if (init && type != as99127f) {
1645 /* Enable temp2 */
1646 tmp = w83781d_read_value(data, W83781D_REG_TEMP2_CONFIG);
1647 if (tmp & 0x01) {
1648 dev_warn(dev, "Enabling temp2, readings "
1649 "might not make sense\n");
1650 w83781d_write_value(data, W83781D_REG_TEMP2_CONFIG,
1651 tmp & 0xfe);
1652 }
1653
1654 /* Enable temp3 */
1655 if (type != w83783s) {
1656 tmp = w83781d_read_value(data,
1657 W83781D_REG_TEMP3_CONFIG);
1658 if (tmp & 0x01) {
1659 dev_warn(dev, "Enabling temp3, "
1660 "readings might not make sense\n");
1661 w83781d_write_value(data,
1662 W83781D_REG_TEMP3_CONFIG, tmp & 0xfe);
1663 }
1664 }
1665 }
1666
1667 /* Start monitoring */
1668 w83781d_write_value(data, W83781D_REG_CONFIG,
1669 (w83781d_read_value(data,
1670 W83781D_REG_CONFIG) & 0xf7)
1671 | 0x01);
1672
1673 /* A few vars need to be filled upon startup */
1674 for (i = 0; i < 3; i++) {
1675 data->fan_min[i] = w83781d_read_value(data,
1676 W83781D_REG_FAN_MIN(i));
1677 }
1678
1679 mutex_init(&data->update_lock);
1680 }
1681
1682 static struct w83781d_data *w83781d_update_device(struct device *dev)
1683 {
1684 struct w83781d_data *data = dev_get_drvdata(dev);
1685 struct i2c_client *client = &data->client;
1686 int i;
1687
1688 mutex_lock(&data->update_lock);
1689
1690 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
1691 || !data->valid) {
1692 dev_dbg(dev, "Starting device update\n");
1693
1694 for (i = 0; i <= 8; i++) {
1695 if (data->type == w83783s && i == 1)
1696 continue; /* 783S has no in1 */
1697 data->in[i] =
1698 w83781d_read_value(data, W83781D_REG_IN(i));
1699 data->in_min[i] =
1700 w83781d_read_value(data, W83781D_REG_IN_MIN(i));
1701 data->in_max[i] =
1702 w83781d_read_value(data, W83781D_REG_IN_MAX(i));
1703 if ((data->type != w83782d) && (i == 6))
1704 break;
1705 }
1706 for (i = 0; i < 3; i++) {
1707 data->fan[i] =
1708 w83781d_read_value(data, W83781D_REG_FAN(i));
1709 data->fan_min[i] =
1710 w83781d_read_value(data, W83781D_REG_FAN_MIN(i));
1711 }
1712 if (data->type != w83781d && data->type != as99127f) {
1713 for (i = 0; i < 4; i++) {
1714 data->pwm[i] =
1715 w83781d_read_value(data,
1716 W83781D_REG_PWM[i]);
1717 if ((data->type != w83782d || !client->driver)
1718 && i == 1)
1719 break;
1720 }
1721 /* Only PWM2 can be disabled */
1722 data->pwm2_enable = (w83781d_read_value(data,
1723 W83781D_REG_PWMCLK12) & 0x08) >> 3;
1724 }
1725
1726 data->temp = w83781d_read_value(data, W83781D_REG_TEMP(1));
1727 data->temp_max =
1728 w83781d_read_value(data, W83781D_REG_TEMP_OVER(1));
1729 data->temp_max_hyst =
1730 w83781d_read_value(data, W83781D_REG_TEMP_HYST(1));
1731 data->temp_add[0] =
1732 w83781d_read_value(data, W83781D_REG_TEMP(2));
1733 data->temp_max_add[0] =
1734 w83781d_read_value(data, W83781D_REG_TEMP_OVER(2));
1735 data->temp_max_hyst_add[0] =
1736 w83781d_read_value(data, W83781D_REG_TEMP_HYST(2));
1737 if (data->type != w83783s) {
1738 data->temp_add[1] =
1739 w83781d_read_value(data, W83781D_REG_TEMP(3));
1740 data->temp_max_add[1] =
1741 w83781d_read_value(data,
1742 W83781D_REG_TEMP_OVER(3));
1743 data->temp_max_hyst_add[1] =
1744 w83781d_read_value(data,
1745 W83781D_REG_TEMP_HYST(3));
1746 }
1747 i = w83781d_read_value(data, W83781D_REG_VID_FANDIV);
1748 data->vid = i & 0x0f;
1749 data->vid |= (w83781d_read_value(data,
1750 W83781D_REG_CHIPID) & 0x01) << 4;
1751 data->fan_div[0] = (i >> 4) & 0x03;
1752 data->fan_div[1] = (i >> 6) & 0x03;
1753 data->fan_div[2] = (w83781d_read_value(data,
1754 W83781D_REG_PIN) >> 6) & 0x03;
1755 if ((data->type != w83781d) && (data->type != as99127f)) {
1756 i = w83781d_read_value(data, W83781D_REG_VBAT);
1757 data->fan_div[0] |= (i >> 3) & 0x04;
1758 data->fan_div[1] |= (i >> 4) & 0x04;
1759 data->fan_div[2] |= (i >> 5) & 0x04;
1760 }
1761 if (data->type == w83782d) {
1762 data->alarms = w83781d_read_value(data,
1763 W83782D_REG_ALARM1)
1764 | (w83781d_read_value(data,
1765 W83782D_REG_ALARM2) << 8)
1766 | (w83781d_read_value(data,
1767 W83782D_REG_ALARM3) << 16);
1768 } else if (data->type == w83783s) {
1769 data->alarms = w83781d_read_value(data,
1770 W83782D_REG_ALARM1)
1771 | (w83781d_read_value(data,
1772 W83782D_REG_ALARM2) << 8);
1773 } else {
1774 /* No real-time status registers, fall back to
1775 interrupt status registers */
1776 data->alarms = w83781d_read_value(data,
1777 W83781D_REG_ALARM1)
1778 | (w83781d_read_value(data,
1779 W83781D_REG_ALARM2) << 8);
1780 }
1781 i = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
1782 data->beep_enable = i >> 7;
1783 data->beep_mask = ((i & 0x7f) << 8) +
1784 w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
1785 if ((data->type != w83781d) && (data->type != as99127f)) {
1786 data->beep_mask |=
1787 w83781d_read_value(data,
1788 W83781D_REG_BEEP_INTS3) << 16;
1789 }
1790 data->last_updated = jiffies;
1791 data->valid = 1;
1792 }
1793
1794 mutex_unlock(&data->update_lock);
1795
1796 return data;
1797 }
1798
1799 /* return 1 if a supported chip is found, 0 otherwise */
1800 static int __init
1801 w83781d_isa_found(unsigned short address)
1802 {
1803 int val, save, found = 0;
1804
1805 if (!request_region(address, W83781D_EXTENT, "w83781d"))
1806 return 0;
1807
1808 #define REALLY_SLOW_IO
1809 /* We need the timeouts for at least some W83781D-like
1810 chips. But only if we read 'undefined' registers. */
1811 val = inb_p(address + 1);
1812 if (inb_p(address + 2) != val
1813 || inb_p(address + 3) != val
1814 || inb_p(address + 7) != val) {
1815 pr_debug("w83781d: Detection failed at step 1\n");
1816 goto release;
1817 }
1818 #undef REALLY_SLOW_IO
1819
1820 /* We should be able to change the 7 LSB of the address port. The
1821 MSB (busy flag) should be clear initially, set after the write. */
1822 save = inb_p(address + W83781D_ADDR_REG_OFFSET);
1823 if (save & 0x80) {
1824 pr_debug("w83781d: Detection failed at step 2\n");
1825 goto release;
1826 }
1827 val = ~save & 0x7f;
1828 outb_p(val, address + W83781D_ADDR_REG_OFFSET);
1829 if (inb_p(address + W83781D_ADDR_REG_OFFSET) != (val | 0x80)) {
1830 outb_p(save, address + W83781D_ADDR_REG_OFFSET);
1831 pr_debug("w83781d: Detection failed at step 3\n");
1832 goto release;
1833 }
1834
1835 /* We found a device, now see if it could be a W83781D */
1836 outb_p(W83781D_REG_CONFIG, address + W83781D_ADDR_REG_OFFSET);
1837 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1838 if (val & 0x80) {
1839 pr_debug("w83781d: Detection failed at step 4\n");
1840 goto release;
1841 }
1842 outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
1843 save = inb_p(address + W83781D_DATA_REG_OFFSET);
1844 outb_p(W83781D_REG_CHIPMAN, address + W83781D_ADDR_REG_OFFSET);
1845 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1846 if ((!(save & 0x80) && (val != 0xa3))
1847 || ((save & 0x80) && (val != 0x5c))) {
1848 pr_debug("w83781d: Detection failed at step 5\n");
1849 goto release;
1850 }
1851 outb_p(W83781D_REG_I2C_ADDR, address + W83781D_ADDR_REG_OFFSET);
1852 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1853 if (val < 0x03 || val > 0x77) { /* Not a valid I2C address */
1854 pr_debug("w83781d: Detection failed at step 6\n");
1855 goto release;
1856 }
1857
1858 /* The busy flag should be clear again */
1859 if (inb_p(address + W83781D_ADDR_REG_OFFSET) & 0x80) {
1860 pr_debug("w83781d: Detection failed at step 7\n");
1861 goto release;
1862 }
1863
1864 /* Determine the chip type */
1865 outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
1866 save = inb_p(address + W83781D_DATA_REG_OFFSET);
1867 outb_p(save & 0xf8, address + W83781D_DATA_REG_OFFSET);
1868 outb_p(W83781D_REG_WCHIPID, address + W83781D_ADDR_REG_OFFSET);
1869 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1870 if ((val & 0xfe) == 0x10 /* W83781D */
1871 || val == 0x30) /* W83782D */
1872 found = 1;
1873
1874 if (found)
1875 pr_info("w83781d: Found a %s chip at %#x\n",
1876 val == 0x30 ? "W83782D" : "W83781D", (int)address);
1877
1878 release:
1879 release_region(address, W83781D_EXTENT);
1880 return found;
1881 }
1882
1883 static int __init
1884 w83781d_isa_device_add(unsigned short address)
1885 {
1886 struct resource res = {
1887 .start = address,
1888 .end = address + W83781D_EXTENT - 1,
1889 .name = "w83781d",
1890 .flags = IORESOURCE_IO,
1891 };
1892 int err;
1893
1894 pdev = platform_device_alloc("w83781d", address);
1895 if (!pdev) {
1896 err = -ENOMEM;
1897 printk(KERN_ERR "w83781d: Device allocation failed\n");
1898 goto exit;
1899 }
1900
1901 err = platform_device_add_resources(pdev, &res, 1);
1902 if (err) {
1903 printk(KERN_ERR "w83781d: Device resource addition failed "
1904 "(%d)\n", err);
1905 goto exit_device_put;
1906 }
1907
1908 err = platform_device_add(pdev);
1909 if (err) {
1910 printk(KERN_ERR "w83781d: Device addition failed (%d)\n",
1911 err);
1912 goto exit_device_put;
1913 }
1914
1915 return 0;
1916
1917 exit_device_put:
1918 platform_device_put(pdev);
1919 exit:
1920 pdev = NULL;
1921 return err;
1922 }
1923
1924 static int __init
1925 sensors_w83781d_init(void)
1926 {
1927 int res;
1928
1929 res = i2c_add_driver(&w83781d_driver);
1930 if (res)
1931 goto exit;
1932
1933 if (w83781d_isa_found(isa_address)) {
1934 res = platform_driver_register(&w83781d_isa_driver);
1935 if (res)
1936 goto exit_unreg_i2c_driver;
1937
1938 /* Sets global pdev as a side effect */
1939 res = w83781d_isa_device_add(isa_address);
1940 if (res)
1941 goto exit_unreg_isa_driver;
1942 }
1943
1944 return 0;
1945
1946 exit_unreg_isa_driver:
1947 platform_driver_unregister(&w83781d_isa_driver);
1948 exit_unreg_i2c_driver:
1949 i2c_del_driver(&w83781d_driver);
1950 exit:
1951 return res;
1952 }
1953
1954 static void __exit
1955 sensors_w83781d_exit(void)
1956 {
1957 if (pdev) {
1958 platform_device_unregister(pdev);
1959 platform_driver_unregister(&w83781d_isa_driver);
1960 }
1961 i2c_del_driver(&w83781d_driver);
1962 }
1963
1964 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
1965 "Philip Edelbrock <phil@netroedge.com>, "
1966 "and Mark Studebaker <mdsxyz123@yahoo.com>");
1967 MODULE_DESCRIPTION("W83781D driver");
1968 MODULE_LICENSE("GPL");
1969
1970 module_init(sensors_w83781d_init);
1971 module_exit(sensors_w83781d_exit);
Linux kernel - Deliverables
This page took 0.101244 seconds and 5 git commands to generate.