1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
37
38#include <linux/module.h>
39#include <linux/init.h>
40#include <linux/slab.h>
41#include <linux/jiffies.h>
42#include <linux/i2c.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
50#ifdef CONFIG_ISA
51#include <linux/platform_device.h>
52#include <linux/ioport.h>
53#include <linux/io.h>
54#endif
55
56#include "lm75.h"
57
58
59static const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d,
60 0x2e, 0x2f, I2C_CLIENT_END };
61
62enum chips { w83781d, w83782d, w83783s, as99127f };
63
64
65static unsigned short force_subclients[4];
66module_param_array(force_subclients, short, NULL, 0);
67MODULE_PARM_DESC(force_subclients, "List of subclient addresses: "
68 "{bus, clientaddr, subclientaddr1, subclientaddr2}");
69
70static bool reset;
71module_param(reset, bool, 0);
72MODULE_PARM_DESC(reset, "Set to one to reset chip on load");
73
74static bool init = 1;
75module_param(init, bool, 0);
76MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");
77
78
79
80
81#define W83781D_EXTENT 8
82
83
84#define W83781D_ADDR_REG_OFFSET 5
85#define W83781D_DATA_REG_OFFSET 6
86
87
88
89#define W83781D_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
90 (0x554 + (((nr) - 7) * 2)))
91#define W83781D_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
92 (0x555 + (((nr) - 7) * 2)))
93#define W83781D_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \
94 (0x550 + (nr) - 7))
95
96
97#define W83781D_REG_FAN_MIN(nr) (0x3b + (nr))
98#define W83781D_REG_FAN(nr) (0x28 + (nr))
99
100#define W83781D_REG_BANK 0x4E
101#define W83781D_REG_TEMP2_CONFIG 0x152
102#define W83781D_REG_TEMP3_CONFIG 0x252
103
104#define W83781D_REG_TEMP(nr) ((nr == 3) ? (0x0250) : \
105 ((nr == 2) ? (0x0150) : \
106 (0x27)))
107#define W83781D_REG_TEMP_HYST(nr) ((nr == 3) ? (0x253) : \
108 ((nr == 2) ? (0x153) : \
109 (0x3A)))
110#define W83781D_REG_TEMP_OVER(nr) ((nr == 3) ? (0x255) : \
111 ((nr == 2) ? (0x155) : \
112 (0x39)))
113
114#define W83781D_REG_CONFIG 0x40
115
116
117#define W83781D_REG_ALARM1 0x41
118#define W83781D_REG_ALARM2 0x42
119
120
121#define W83782D_REG_ALARM1 0x459
122#define W83782D_REG_ALARM2 0x45A
123#define W83782D_REG_ALARM3 0x45B
124
125#define W83781D_REG_BEEP_CONFIG 0x4D
126#define W83781D_REG_BEEP_INTS1 0x56
127#define W83781D_REG_BEEP_INTS2 0x57
128#define W83781D_REG_BEEP_INTS3 0x453
129
130#define W83781D_REG_VID_FANDIV 0x47
131
132#define W83781D_REG_CHIPID 0x49
133#define W83781D_REG_WCHIPID 0x58
134#define W83781D_REG_CHIPMAN 0x4F
135#define W83781D_REG_PIN 0x4B
136
137
138#define W83781D_REG_VBAT 0x5D
139
140
141static const u8 W83781D_REG_PWM[] = { 0x5B, 0x5A, 0x5E, 0x5F };
142#define W83781D_REG_PWMCLK12 0x5C
143#define W83781D_REG_PWMCLK34 0x45C
144
145#define W83781D_REG_I2C_ADDR 0x48
146#define W83781D_REG_I2C_SUBADDR 0x4A
147
148
149
150
151
152
153#define W83781D_REG_SCFG1 0x5D
154static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };
155
156#define W83781D_REG_SCFG2 0x59
157static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 };
158
159#define W83781D_DEFAULT_BETA 3435
160
161
162#define IN_TO_REG(val) SENSORS_LIMIT(((val) + 8) / 16, 0, 255)
163#define IN_FROM_REG(val) ((val) * 16)
164
165static inline u8
166FAN_TO_REG(long rpm, int div)
167{
168 if (rpm == 0)
169 return 255;
170 rpm = SENSORS_LIMIT(rpm, 1, 1000000);
171 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
172}
173
174static inline long
175FAN_FROM_REG(u8 val, int div)
176{
177 if (val == 0)
178 return -1;
179 if (val == 255)
180 return 0;
181 return 1350000 / (val * div);
182}
183
184#define TEMP_TO_REG(val) SENSORS_LIMIT((val) / 1000, -127, 128)
185#define TEMP_FROM_REG(val) ((val) * 1000)
186
187#define BEEP_MASK_FROM_REG(val, type) ((type) == as99127f ? \
188 (~(val)) & 0x7fff : (val) & 0xff7fff)
189#define BEEP_MASK_TO_REG(val, type) ((type) == as99127f ? \
190 (~(val)) & 0x7fff : (val) & 0xff7fff)
191
192#define DIV_FROM_REG(val) (1 << (val))
193
194static inline u8
195DIV_TO_REG(long val, enum chips type)
196{
197 int i;
198 val = SENSORS_LIMIT(val, 1,
199 ((type == w83781d
200 || type == as99127f) ? 8 : 128)) >> 1;
201 for (i = 0; i < 7; i++) {
202 if (val == 0)
203 break;
204 val >>= 1;
205 }
206 return i;
207}
208
209struct w83781d_data {
210 struct i2c_client *client;
211 struct device *hwmon_dev;
212 struct mutex lock;
213 enum chips type;
214
215
216 const char *name;
217 int isa_addr;
218
219 struct mutex update_lock;
220 char valid;
221 unsigned long last_updated;
222
223 struct i2c_client *lm75[2];
224
225
226 u8 in[9];
227 u8 in_max[9];
228 u8 in_min[9];
229 u8 fan[3];
230 u8 fan_min[3];
231 s8 temp;
232 s8 temp_max;
233 s8 temp_max_hyst;
234 u16 temp_add[2];
235 u16 temp_max_add[2];
236 u16 temp_max_hyst_add[2];
237 u8 fan_div[3];
238 u8 vid;
239 u32 alarms;
240 u32 beep_mask;
241 u8 pwm[4];
242 u8 pwm2_enable;
243 u16 sens[3];
244
245
246
247
248 u8 vrm;
249};
250
251static struct w83781d_data *w83781d_data_if_isa(void);
252static int w83781d_alias_detect(struct i2c_client *client, u8 chipid);
253
254static int w83781d_read_value(struct w83781d_data *data, u16 reg);
255static int w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value);
256static struct w83781d_data *w83781d_update_device(struct device *dev);
257static void w83781d_init_device(struct device *dev);
258
259
260#define show_in_reg(reg) \
261static ssize_t show_##reg(struct device *dev, struct device_attribute *da, \
262 char *buf) \
263{ \
264 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
265 struct w83781d_data *data = w83781d_update_device(dev); \
266 return sprintf(buf, "%ld\n", \
267 (long)IN_FROM_REG(data->reg[attr->index])); \
268}
269show_in_reg(in);
270show_in_reg(in_min);
271show_in_reg(in_max);
272
273#define store_in_reg(REG, reg) \
274static ssize_t store_in_##reg(struct device *dev, struct device_attribute \
275 *da, const char *buf, size_t count) \
276{ \
277 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
278 struct w83781d_data *data = dev_get_drvdata(dev); \
279 int nr = attr->index; \
280 unsigned long val; \
281 int err = kstrtoul(buf, 10, &val); \
282 if (err) \
283 return err; \
284 mutex_lock(&data->update_lock); \
285 data->in_##reg[nr] = IN_TO_REG(val); \
286 w83781d_write_value(data, W83781D_REG_IN_##REG(nr), \
287 data->in_##reg[nr]); \
288 \
289 mutex_unlock(&data->update_lock); \
290 return count; \
291}
292store_in_reg(MIN, min);
293store_in_reg(MAX, max);
294
295#define sysfs_in_offsets(offset) \
296static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
297 show_in, NULL, offset); \
298static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
299 show_in_min, store_in_min, offset); \
300static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
301 show_in_max, store_in_max, offset)
302
303sysfs_in_offsets(0);
304sysfs_in_offsets(1);
305sysfs_in_offsets(2);
306sysfs_in_offsets(3);
307sysfs_in_offsets(4);
308sysfs_in_offsets(5);
309sysfs_in_offsets(6);
310sysfs_in_offsets(7);
311sysfs_in_offsets(8);
312
313#define show_fan_reg(reg) \
314static ssize_t show_##reg(struct device *dev, struct device_attribute *da, \
315 char *buf) \
316{ \
317 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
318 struct w83781d_data *data = w83781d_update_device(dev); \
319 return sprintf(buf, "%ld\n", \
320 FAN_FROM_REG(data->reg[attr->index], \
321 DIV_FROM_REG(data->fan_div[attr->index]))); \
322}
323show_fan_reg(fan);
324show_fan_reg(fan_min);
325
326static ssize_t
327store_fan_min(struct device *dev, struct device_attribute *da,
328 const char *buf, size_t count)
329{
330 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
331 struct w83781d_data *data = dev_get_drvdata(dev);
332 int nr = attr->index;
333 unsigned long val;
334 int err;
335
336 err = kstrtoul(buf, 10, &val);
337 if (err)
338 return err;
339
340 mutex_lock(&data->update_lock);
341 data->fan_min[nr] =
342 FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
343 w83781d_write_value(data, W83781D_REG_FAN_MIN(nr),
344 data->fan_min[nr]);
345
346 mutex_unlock(&data->update_lock);
347 return count;
348}
349
350static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
351static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR,
352 show_fan_min, store_fan_min, 0);
353static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
354static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR,
355 show_fan_min, store_fan_min, 1);
356static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
357static SENSOR_DEVICE_ATTR(fan3_min, S_IRUGO | S_IWUSR,
358 show_fan_min, store_fan_min, 2);
359
360#define show_temp_reg(reg) \
361static ssize_t show_##reg(struct device *dev, struct device_attribute *da, \
362 char *buf) \
363{ \
364 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
365 struct w83781d_data *data = w83781d_update_device(dev); \
366 int nr = attr->index; \
367 if (nr >= 2) { \
368 return sprintf(buf, "%d\n", \
369 LM75_TEMP_FROM_REG(data->reg##_add[nr-2])); \
370 } else { \
371 return sprintf(buf, "%ld\n", (long)TEMP_FROM_REG(data->reg)); \
372 } \
373}
374show_temp_reg(temp);
375show_temp_reg(temp_max);
376show_temp_reg(temp_max_hyst);
377
378#define store_temp_reg(REG, reg) \
379static ssize_t store_temp_##reg(struct device *dev, \
380 struct device_attribute *da, const char *buf, size_t count) \
381{ \
382 struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
383 struct w83781d_data *data = dev_get_drvdata(dev); \
384 int nr = attr->index; \
385 long val; \
386 int err = kstrtol(buf, 10, &val); \
387 if (err) \
388 return err; \
389 mutex_lock(&data->update_lock); \
390 \
391 if (nr >= 2) { \
392 data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \
393 w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
394 data->temp_##reg##_add[nr-2]); \
395 } else { \
396 data->temp_##reg = TEMP_TO_REG(val); \
397 w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
398 data->temp_##reg); \
399 } \
400 \
401 mutex_unlock(&data->update_lock); \
402 return count; \
403}
404store_temp_reg(OVER, max);
405store_temp_reg(HYST, max_hyst);
406
407#define sysfs_temp_offsets(offset) \
408static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
409 show_temp, NULL, offset); \
410static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
411 show_temp_max, store_temp_max, offset); \
412static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR, \
413 show_temp_max_hyst, store_temp_max_hyst, offset);
414
415sysfs_temp_offsets(1);
416sysfs_temp_offsets(2);
417sysfs_temp_offsets(3);
418
419static ssize_t
420show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf)
421{
422 struct w83781d_data *data = w83781d_update_device(dev);
423 return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
424}
425
426static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);
427
428static ssize_t
429show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf)
430{
431 struct w83781d_data *data = dev_get_drvdata(dev);
432 return sprintf(buf, "%ld\n", (long) data->vrm);
433}
434
435static ssize_t
436store_vrm_reg(struct device *dev, struct device_attribute *attr,
437 const char *buf, size_t count)
438{
439 struct w83781d_data *data = dev_get_drvdata(dev);
440 unsigned long val;
441 int err;
442
443 err = kstrtoul(buf, 10, &val);
444 if (err)
445 return err;
446 data->vrm = SENSORS_LIMIT(val, 0, 255);
447
448 return count;
449}
450
451static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);
452
453static ssize_t
454show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf)
455{
456 struct w83781d_data *data = w83781d_update_device(dev);
457 return sprintf(buf, "%u\n", data->alarms);
458}
459
460static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);
461
462static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
463 char *buf)
464{
465 struct w83781d_data *data = w83781d_update_device(dev);
466 int bitnr = to_sensor_dev_attr(attr)->index;
467 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
468}
469
470
471static ssize_t show_temp3_alarm(struct device *dev,
472 struct device_attribute *attr, char *buf)
473{
474 struct w83781d_data *data = w83781d_update_device(dev);
475 int bitnr = (data->type == w83781d) ? 5 : 13;
476 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
477}
478
479static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
480static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
481static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
482static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
483static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
484static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
485static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
486static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16);
487static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17);
488static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
489static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
490static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
491static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
492static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
493static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_temp3_alarm, NULL, 0);
494
495static ssize_t show_beep_mask(struct device *dev,
496 struct device_attribute *attr, char *buf)
497{
498 struct w83781d_data *data = w83781d_update_device(dev);
499 return sprintf(buf, "%ld\n",
500 (long)BEEP_MASK_FROM_REG(data->beep_mask, data->type));
501}
502
503static ssize_t
504store_beep_mask(struct device *dev, struct device_attribute *attr,
505 const char *buf, size_t count)
506{
507 struct w83781d_data *data = dev_get_drvdata(dev);
508 unsigned long val;
509 int err;
510
511 err = kstrtoul(buf, 10, &val);
512 if (err)
513 return err;
514
515 mutex_lock(&data->update_lock);
516 data->beep_mask &= 0x8000;
517 data->beep_mask |= BEEP_MASK_TO_REG(val, data->type);
518 w83781d_write_value(data, W83781D_REG_BEEP_INTS1,
519 data->beep_mask & 0xff);
520 w83781d_write_value(data, W83781D_REG_BEEP_INTS2,
521 (data->beep_mask >> 8) & 0xff);
522 if (data->type != w83781d && data->type != as99127f) {
523 w83781d_write_value(data, W83781D_REG_BEEP_INTS3,
524 ((data->beep_mask) >> 16) & 0xff);
525 }
526 mutex_unlock(&data->update_lock);
527
528 return count;
529}
530
531static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR,
532 show_beep_mask, store_beep_mask);
533
534static ssize_t show_beep(struct device *dev, struct device_attribute *attr,
535 char *buf)
536{
537 struct w83781d_data *data = w83781d_update_device(dev);
538 int bitnr = to_sensor_dev_attr(attr)->index;
539 return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
540}
541
542static ssize_t
543store_beep(struct device *dev, struct device_attribute *attr,
544 const char *buf, size_t count)
545{
546 struct w83781d_data *data = dev_get_drvdata(dev);
547 int bitnr = to_sensor_dev_attr(attr)->index;
548 u8 reg;
549 unsigned long bit;
550 int err;
551
552 err = kstrtoul(buf, 10, &bit);
553 if (err)
554 return err;
555
556 if (bit & ~1)
557 return -EINVAL;
558
559 mutex_lock(&data->update_lock);
560 if (bit)
561 data->beep_mask |= (1 << bitnr);
562 else
563 data->beep_mask &= ~(1 << bitnr);
564
565 if (bitnr < 8) {
566 reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
567 if (bit)
568 reg |= (1 << bitnr);
569 else
570 reg &= ~(1 << bitnr);
571 w83781d_write_value(data, W83781D_REG_BEEP_INTS1, reg);
572 } else if (bitnr < 16) {
573 reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
574 if (bit)
575 reg |= (1 << (bitnr - 8));
576 else
577 reg &= ~(1 << (bitnr - 8));
578 w83781d_write_value(data, W83781D_REG_BEEP_INTS2, reg);
579 } else {
580 reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS3);
581 if (bit)
582 reg |= (1 << (bitnr - 16));
583 else
584 reg &= ~(1 << (bitnr - 16));
585 w83781d_write_value(data, W83781D_REG_BEEP_INTS3, reg);
586 }
587 mutex_unlock(&data->update_lock);
588
589 return count;
590}
591
592
593static ssize_t show_temp3_beep(struct device *dev,
594 struct device_attribute *attr, char *buf)
595{
596 struct w83781d_data *data = w83781d_update_device(dev);
597 int bitnr = (data->type == w83781d) ? 5 : 13;
598 return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
599}
600
601static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR,
602 show_beep, store_beep, 0);
603static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR,
604 show_beep, store_beep, 1);
605static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR,
606 show_beep, store_beep, 2);
607static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR,
608 show_beep, store_beep, 3);
609static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR,
610 show_beep, store_beep, 8);
611static SENSOR_DEVICE_ATTR(in5_beep, S_IRUGO | S_IWUSR,
612 show_beep, store_beep, 9);
613static SENSOR_DEVICE_ATTR(in6_beep, S_IRUGO | S_IWUSR,
614 show_beep, store_beep, 10);
615static SENSOR_DEVICE_ATTR(in7_beep, S_IRUGO | S_IWUSR,
616 show_beep, store_beep, 16);
617static SENSOR_DEVICE_ATTR(in8_beep, S_IRUGO | S_IWUSR,
618 show_beep, store_beep, 17);
619static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR,
620 show_beep, store_beep, 6);
621static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR,
622 show_beep, store_beep, 7);
623static SENSOR_DEVICE_ATTR(fan3_beep, S_IRUGO | S_IWUSR,
624 show_beep, store_beep, 11);
625static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR,
626 show_beep, store_beep, 4);
627static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR,
628 show_beep, store_beep, 5);
629static SENSOR_DEVICE_ATTR(temp3_beep, S_IRUGO,
630 show_temp3_beep, store_beep, 13);
631static SENSOR_DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR,
632 show_beep, store_beep, 15);
633
634static ssize_t
635show_fan_div(struct device *dev, struct device_attribute *da, char *buf)
636{
637 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
638 struct w83781d_data *data = w83781d_update_device(dev);
639 return sprintf(buf, "%ld\n",
640 (long) DIV_FROM_REG(data->fan_div[attr->index]));
641}
642
643
644
645
646
647
648
649static ssize_t
650store_fan_div(struct device *dev, struct device_attribute *da,
651 const char *buf, size_t count)
652{
653 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
654 struct w83781d_data *data = dev_get_drvdata(dev);
655 unsigned long min;
656 int nr = attr->index;
657 u8 reg;
658 unsigned long val;
659 int err;
660
661 err = kstrtoul(buf, 10, &val);
662 if (err)
663 return err;
664
665 mutex_lock(&data->update_lock);
666
667
668 min = FAN_FROM_REG(data->fan_min[nr],
669 DIV_FROM_REG(data->fan_div[nr]));
670
671 data->fan_div[nr] = DIV_TO_REG(val, data->type);
672
673 reg = (w83781d_read_value(data, nr == 2 ?
674 W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
675 & (nr == 0 ? 0xcf : 0x3f))
676 | ((data->fan_div[nr] & 0x03) << (nr == 0 ? 4 : 6));
677 w83781d_write_value(data, nr == 2 ?
678 W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
679
680
681 if (data->type != w83781d && data->type != as99127f) {
682 reg = (w83781d_read_value(data, W83781D_REG_VBAT)
683 & ~(1 << (5 + nr)))
684 | ((data->fan_div[nr] & 0x04) << (3 + nr));
685 w83781d_write_value(data, W83781D_REG_VBAT, reg);
686 }
687
688
689 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
690 w83781d_write_value(data, W83781D_REG_FAN_MIN(nr), data->fan_min[nr]);
691
692 mutex_unlock(&data->update_lock);
693 return count;
694}
695
696static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
697 show_fan_div, store_fan_div, 0);
698static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
699 show_fan_div, store_fan_div, 1);
700static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO | S_IWUSR,
701 show_fan_div, store_fan_div, 2);
702
703static ssize_t
704show_pwm(struct device *dev, struct device_attribute *da, char *buf)
705{
706 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
707 struct w83781d_data *data = w83781d_update_device(dev);
708 return sprintf(buf, "%d\n", (int)data->pwm[attr->index]);
709}
710
711static ssize_t
712show_pwm2_enable(struct device *dev, struct device_attribute *da, char *buf)
713{
714 struct w83781d_data *data = w83781d_update_device(dev);
715 return sprintf(buf, "%d\n", (int)data->pwm2_enable);
716}
717
718static ssize_t
719store_pwm(struct device *dev, struct device_attribute *da, const char *buf,
720 size_t count)
721{
722 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
723 struct w83781d_data *data = dev_get_drvdata(dev);
724 int nr = attr->index;
725 unsigned long val;
726 int err;
727
728 err = kstrtoul(buf, 10, &val);
729 if (err)
730 return err;
731
732 mutex_lock(&data->update_lock);
733 data->pwm[nr] = SENSORS_LIMIT(val, 0, 255);
734 w83781d_write_value(data, W83781D_REG_PWM[nr], data->pwm[nr]);
735 mutex_unlock(&data->update_lock);
736 return count;
737}
738
739static ssize_t
740store_pwm2_enable(struct device *dev, struct device_attribute *da,
741 const char *buf, size_t count)
742{
743 struct w83781d_data *data = dev_get_drvdata(dev);
744 unsigned long val;
745 u32 reg;
746 int err;
747
748 err = kstrtoul(buf, 10, &val);
749 if (err)
750 return err;
751
752 mutex_lock(&data->update_lock);
753
754 switch (val) {
755 case 0:
756 case 1:
757 reg = w83781d_read_value(data, W83781D_REG_PWMCLK12);
758 w83781d_write_value(data, W83781D_REG_PWMCLK12,
759 (reg & 0xf7) | (val << 3));
760
761 reg = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
762 w83781d_write_value(data, W83781D_REG_BEEP_CONFIG,
763 (reg & 0xef) | (!val << 4));
764
765 data->pwm2_enable = val;
766 break;
767
768 default:
769 mutex_unlock(&data->update_lock);
770 return -EINVAL;
771 }
772
773 mutex_unlock(&data->update_lock);
774 return count;
775}
776
777static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 0);
778static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 1);
779static SENSOR_DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 2);
780static SENSOR_DEVICE_ATTR(pwm4, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 3);
781
782static DEVICE_ATTR(pwm2_enable, S_IRUGO | S_IWUSR,
783 show_pwm2_enable, store_pwm2_enable);
784
785static ssize_t
786show_sensor(struct device *dev, struct device_attribute *da, char *buf)
787{
788 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
789 struct w83781d_data *data = w83781d_update_device(dev);
790 return sprintf(buf, "%d\n", (int)data->sens[attr->index]);
791}
792
793static ssize_t
794store_sensor(struct device *dev, struct device_attribute *da,
795 const char *buf, size_t count)
796{
797 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
798 struct w83781d_data *data = dev_get_drvdata(dev);
799 int nr = attr->index;
800 unsigned long val;
801 u32 tmp;
802 int err;
803
804 err = kstrtoul(buf, 10, &val);
805 if (err)
806 return err;
807
808 mutex_lock(&data->update_lock);
809
810 switch (val) {
811 case 1:
812 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
813 w83781d_write_value(data, W83781D_REG_SCFG1,
814 tmp | BIT_SCFG1[nr]);
815 tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
816 w83781d_write_value(data, W83781D_REG_SCFG2,
817 tmp | BIT_SCFG2[nr]);
818 data->sens[nr] = val;
819 break;
820 case 2:
821 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
822 w83781d_write_value(data, W83781D_REG_SCFG1,
823 tmp | BIT_SCFG1[nr]);
824 tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
825 w83781d_write_value(data, W83781D_REG_SCFG2,
826 tmp & ~BIT_SCFG2[nr]);
827 data->sens[nr] = val;
828 break;
829 case W83781D_DEFAULT_BETA:
830 dev_warn(dev, "Sensor type %d is deprecated, please use 4 "
831 "instead\n", W83781D_DEFAULT_BETA);
832
833 case 4:
834 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
835 w83781d_write_value(data, W83781D_REG_SCFG1,
836 tmp & ~BIT_SCFG1[nr]);
837 data->sens[nr] = val;
838 break;
839 default:
840 dev_err(dev, "Invalid sensor type %ld; must be 1, 2, or 4\n",
841 (long) val);
842 break;
843 }
844
845 mutex_unlock(&data->update_lock);
846 return count;
847}
848
849static SENSOR_DEVICE_ATTR(temp1_type, S_IRUGO | S_IWUSR,
850 show_sensor, store_sensor, 0);
851static SENSOR_DEVICE_ATTR(temp2_type, S_IRUGO | S_IWUSR,
852 show_sensor, store_sensor, 1);
853static SENSOR_DEVICE_ATTR(temp3_type, S_IRUGO | S_IWUSR,
854 show_sensor, store_sensor, 2);
855
856
857
858
859
860static int
861w83781d_detect_subclients(struct i2c_client *new_client)
862{
863 int i, val1 = 0, id;
864 int err;
865 int address = new_client->addr;
866 unsigned short sc_addr[2];
867 struct i2c_adapter *adapter = new_client->adapter;
868 struct w83781d_data *data = i2c_get_clientdata(new_client);
869 enum chips kind = data->type;
870 int num_sc = 1;
871
872 id = i2c_adapter_id(adapter);
873
874 if (force_subclients[0] == id && force_subclients[1] == address) {
875 for (i = 2; i <= 3; i++) {
876 if (force_subclients[i] < 0x48 ||
877 force_subclients[i] > 0x4f) {
878 dev_err(&new_client->dev, "Invalid subclient "
879 "address %d; must be 0x48-0x4f\n",
880 force_subclients[i]);
881 err = -EINVAL;
882 goto ERROR_SC_1;
883 }
884 }
885 w83781d_write_value(data, W83781D_REG_I2C_SUBADDR,
886 (force_subclients[2] & 0x07) |
887 ((force_subclients[3] & 0x07) << 4));
888 sc_addr[0] = force_subclients[2];
889 } else {
890 val1 = w83781d_read_value(data, W83781D_REG_I2C_SUBADDR);
891 sc_addr[0] = 0x48 + (val1 & 0x07);
892 }
893
894 if (kind != w83783s) {
895 num_sc = 2;
896 if (force_subclients[0] == id &&
897 force_subclients[1] == address) {
898 sc_addr[1] = force_subclients[3];
899 } else {
900 sc_addr[1] = 0x48 + ((val1 >> 4) & 0x07);
901 }
902 if (sc_addr[0] == sc_addr[1]) {
903 dev_err(&new_client->dev,
904 "Duplicate addresses 0x%x for subclients.\n",
905 sc_addr[0]);
906 err = -EBUSY;
907 goto ERROR_SC_2;
908 }
909 }
910
911 for (i = 0; i < num_sc; i++) {
912 data->lm75[i] = i2c_new_dummy(adapter, sc_addr[i]);
913 if (!data->lm75[i]) {
914 dev_err(&new_client->dev, "Subclient %d "
915 "registration at address 0x%x "
916 "failed.\n", i, sc_addr[i]);
917 err = -ENOMEM;
918 if (i == 1)
919 goto ERROR_SC_3;
920 goto ERROR_SC_2;
921 }
922 }
923
924 return 0;
925
926
927ERROR_SC_3:
928 i2c_unregister_device(data->lm75[0]);
929ERROR_SC_2:
930ERROR_SC_1:
931 return err;
932}
933
934#define IN_UNIT_ATTRS(X) \
935 &sensor_dev_attr_in##X##_input.dev_attr.attr, \
936 &sensor_dev_attr_in##X##_min.dev_attr.attr, \
937 &sensor_dev_attr_in##X##_max.dev_attr.attr, \
938 &sensor_dev_attr_in##X##_alarm.dev_attr.attr, \
939 &sensor_dev_attr_in##X##_beep.dev_attr.attr
940
941#define FAN_UNIT_ATTRS(X) \
942 &sensor_dev_attr_fan##X##_input.dev_attr.attr, \
943 &sensor_dev_attr_fan##X##_min.dev_attr.attr, \
944 &sensor_dev_attr_fan##X##_div.dev_attr.attr, \
945 &sensor_dev_attr_fan##X##_alarm.dev_attr.attr, \
946 &sensor_dev_attr_fan##X##_beep.dev_attr.attr
947
948#define TEMP_UNIT_ATTRS(X) \
949 &sensor_dev_attr_temp##X##_input.dev_attr.attr, \
950 &sensor_dev_attr_temp##X##_max.dev_attr.attr, \
951 &sensor_dev_attr_temp##X##_max_hyst.dev_attr.attr, \
952 &sensor_dev_attr_temp##X##_alarm.dev_attr.attr, \
953 &sensor_dev_attr_temp##X##_beep.dev_attr.attr
954
955static struct attribute *w83781d_attributes[] = {
956 IN_UNIT_ATTRS(0),
957 IN_UNIT_ATTRS(2),
958 IN_UNIT_ATTRS(3),
959 IN_UNIT_ATTRS(4),
960 IN_UNIT_ATTRS(5),
961 IN_UNIT_ATTRS(6),
962 FAN_UNIT_ATTRS(1),
963 FAN_UNIT_ATTRS(2),
964 FAN_UNIT_ATTRS(3),
965 TEMP_UNIT_ATTRS(1),
966 TEMP_UNIT_ATTRS(2),
967 &dev_attr_cpu0_vid.attr,
968 &dev_attr_vrm.attr,
969 &dev_attr_alarms.attr,
970 &dev_attr_beep_mask.attr,
971 &sensor_dev_attr_beep_enable.dev_attr.attr,
972 NULL
973};
974static const struct attribute_group w83781d_group = {
975 .attrs = w83781d_attributes,
976};
977
978static struct attribute *w83781d_attributes_in1[] = {
979 IN_UNIT_ATTRS(1),
980 NULL
981};
982static const struct attribute_group w83781d_group_in1 = {
983 .attrs = w83781d_attributes_in1,
984};
985
986static struct attribute *w83781d_attributes_in78[] = {
987 IN_UNIT_ATTRS(7),
988 IN_UNIT_ATTRS(8),
989 NULL
990};
991static const struct attribute_group w83781d_group_in78 = {
992 .attrs = w83781d_attributes_in78,
993};
994
995static struct attribute *w83781d_attributes_temp3[] = {
996 TEMP_UNIT_ATTRS(3),
997 NULL
998};
999static const struct attribute_group w83781d_group_temp3 = {
1000 .attrs = w83781d_attributes_temp3,
1001};
1002
1003static struct attribute *w83781d_attributes_pwm12[] = {
1004 &sensor_dev_attr_pwm1.dev_attr.attr,
1005 &sensor_dev_attr_pwm2.dev_attr.attr,
1006 &dev_attr_pwm2_enable.attr,
1007 NULL
1008};
1009static const struct attribute_group w83781d_group_pwm12 = {
1010 .attrs = w83781d_attributes_pwm12,
1011};
1012
1013static struct attribute *w83781d_attributes_pwm34[] = {
1014 &sensor_dev_attr_pwm3.dev_attr.attr,
1015 &sensor_dev_attr_pwm4.dev_attr.attr,
1016 NULL
1017};
1018static const struct attribute_group w83781d_group_pwm34 = {
1019 .attrs = w83781d_attributes_pwm34,
1020};
1021
1022static struct attribute *w83781d_attributes_other[] = {
1023 &sensor_dev_attr_temp1_type.dev_attr.attr,
1024 &sensor_dev_attr_temp2_type.dev_attr.attr,
1025 &sensor_dev_attr_temp3_type.dev_attr.attr,
1026 NULL
1027};
1028static const struct attribute_group w83781d_group_other = {
1029 .attrs = w83781d_attributes_other,
1030};
1031
1032
1033static int
1034w83781d_create_files(struct device *dev, int kind, int is_isa)
1035{
1036 int err;
1037
1038 err = sysfs_create_group(&dev->kobj, &w83781d_group);
1039 if (err)
1040 return err;
1041
1042 if (kind != w83783s) {
1043 err = sysfs_create_group(&dev->kobj, &w83781d_group_in1);
1044 if (err)
1045 return err;
1046 }
1047 if (kind != as99127f && kind != w83781d && kind != w83783s) {
1048 err = sysfs_create_group(&dev->kobj, &w83781d_group_in78);
1049 if (err)
1050 return err;
1051 }
1052 if (kind != w83783s) {
1053 err = sysfs_create_group(&dev->kobj, &w83781d_group_temp3);
1054 if (err)
1055 return err;
1056
1057 if (kind != w83781d) {
1058 err = sysfs_chmod_file(&dev->kobj,
1059 &sensor_dev_attr_temp3_alarm.dev_attr.attr,
1060 S_IRUGO | S_IWUSR);
1061 if (err)
1062 return err;
1063 }
1064 }
1065
1066 if (kind != w83781d && kind != as99127f) {
1067 err = sysfs_create_group(&dev->kobj, &w83781d_group_pwm12);
1068 if (err)
1069 return err;
1070 }
1071 if (kind == w83782d && !is_isa) {
1072 err = sysfs_create_group(&dev->kobj, &w83781d_group_pwm34);
1073 if (err)
1074 return err;
1075 }
1076
1077 if (kind != as99127f && kind != w83781d) {
1078 err = device_create_file(dev,
1079 &sensor_dev_attr_temp1_type.dev_attr);
1080 if (err)
1081 return err;
1082 err = device_create_file(dev,
1083 &sensor_dev_attr_temp2_type.dev_attr);
1084 if (err)
1085 return err;
1086 if (kind != w83783s) {
1087 err = device_create_file(dev,
1088 &sensor_dev_attr_temp3_type.dev_attr);
1089 if (err)
1090 return err;
1091 }
1092 }
1093
1094 return 0;
1095}
1096
1097
1098static int
1099w83781d_detect(struct i2c_client *client, struct i2c_board_info *info)
1100{
1101 int val1, val2;
1102 struct w83781d_data *isa = w83781d_data_if_isa();
1103 struct i2c_adapter *adapter = client->adapter;
1104 int address = client->addr;
1105 const char *client_name;
1106 enum vendor { winbond, asus } vendid;
1107
1108 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1109 return -ENODEV;
1110
1111
1112
1113
1114
1115
1116 if (isa)
1117 mutex_lock(&isa->update_lock);
1118
1119 if (i2c_smbus_read_byte_data(client, W83781D_REG_CONFIG) & 0x80) {
1120 dev_dbg(&adapter->dev,
1121 "Detection of w83781d chip failed at step 3\n");
1122 goto err_nodev;
1123 }
1124
1125 val1 = i2c_smbus_read_byte_data(client, W83781D_REG_BANK);
1126 val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN);
1127
1128 if (!(val1 & 0x07) &&
1129 ((!(val1 & 0x80) && val2 != 0xa3 && val2 != 0xc3) ||
1130 ((val1 & 0x80) && val2 != 0x5c && val2 != 0x12))) {
1131 dev_dbg(&adapter->dev,
1132 "Detection of w83781d chip failed at step 4\n");
1133 goto err_nodev;
1134 }
1135
1136
1137
1138
1139 if ((!(val1 & 0x80) && val2 == 0xa3) ||
1140 ((val1 & 0x80) && val2 == 0x5c)) {
1141 if (i2c_smbus_read_byte_data(client, W83781D_REG_I2C_ADDR)
1142 != address) {
1143 dev_dbg(&adapter->dev,
1144 "Detection of w83781d chip failed at step 5\n");
1145 goto err_nodev;
1146 }
1147 }
1148
1149
1150 i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
1151 (i2c_smbus_read_byte_data(client, W83781D_REG_BANK)
1152 & 0x78) | 0x80);
1153
1154
1155 val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN);
1156 if (val2 == 0x5c)
1157 vendid = winbond;
1158 else if (val2 == 0x12)
1159 vendid = asus;
1160 else {
1161 dev_dbg(&adapter->dev,
1162 "w83781d chip vendor is neither Winbond nor Asus\n");
1163 goto err_nodev;
1164 }
1165
1166
1167 val1 = i2c_smbus_read_byte_data(client, W83781D_REG_WCHIPID);
1168 if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond)
1169 client_name = "w83781d";
1170 else if (val1 == 0x30 && vendid == winbond)
1171 client_name = "w83782d";
1172 else if (val1 == 0x40 && vendid == winbond && address == 0x2d)
1173 client_name = "w83783s";
1174 else if (val1 == 0x31)
1175 client_name = "as99127f";
1176 else
1177 goto err_nodev;
1178
1179 if (val1 <= 0x30 && w83781d_alias_detect(client, val1)) {
1180 dev_dbg(&adapter->dev, "Device at 0x%02x appears to "
1181 "be the same as ISA device\n", address);
1182 goto err_nodev;
1183 }
1184
1185 if (isa)
1186 mutex_unlock(&isa->update_lock);
1187
1188 strlcpy(info->type, client_name, I2C_NAME_SIZE);
1189
1190 return 0;
1191
1192 err_nodev:
1193 if (isa)
1194 mutex_unlock(&isa->update_lock);
1195 return -ENODEV;
1196}
1197
1198static void w83781d_remove_files(struct device *dev)
1199{
1200 sysfs_remove_group(&dev->kobj, &w83781d_group);
1201 sysfs_remove_group(&dev->kobj, &w83781d_group_in1);
1202 sysfs_remove_group(&dev->kobj, &w83781d_group_in78);
1203 sysfs_remove_group(&dev->kobj, &w83781d_group_temp3);
1204 sysfs_remove_group(&dev->kobj, &w83781d_group_pwm12);
1205 sysfs_remove_group(&dev->kobj, &w83781d_group_pwm34);
1206 sysfs_remove_group(&dev->kobj, &w83781d_group_other);
1207}
1208
1209static int
1210w83781d_probe(struct i2c_client *client, const struct i2c_device_id *id)
1211{
1212 struct device *dev = &client->dev;
1213 struct w83781d_data *data;
1214 int err;
1215
1216 data = devm_kzalloc(dev, sizeof(struct w83781d_data), GFP_KERNEL);
1217 if (!data)
1218 return -ENOMEM;
1219
1220 i2c_set_clientdata(client, data);
1221 mutex_init(&data->lock);
1222 mutex_init(&data->update_lock);
1223
1224 data->type = id->driver_data;
1225 data->client = client;
1226
1227
1228 err = w83781d_detect_subclients(client);
1229 if (err)
1230 return err;
1231
1232
1233 w83781d_init_device(dev);
1234
1235
1236 err = w83781d_create_files(dev, data->type, 0);
1237 if (err)
1238 goto exit_remove_files;
1239
1240 data->hwmon_dev = hwmon_device_register(dev);
1241 if (IS_ERR(data->hwmon_dev)) {
1242 err = PTR_ERR(data->hwmon_dev);
1243 goto exit_remove_files;
1244 }
1245
1246 return 0;
1247
1248 exit_remove_files:
1249 w83781d_remove_files(dev);
1250 if (data->lm75[0])
1251 i2c_unregister_device(data->lm75[0]);
1252 if (data->lm75[1])
1253 i2c_unregister_device(data->lm75[1]);
1254 return err;
1255}
1256
1257static int
1258w83781d_remove(struct i2c_client *client)
1259{
1260 struct w83781d_data *data = i2c_get_clientdata(client);
1261 struct device *dev = &client->dev;
1262
1263 hwmon_device_unregister(data->hwmon_dev);
1264 w83781d_remove_files(dev);
1265
1266 if (data->lm75[0])
1267 i2c_unregister_device(data->lm75[0]);
1268 if (data->lm75[1])
1269 i2c_unregister_device(data->lm75[1]);
1270
1271 return 0;
1272}
1273
1274static int
1275w83781d_read_value_i2c(struct w83781d_data *data, u16 reg)
1276{
1277 struct i2c_client *client = data->client;
1278 int res, bank;
1279 struct i2c_client *cl;
1280
1281 bank = (reg >> 8) & 0x0f;
1282 if (bank > 2)
1283
1284 i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
1285 bank);
1286 if (bank == 0 || bank > 2) {
1287 res = i2c_smbus_read_byte_data(client, reg & 0xff);
1288 } else {
1289
1290 cl = data->lm75[bank - 1];
1291
1292 switch (reg & 0xff) {
1293 case 0x50:
1294 res = i2c_smbus_read_word_swapped(cl, 0);
1295 break;
1296 case 0x52:
1297 res = i2c_smbus_read_byte_data(cl, 1);
1298 break;
1299 case 0x53:
1300 res = i2c_smbus_read_word_swapped(cl, 2);
1301 break;
1302 case 0x55:
1303 default:
1304 res = i2c_smbus_read_word_swapped(cl, 3);
1305 break;
1306 }
1307 }
1308 if (bank > 2)
1309 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
1310
1311 return res;
1312}
1313
1314static int
1315w83781d_write_value_i2c(struct w83781d_data *data, u16 reg, u16 value)
1316{
1317 struct i2c_client *client = data->client;
1318 int bank;
1319 struct i2c_client *cl;
1320
1321 bank = (reg >> 8) & 0x0f;
1322 if (bank > 2)
1323
1324 i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
1325 bank);
1326 if (bank == 0 || bank > 2) {
1327 i2c_smbus_write_byte_data(client, reg & 0xff,
1328 value & 0xff);
1329 } else {
1330
1331 cl = data->lm75[bank - 1];
1332
1333 switch (reg & 0xff) {
1334 case 0x52:
1335 i2c_smbus_write_byte_data(cl, 1, value & 0xff);
1336 break;
1337 case 0x53:
1338 i2c_smbus_write_word_swapped(cl, 2, value);
1339 break;
1340 case 0x55:
1341 i2c_smbus_write_word_swapped(cl, 3, value);
1342 break;
1343 }
1344 }
1345 if (bank > 2)
1346 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
1347
1348 return 0;
1349}
1350
1351static void
1352w83781d_init_device(struct device *dev)
1353{
1354 struct w83781d_data *data = dev_get_drvdata(dev);
1355 int i, p;
1356 int type = data->type;
1357 u8 tmp;
1358
1359 if (reset && type != as99127f) {
1360
1361
1362
1363
1364
1365
1366
1367
1368
1369
1370
1371 dev_info(dev, "If reset=1 solved a problem you were "
1372 "having, please report!\n");
1373
1374
1375 i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
1376 p = w83781d_read_value(data, W83781D_REG_PWMCLK12);
1377
1378
1379
1380
1381 w83781d_write_value(data, W83781D_REG_CONFIG, 0x80);
1382
1383
1384
1385
1386 w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
1387 w83781d_write_value(data, W83781D_REG_PWMCLK12, p);
1388
1389
1390
1391
1392
1393 w83781d_write_value(data, W83781D_REG_BEEP_INTS2, 0);
1394 }
1395
1396
1397
1398
1399
1400 if (init && !reset && type != as99127f) {
1401 i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
1402 w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
1403 }
1404
1405 data->vrm = vid_which_vrm();
1406
1407 if ((type != w83781d) && (type != as99127f)) {
1408 tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
1409 for (i = 1; i <= 3; i++) {
1410 if (!(tmp & BIT_SCFG1[i - 1])) {
1411 data->sens[i - 1] = 4;
1412 } else {
1413 if (w83781d_read_value
1414 (data,
1415 W83781D_REG_SCFG2) & BIT_SCFG2[i - 1])
1416 data->sens[i - 1] = 1;
1417 else
1418 data->sens[i - 1] = 2;
1419 }
1420 if (type == w83783s && i == 2)
1421 break;
1422 }
1423 }
1424
1425 if (init && type != as99127f) {
1426
1427 tmp = w83781d_read_value(data, W83781D_REG_TEMP2_CONFIG);
1428 if (tmp & 0x01) {
1429 dev_warn(dev, "Enabling temp2, readings "
1430 "might not make sense\n");
1431 w83781d_write_value(data, W83781D_REG_TEMP2_CONFIG,
1432 tmp & 0xfe);
1433 }
1434
1435
1436 if (type != w83783s) {
1437 tmp = w83781d_read_value(data,
1438 W83781D_REG_TEMP3_CONFIG);
1439 if (tmp & 0x01) {
1440 dev_warn(dev, "Enabling temp3, "
1441 "readings might not make sense\n");
1442 w83781d_write_value(data,
1443 W83781D_REG_TEMP3_CONFIG, tmp & 0xfe);
1444 }
1445 }
1446 }
1447
1448
1449 w83781d_write_value(data, W83781D_REG_CONFIG,
1450 (w83781d_read_value(data,
1451 W83781D_REG_CONFIG) & 0xf7)
1452 | 0x01);
1453
1454
1455 for (i = 0; i < 3; i++) {
1456 data->fan_min[i] = w83781d_read_value(data,
1457 W83781D_REG_FAN_MIN(i));
1458 }
1459
1460 mutex_init(&data->update_lock);
1461}
1462
1463static struct w83781d_data *w83781d_update_device(struct device *dev)
1464{
1465 struct w83781d_data *data = dev_get_drvdata(dev);
1466 struct i2c_client *client = data->client;
1467 int i;
1468
1469 mutex_lock(&data->update_lock);
1470
1471 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
1472 || !data->valid) {
1473 dev_dbg(dev, "Starting device update\n");
1474
1475 for (i = 0; i <= 8; i++) {
1476 if (data->type == w83783s && i == 1)
1477 continue;
1478 data->in[i] =
1479 w83781d_read_value(data, W83781D_REG_IN(i));
1480 data->in_min[i] =
1481 w83781d_read_value(data, W83781D_REG_IN_MIN(i));
1482 data->in_max[i] =
1483 w83781d_read_value(data, W83781D_REG_IN_MAX(i));
1484 if ((data->type != w83782d) && (i == 6))
1485 break;
1486 }
1487 for (i = 0; i < 3; i++) {
1488 data->fan[i] =
1489 w83781d_read_value(data, W83781D_REG_FAN(i));
1490 data->fan_min[i] =
1491 w83781d_read_value(data, W83781D_REG_FAN_MIN(i));
1492 }
1493 if (data->type != w83781d && data->type != as99127f) {
1494 for (i = 0; i < 4; i++) {
1495 data->pwm[i] =
1496 w83781d_read_value(data,
1497 W83781D_REG_PWM[i]);
1498
1499 if ((data->type != w83782d || !client)
1500 && i == 1)
1501 break;
1502 }
1503
1504 data->pwm2_enable = (w83781d_read_value(data,
1505 W83781D_REG_PWMCLK12) & 0x08) >> 3;
1506 }
1507
1508 data->temp = w83781d_read_value(data, W83781D_REG_TEMP(1));
1509 data->temp_max =
1510 w83781d_read_value(data, W83781D_REG_TEMP_OVER(1));
1511 data->temp_max_hyst =
1512 w83781d_read_value(data, W83781D_REG_TEMP_HYST(1));
1513 data->temp_add[0] =
1514 w83781d_read_value(data, W83781D_REG_TEMP(2));
1515 data->temp_max_add[0] =
1516 w83781d_read_value(data, W83781D_REG_TEMP_OVER(2));
1517 data->temp_max_hyst_add[0] =
1518 w83781d_read_value(data, W83781D_REG_TEMP_HYST(2));
1519 if (data->type != w83783s) {
1520 data->temp_add[1] =
1521 w83781d_read_value(data, W83781D_REG_TEMP(3));
1522 data->temp_max_add[1] =
1523 w83781d_read_value(data,
1524 W83781D_REG_TEMP_OVER(3));
1525 data->temp_max_hyst_add[1] =
1526 w83781d_read_value(data,
1527 W83781D_REG_TEMP_HYST(3));
1528 }
1529 i = w83781d_read_value(data, W83781D_REG_VID_FANDIV);
1530 data->vid = i & 0x0f;
1531 data->vid |= (w83781d_read_value(data,
1532 W83781D_REG_CHIPID) & 0x01) << 4;
1533 data->fan_div[0] = (i >> 4) & 0x03;
1534 data->fan_div[1] = (i >> 6) & 0x03;
1535 data->fan_div[2] = (w83781d_read_value(data,
1536 W83781D_REG_PIN) >> 6) & 0x03;
1537 if ((data->type != w83781d) && (data->type != as99127f)) {
1538 i = w83781d_read_value(data, W83781D_REG_VBAT);
1539 data->fan_div[0] |= (i >> 3) & 0x04;
1540 data->fan_div[1] |= (i >> 4) & 0x04;
1541 data->fan_div[2] |= (i >> 5) & 0x04;
1542 }
1543 if (data->type == w83782d) {
1544 data->alarms = w83781d_read_value(data,
1545 W83782D_REG_ALARM1)
1546 | (w83781d_read_value(data,
1547 W83782D_REG_ALARM2) << 8)
1548 | (w83781d_read_value(data,
1549 W83782D_REG_ALARM3) << 16);
1550 } else if (data->type == w83783s) {
1551 data->alarms = w83781d_read_value(data,
1552 W83782D_REG_ALARM1)
1553 | (w83781d_read_value(data,
1554 W83782D_REG_ALARM2) << 8);
1555 } else {
1556
1557
1558
1559
1560 data->alarms = w83781d_read_value(data,
1561 W83781D_REG_ALARM1)
1562 | (w83781d_read_value(data,
1563 W83781D_REG_ALARM2) << 8);
1564 }
1565 i = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
1566 data->beep_mask = (i << 8) +
1567 w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
1568 if ((data->type != w83781d) && (data->type != as99127f)) {
1569 data->beep_mask |=
1570 w83781d_read_value(data,
1571 W83781D_REG_BEEP_INTS3) << 16;
1572 }
1573 data->last_updated = jiffies;
1574 data->valid = 1;
1575 }
1576
1577 mutex_unlock(&data->update_lock);
1578
1579 return data;
1580}
1581
1582static const struct i2c_device_id w83781d_ids[] = {
1583 { "w83781d", w83781d, },
1584 { "w83782d", w83782d, },
1585 { "w83783s", w83783s, },
1586 { "as99127f", as99127f },
1587 { }
1588};
1589MODULE_DEVICE_TABLE(i2c, w83781d_ids);
1590
1591static struct i2c_driver w83781d_driver = {
1592 .class = I2C_CLASS_HWMON,
1593 .driver = {
1594 .name = "w83781d",
1595 },
1596 .probe = w83781d_probe,
1597 .remove = w83781d_remove,
1598 .id_table = w83781d_ids,
1599 .detect = w83781d_detect,
1600 .address_list = normal_i2c,
1601};
1602
1603
1604
1605
1606#ifdef CONFIG_ISA
1607
1608
1609static struct platform_device *pdev;
1610
1611static unsigned short isa_address = 0x290;
1612
1613
1614
1615
1616
1617static ssize_t
1618show_name(struct device *dev, struct device_attribute *devattr, char *buf)
1619{
1620 struct w83781d_data *data = dev_get_drvdata(dev);
1621 return sprintf(buf, "%s\n", data->name);
1622}
1623static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1624
1625static struct w83781d_data *w83781d_data_if_isa(void)
1626{
1627 return pdev ? platform_get_drvdata(pdev) : NULL;
1628}
1629
1630
1631static int w83781d_alias_detect(struct i2c_client *client, u8 chipid)
1632{
1633 struct w83781d_data *isa;
1634 int i;
1635
1636 if (!pdev)
1637 return 0;
1638
1639 isa = platform_get_drvdata(pdev);
1640
1641 if (w83781d_read_value(isa, W83781D_REG_I2C_ADDR) != client->addr)
1642 return 0;
1643 if (w83781d_read_value(isa, W83781D_REG_WCHIPID) != chipid)
1644 return 0;
1645
1646
1647
1648
1649
1650 for (i = 0x2b; i <= 0x3d; i++) {
1651 if (w83781d_read_value(isa, i) !=
1652 i2c_smbus_read_byte_data(client, i))
1653 return 0;
1654 }
1655 if (w83781d_read_value(isa, W83781D_REG_CONFIG) !=
1656 i2c_smbus_read_byte_data(client, W83781D_REG_CONFIG))
1657 return 0;
1658 for (i = 0x43; i <= 0x46; i++) {
1659 if (w83781d_read_value(isa, i) !=
1660 i2c_smbus_read_byte_data(client, i))
1661 return 0;
1662 }
1663
1664 return 1;
1665}
1666
1667static int
1668w83781d_read_value_isa(struct w83781d_data *data, u16 reg)
1669{
1670 int word_sized, res;
1671
1672 word_sized = (((reg & 0xff00) == 0x100)
1673 || ((reg & 0xff00) == 0x200))
1674 && (((reg & 0x00ff) == 0x50)
1675 || ((reg & 0x00ff) == 0x53)
1676 || ((reg & 0x00ff) == 0x55));
1677 if (reg & 0xff00) {
1678 outb_p(W83781D_REG_BANK,
1679 data->isa_addr + W83781D_ADDR_REG_OFFSET);
1680 outb_p(reg >> 8,
1681 data->isa_addr + W83781D_DATA_REG_OFFSET);
1682 }
1683 outb_p(reg & 0xff, data->isa_addr + W83781D_ADDR_REG_OFFSET);
1684 res = inb_p(data->isa_addr + W83781D_DATA_REG_OFFSET);
1685 if (word_sized) {
1686 outb_p((reg & 0xff) + 1,
1687 data->isa_addr + W83781D_ADDR_REG_OFFSET);
1688 res =
1689 (res << 8) + inb_p(data->isa_addr +
1690 W83781D_DATA_REG_OFFSET);
1691 }
1692 if (reg & 0xff00) {
1693 outb_p(W83781D_REG_BANK,
1694 data->isa_addr + W83781D_ADDR_REG_OFFSET);
1695 outb_p(0, data->isa_addr + W83781D_DATA_REG_OFFSET);
1696 }
1697 return res;
1698}
1699
1700static void
1701w83781d_write_value_isa(struct w83781d_data *data, u16 reg, u16 value)
1702{
1703 int word_sized;
1704
1705 word_sized = (((reg & 0xff00) == 0x100)
1706 || ((reg & 0xff00) == 0x200))
1707 && (((reg & 0x00ff) == 0x53)
1708 || ((reg & 0x00ff) == 0x55));
1709 if (reg & 0xff00) {
1710 outb_p(W83781D_REG_BANK,
1711 data->isa_addr + W83781D_ADDR_REG_OFFSET);
1712 outb_p(reg >> 8,
1713 data->isa_addr + W83781D_DATA_REG_OFFSET);
1714 }
1715 outb_p(reg & 0xff, data->isa_addr + W83781D_ADDR_REG_OFFSET);
1716 if (word_sized) {
1717 outb_p(value >> 8,
1718 data->isa_addr + W83781D_DATA_REG_OFFSET);
1719 outb_p((reg & 0xff) + 1,
1720 data->isa_addr + W83781D_ADDR_REG_OFFSET);
1721 }
1722 outb_p(value & 0xff, data->isa_addr + W83781D_DATA_REG_OFFSET);
1723 if (reg & 0xff00) {
1724 outb_p(W83781D_REG_BANK,
1725 data->isa_addr + W83781D_ADDR_REG_OFFSET);
1726 outb_p(0, data->isa_addr + W83781D_DATA_REG_OFFSET);
1727 }
1728}
1729
1730
1731
1732
1733
1734
1735
1736
1737
1738static int
1739w83781d_read_value(struct w83781d_data *data, u16 reg)
1740{
1741 struct i2c_client *client = data->client;
1742 int res;
1743
1744 mutex_lock(&data->lock);
1745 if (client)
1746 res = w83781d_read_value_i2c(data, reg);
1747 else
1748 res = w83781d_read_value_isa(data, reg);
1749 mutex_unlock(&data->lock);
1750 return res;
1751}
1752
1753static int
1754w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value)
1755{
1756 struct i2c_client *client = data->client;
1757
1758 mutex_lock(&data->lock);
1759 if (client)
1760 w83781d_write_value_i2c(data, reg, value);
1761 else
1762 w83781d_write_value_isa(data, reg, value);
1763 mutex_unlock(&data->lock);
1764 return 0;
1765}
1766
1767static int
1768w83781d_isa_probe(struct platform_device *pdev)
1769{
1770 int err, reg;
1771 struct w83781d_data *data;
1772 struct resource *res;
1773
1774
1775 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1776 if (!devm_request_region(&pdev->dev,
1777 res->start + W83781D_ADDR_REG_OFFSET, 2,
1778 "w83781d"))
1779 return -EBUSY;
1780
1781 data = devm_kzalloc(&pdev->dev, sizeof(struct w83781d_data),
1782 GFP_KERNEL);
1783 if (!data)
1784 return -ENOMEM;
1785
1786 mutex_init(&data->lock);
1787 data->isa_addr = res->start;
1788 platform_set_drvdata(pdev, data);
1789
1790 reg = w83781d_read_value(data, W83781D_REG_WCHIPID);
1791 switch (reg) {
1792 case 0x30:
1793 data->type = w83782d;
1794 data->name = "w83782d";
1795 break;
1796 default:
1797 data->type = w83781d;
1798 data->name = "w83781d";
1799 }
1800
1801
1802 w83781d_init_device(&pdev->dev);
1803
1804
1805 err = w83781d_create_files(&pdev->dev, data->type, 1);
1806 if (err)
1807 goto exit_remove_files;
1808
1809 err = device_create_file(&pdev->dev, &dev_attr_name);
1810 if (err)
1811 goto exit_remove_files;
1812
1813 data->hwmon_dev = hwmon_device_register(&pdev->dev);
1814 if (IS_ERR(data->hwmon_dev)) {
1815 err = PTR_ERR(data->hwmon_dev);
1816 goto exit_remove_files;
1817 }
1818
1819 return 0;
1820
1821 exit_remove_files:
1822 w83781d_remove_files(&pdev->dev);
1823 device_remove_file(&pdev->dev, &dev_attr_name);
1824 return err;
1825}
1826
1827static int
1828w83781d_isa_remove(struct platform_device *pdev)
1829{
1830 struct w83781d_data *data = platform_get_drvdata(pdev);
1831
1832 hwmon_device_unregister(data->hwmon_dev);
1833 w83781d_remove_files(&pdev->dev);
1834 device_remove_file(&pdev->dev, &dev_attr_name);
1835
1836 return 0;
1837}
1838
1839static struct platform_driver w83781d_isa_driver = {
1840 .driver = {
1841 .owner = THIS_MODULE,
1842 .name = "w83781d",
1843 },
1844 .probe = w83781d_isa_probe,
1845 .remove = w83781d_isa_remove,
1846};
1847
1848
1849static int __init
1850w83781d_isa_found(unsigned short address)
1851{
1852 int val, save, found = 0;
1853 int port;
1854
1855
1856
1857
1858
1859
1860 for (port = address; port < address + W83781D_EXTENT; port++) {
1861 if (!request_region(port, 1, "w83781d")) {
1862 pr_debug("Failed to request port 0x%x\n", port);
1863 goto release;
1864 }
1865 }
1866
1867#define REALLY_SLOW_IO
1868
1869
1870
1871
1872 val = inb_p(address + 1);
1873 if (inb_p(address + 2) != val
1874 || inb_p(address + 3) != val
1875 || inb_p(address + 7) != val) {
1876 pr_debug("Detection failed at step %d\n", 1);
1877 goto release;
1878 }
1879#undef REALLY_SLOW_IO
1880
1881
1882
1883
1884
1885 save = inb_p(address + W83781D_ADDR_REG_OFFSET);
1886 if (save & 0x80) {
1887 pr_debug("Detection failed at step %d\n", 2);
1888 goto release;
1889 }
1890 val = ~save & 0x7f;
1891 outb_p(val, address + W83781D_ADDR_REG_OFFSET);
1892 if (inb_p(address + W83781D_ADDR_REG_OFFSET) != (val | 0x80)) {
1893 outb_p(save, address + W83781D_ADDR_REG_OFFSET);
1894 pr_debug("Detection failed at step %d\n", 3);
1895 goto release;
1896 }
1897
1898
1899 outb_p(W83781D_REG_CONFIG, address + W83781D_ADDR_REG_OFFSET);
1900 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1901 if (val & 0x80) {
1902 pr_debug("Detection failed at step %d\n", 4);
1903 goto release;
1904 }
1905 outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
1906 save = inb_p(address + W83781D_DATA_REG_OFFSET);
1907 outb_p(W83781D_REG_CHIPMAN, address + W83781D_ADDR_REG_OFFSET);
1908 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1909 if ((!(save & 0x80) && (val != 0xa3))
1910 || ((save & 0x80) && (val != 0x5c))) {
1911 pr_debug("Detection failed at step %d\n", 5);
1912 goto release;
1913 }
1914 outb_p(W83781D_REG_I2C_ADDR, address + W83781D_ADDR_REG_OFFSET);
1915 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1916 if (val < 0x03 || val > 0x77) {
1917 pr_debug("Detection failed at step %d\n", 6);
1918 goto release;
1919 }
1920
1921
1922 if (inb_p(address + W83781D_ADDR_REG_OFFSET) & 0x80) {
1923 pr_debug("Detection failed at step %d\n", 7);
1924 goto release;
1925 }
1926
1927
1928 outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
1929 save = inb_p(address + W83781D_DATA_REG_OFFSET);
1930 outb_p(save & 0xf8, address + W83781D_DATA_REG_OFFSET);
1931 outb_p(W83781D_REG_WCHIPID, address + W83781D_ADDR_REG_OFFSET);
1932 val = inb_p(address + W83781D_DATA_REG_OFFSET);
1933 if ((val & 0xfe) == 0x10
1934 || val == 0x30)
1935 found = 1;
1936
1937 if (found)
1938 pr_info("Found a %s chip at %#x\n",
1939 val == 0x30 ? "W83782D" : "W83781D", (int)address);
1940
1941 release:
1942 for (port--; port >= address; port--)
1943 release_region(port, 1);
1944 return found;
1945}
1946
1947static int __init
1948w83781d_isa_device_add(unsigned short address)
1949{
1950 struct resource res = {
1951 .start = address,
1952 .end = address + W83781D_EXTENT - 1,
1953 .name = "w83781d",
1954 .flags = IORESOURCE_IO,
1955 };
1956 int err;
1957
1958 pdev = platform_device_alloc("w83781d", address);
1959 if (!pdev) {
1960 err = -ENOMEM;
1961 pr_err("Device allocation failed\n");
1962 goto exit;
1963 }
1964
1965 err = platform_device_add_resources(pdev, &res, 1);
1966 if (err) {
1967 pr_err("Device resource addition failed (%d)\n", err);
1968 goto exit_device_put;
1969 }
1970
1971 err = platform_device_add(pdev);
1972 if (err) {
1973 pr_err("Device addition failed (%d)\n", err);
1974 goto exit_device_put;
1975 }
1976
1977 return 0;
1978
1979 exit_device_put:
1980 platform_device_put(pdev);
1981 exit:
1982 pdev = NULL;
1983 return err;
1984}
1985
1986static int __init
1987w83781d_isa_register(void)
1988{
1989 int res;
1990
1991 if (w83781d_isa_found(isa_address)) {
1992 res = platform_driver_register(&w83781d_isa_driver);
1993 if (res)
1994 goto exit;
1995
1996
1997 res = w83781d_isa_device_add(isa_address);
1998 if (res)
1999 goto exit_unreg_isa_driver;
2000 }
2001
2002 return 0;
2003
2004exit_unreg_isa_driver:
2005 platform_driver_unregister(&w83781d_isa_driver);
2006exit:
2007 return res;
2008}
2009
2010static void
2011w83781d_isa_unregister(void)
2012{
2013 if (pdev) {
2014 platform_device_unregister(pdev);
2015 platform_driver_unregister(&w83781d_isa_driver);
2016 }
2017}
2018#else
2019
2020static struct w83781d_data *w83781d_data_if_isa(void)
2021{
2022 return NULL;
2023}
2024
2025static int
2026w83781d_alias_detect(struct i2c_client *client, u8 chipid)
2027{
2028 return 0;
2029}
2030
2031static int
2032w83781d_read_value(struct w83781d_data *data, u16 reg)
2033{
2034 int res;
2035
2036 mutex_lock(&data->lock);
2037 res = w83781d_read_value_i2c(data, reg);
2038 mutex_unlock(&data->lock);
2039
2040 return res;
2041}
2042
2043static int
2044w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value)
2045{
2046 mutex_lock(&data->lock);
2047 w83781d_write_value_i2c(data, reg, value);
2048 mutex_unlock(&data->lock);
2049
2050 return 0;
2051}
2052
2053static int __init
2054w83781d_isa_register(void)
2055{
2056 return 0;
2057}
2058
2059static void
2060w83781d_isa_unregister(void)
2061{
2062}
2063#endif
2064
2065static int __init
2066sensors_w83781d_init(void)
2067{
2068 int res;
2069
2070
2071
2072
2073
2074 res = w83781d_isa_register();
2075 if (res)
2076 goto exit;
2077
2078 res = i2c_add_driver(&w83781d_driver);
2079 if (res)
2080 goto exit_unreg_isa;
2081
2082 return 0;
2083
2084 exit_unreg_isa:
2085 w83781d_isa_unregister();
2086 exit:
2087 return res;
2088}
2089
2090static void __exit
2091sensors_w83781d_exit(void)
2092{
2093 w83781d_isa_unregister();
2094 i2c_del_driver(&w83781d_driver);
2095}
2096
2097MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
2098 "Philip Edelbrock <phil@netroedge.com>, "
2099 "and Mark Studebaker <mdsxyz123@yahoo.com>");
2100MODULE_DESCRIPTION("W83781D driver");
2101MODULE_LICENSE("GPL");
2102
2103module_init(sensors_w83781d_init);
2104module_exit(sensors_w83781d_exit);
2105