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#include <linux/module.h>
28#include <linux/init.h>
29#include <linux/slab.h>
30#include <linux/i2c.h>
31#include <linux/hwmon.h>
32#include <linux/hwmon-vid.h>
33#include <linux/hwmon-sysfs.h>
34#include <linux/err.h>
35#include <linux/mutex.h>
36#include <linux/jiffies.h>
37
38
39static const unsigned short normal_i2c[] = { 0x2e, 0x2f, I2C_CLIENT_END };
40
41
42
43static bool reset;
44module_param(reset, bool, 0);
45MODULE_PARM_DESC(reset, "Set to 1 to reset chip, not recommended");
46
47#define W83L786NG_REG_IN_MIN(nr) (0x2C + (nr) * 2)
48#define W83L786NG_REG_IN_MAX(nr) (0x2B + (nr) * 2)
49#define W83L786NG_REG_IN(nr) ((nr) + 0x20)
50
51#define W83L786NG_REG_FAN(nr) ((nr) + 0x28)
52#define W83L786NG_REG_FAN_MIN(nr) ((nr) + 0x3B)
53
54#define W83L786NG_REG_CONFIG 0x40
55#define W83L786NG_REG_ALARM1 0x41
56#define W83L786NG_REG_ALARM2 0x42
57#define W83L786NG_REG_GPIO_EN 0x47
58#define W83L786NG_REG_MAN_ID2 0x4C
59#define W83L786NG_REG_MAN_ID1 0x4D
60#define W83L786NG_REG_CHIP_ID 0x4E
61
62#define W83L786NG_REG_DIODE 0x53
63#define W83L786NG_REG_FAN_DIV 0x54
64#define W83L786NG_REG_FAN_CFG 0x80
65
66#define W83L786NG_REG_TOLERANCE 0x8D
67
68static const u8 W83L786NG_REG_TEMP[2][3] = {
69 { 0x25,
70 0x35,
71 0x36 },
72 { 0x26,
73 0x37,
74 0x38 }
75};
76
77static const u8 W83L786NG_PWM_MODE_SHIFT[] = {6, 7};
78static const u8 W83L786NG_PWM_ENABLE_SHIFT[] = {2, 4};
79
80
81static const u8 W83L786NG_REG_PWM[] = {0x81, 0x87};
82
83
84static inline u8
85FAN_TO_REG(long rpm, int div)
86{
87 if (rpm == 0)
88 return 255;
89 rpm = clamp_val(rpm, 1, 1000000);
90 return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
91}
92
93#define FAN_FROM_REG(val, div) ((val) == 0 ? -1 : \
94 ((val) == 255 ? 0 : \
95 1350000 / ((val) * (div))))
96
97
98#define TEMP_TO_REG(val) (clamp_val(((val) < 0 ? (val) + 0x100 * 1000 \
99 : (val)) / 1000, 0, 0xff))
100#define TEMP_FROM_REG(val) (((val) & 0x80 ? \
101 (val) - 0x100 : (val)) * 1000)
102
103
104
105
106
107
108#define IN_TO_REG(val) (clamp_val((((val) + 4) / 8), 0, 255))
109#define IN_FROM_REG(val) ((val) * 8)
110
111#define DIV_FROM_REG(val) (1 << (val))
112
113static inline u8
114DIV_TO_REG(long val)
115{
116 int i;
117 val = clamp_val(val, 1, 128) >> 1;
118 for (i = 0; i < 7; i++) {
119 if (val == 0)
120 break;
121 val >>= 1;
122 }
123 return (u8)i;
124}
125
126struct w83l786ng_data {
127 struct device *hwmon_dev;
128 struct mutex update_lock;
129 char valid;
130 unsigned long last_updated;
131 unsigned long last_nonvolatile;
132
133
134 u8 in[3];
135 u8 in_max[3];
136 u8 in_min[3];
137 u8 fan[2];
138 u8 fan_div[2];
139 u8 fan_min[2];
140 u8 temp_type[2];
141 u8 temp[2][3];
142 u8 pwm[2];
143 u8 pwm_mode[2];
144
145
146 u8 pwm_enable[2];
147
148 u8 tolerance[2];
149};
150
151static int w83l786ng_probe(struct i2c_client *client,
152 const struct i2c_device_id *id);
153static int w83l786ng_detect(struct i2c_client *client,
154 struct i2c_board_info *info);
155static int w83l786ng_remove(struct i2c_client *client);
156static void w83l786ng_init_client(struct i2c_client *client);
157static struct w83l786ng_data *w83l786ng_update_device(struct device *dev);
158
159static const struct i2c_device_id w83l786ng_id[] = {
160 { "w83l786ng", 0 },
161 { }
162};
163MODULE_DEVICE_TABLE(i2c, w83l786ng_id);
164
165static struct i2c_driver w83l786ng_driver = {
166 .class = I2C_CLASS_HWMON,
167 .driver = {
168 .name = "w83l786ng",
169 },
170 .probe = w83l786ng_probe,
171 .remove = w83l786ng_remove,
172 .id_table = w83l786ng_id,
173 .detect = w83l786ng_detect,
174 .address_list = normal_i2c,
175};
176
177static u8
178w83l786ng_read_value(struct i2c_client *client, u8 reg)
179{
180 return i2c_smbus_read_byte_data(client, reg);
181}
182
183static int
184w83l786ng_write_value(struct i2c_client *client, u8 reg, u8 value)
185{
186 return i2c_smbus_write_byte_data(client, reg, value);
187}
188
189
190#define show_in_reg(reg) \
191static ssize_t \
192show_##reg(struct device *dev, struct device_attribute *attr, \
193 char *buf) \
194{ \
195 int nr = to_sensor_dev_attr(attr)->index; \
196 struct w83l786ng_data *data = w83l786ng_update_device(dev); \
197 return sprintf(buf, "%d\n", IN_FROM_REG(data->reg[nr])); \
198}
199
200show_in_reg(in)
201show_in_reg(in_min)
202show_in_reg(in_max)
203
204#define store_in_reg(REG, reg) \
205static ssize_t \
206store_in_##reg(struct device *dev, struct device_attribute *attr, \
207 const char *buf, size_t count) \
208{ \
209 int nr = to_sensor_dev_attr(attr)->index; \
210 struct i2c_client *client = to_i2c_client(dev); \
211 struct w83l786ng_data *data = i2c_get_clientdata(client); \
212 unsigned long val; \
213 int err = kstrtoul(buf, 10, &val); \
214 if (err) \
215 return err; \
216 mutex_lock(&data->update_lock); \
217 data->in_##reg[nr] = IN_TO_REG(val); \
218 w83l786ng_write_value(client, W83L786NG_REG_IN_##REG(nr), \
219 data->in_##reg[nr]); \
220 mutex_unlock(&data->update_lock); \
221 return count; \
222}
223
224store_in_reg(MIN, min)
225store_in_reg(MAX, max)
226
227static struct sensor_device_attribute sda_in_input[] = {
228 SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
229 SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
230 SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
231};
232
233static struct sensor_device_attribute sda_in_min[] = {
234 SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
235 SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
236 SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
237};
238
239static struct sensor_device_attribute sda_in_max[] = {
240 SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
241 SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
242 SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
243};
244
245#define show_fan_reg(reg) \
246static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
247 char *buf) \
248{ \
249 int nr = to_sensor_dev_attr(attr)->index; \
250 struct w83l786ng_data *data = w83l786ng_update_device(dev); \
251 return sprintf(buf, "%d\n", \
252 FAN_FROM_REG(data->fan[nr], DIV_FROM_REG(data->fan_div[nr]))); \
253}
254
255show_fan_reg(fan);
256show_fan_reg(fan_min);
257
258static ssize_t
259store_fan_min(struct device *dev, struct device_attribute *attr,
260 const char *buf, size_t count)
261{
262 int nr = to_sensor_dev_attr(attr)->index;
263 struct i2c_client *client = to_i2c_client(dev);
264 struct w83l786ng_data *data = i2c_get_clientdata(client);
265 unsigned long val;
266 int err;
267
268 err = kstrtoul(buf, 10, &val);
269 if (err)
270 return err;
271
272 mutex_lock(&data->update_lock);
273 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
274 w83l786ng_write_value(client, W83L786NG_REG_FAN_MIN(nr),
275 data->fan_min[nr]);
276 mutex_unlock(&data->update_lock);
277
278 return count;
279}
280
281static ssize_t
282show_fan_div(struct device *dev, struct device_attribute *attr,
283 char *buf)
284{
285 int nr = to_sensor_dev_attr(attr)->index;
286 struct w83l786ng_data *data = w83l786ng_update_device(dev);
287 return sprintf(buf, "%u\n", DIV_FROM_REG(data->fan_div[nr]));
288}
289
290
291
292
293
294
295
296static ssize_t
297store_fan_div(struct device *dev, struct device_attribute *attr,
298 const char *buf, size_t count)
299{
300 int nr = to_sensor_dev_attr(attr)->index;
301 struct i2c_client *client = to_i2c_client(dev);
302 struct w83l786ng_data *data = i2c_get_clientdata(client);
303
304 unsigned long min;
305 u8 tmp_fan_div;
306 u8 fan_div_reg;
307 u8 keep_mask = 0;
308 u8 new_shift = 0;
309
310 unsigned long val;
311 int err;
312
313 err = kstrtoul(buf, 10, &val);
314 if (err)
315 return err;
316
317
318 mutex_lock(&data->update_lock);
319 min = FAN_FROM_REG(data->fan_min[nr], DIV_FROM_REG(data->fan_div[nr]));
320
321 data->fan_div[nr] = DIV_TO_REG(val);
322
323 switch (nr) {
324 case 0:
325 keep_mask = 0xf8;
326 new_shift = 0;
327 break;
328 case 1:
329 keep_mask = 0x8f;
330 new_shift = 4;
331 break;
332 }
333
334 fan_div_reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_DIV)
335 & keep_mask;
336
337 tmp_fan_div = (data->fan_div[nr] << new_shift) & ~keep_mask;
338
339 w83l786ng_write_value(client, W83L786NG_REG_FAN_DIV,
340 fan_div_reg | tmp_fan_div);
341
342
343 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
344 w83l786ng_write_value(client, W83L786NG_REG_FAN_MIN(nr),
345 data->fan_min[nr]);
346 mutex_unlock(&data->update_lock);
347
348 return count;
349}
350
351static struct sensor_device_attribute sda_fan_input[] = {
352 SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
353 SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
354};
355
356static struct sensor_device_attribute sda_fan_min[] = {
357 SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
358 store_fan_min, 0),
359 SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
360 store_fan_min, 1),
361};
362
363static struct sensor_device_attribute sda_fan_div[] = {
364 SENSOR_ATTR(fan1_div, S_IWUSR | S_IRUGO, show_fan_div,
365 store_fan_div, 0),
366 SENSOR_ATTR(fan2_div, S_IWUSR | S_IRUGO, show_fan_div,
367 store_fan_div, 1),
368};
369
370
371
372
373static ssize_t
374show_temp(struct device *dev, struct device_attribute *attr, char *buf)
375{
376 struct sensor_device_attribute_2 *sensor_attr =
377 to_sensor_dev_attr_2(attr);
378 int nr = sensor_attr->nr;
379 int index = sensor_attr->index;
380 struct w83l786ng_data *data = w83l786ng_update_device(dev);
381 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr][index]));
382}
383
384static ssize_t
385store_temp(struct device *dev, struct device_attribute *attr,
386 const char *buf, size_t count)
387{
388 struct sensor_device_attribute_2 *sensor_attr =
389 to_sensor_dev_attr_2(attr);
390 int nr = sensor_attr->nr;
391 int index = sensor_attr->index;
392 struct i2c_client *client = to_i2c_client(dev);
393 struct w83l786ng_data *data = i2c_get_clientdata(client);
394 long val;
395 int err;
396
397 err = kstrtol(buf, 10, &val);
398 if (err)
399 return err;
400
401 mutex_lock(&data->update_lock);
402 data->temp[nr][index] = TEMP_TO_REG(val);
403 w83l786ng_write_value(client, W83L786NG_REG_TEMP[nr][index],
404 data->temp[nr][index]);
405 mutex_unlock(&data->update_lock);
406
407 return count;
408}
409
410static struct sensor_device_attribute_2 sda_temp_input[] = {
411 SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 0),
412 SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 1, 0),
413};
414
415static struct sensor_device_attribute_2 sda_temp_max[] = {
416 SENSOR_ATTR_2(temp1_max, S_IRUGO | S_IWUSR,
417 show_temp, store_temp, 0, 1),
418 SENSOR_ATTR_2(temp2_max, S_IRUGO | S_IWUSR,
419 show_temp, store_temp, 1, 1),
420};
421
422static struct sensor_device_attribute_2 sda_temp_max_hyst[] = {
423 SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO | S_IWUSR,
424 show_temp, store_temp, 0, 2),
425 SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO | S_IWUSR,
426 show_temp, store_temp, 1, 2),
427};
428
429#define show_pwm_reg(reg) \
430static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
431 char *buf) \
432{ \
433 struct w83l786ng_data *data = w83l786ng_update_device(dev); \
434 int nr = to_sensor_dev_attr(attr)->index; \
435 return sprintf(buf, "%d\n", data->reg[nr]); \
436}
437
438show_pwm_reg(pwm_mode)
439show_pwm_reg(pwm_enable)
440show_pwm_reg(pwm)
441
442static ssize_t
443store_pwm_mode(struct device *dev, struct device_attribute *attr,
444 const char *buf, size_t count)
445{
446 int nr = to_sensor_dev_attr(attr)->index;
447 struct i2c_client *client = to_i2c_client(dev);
448 struct w83l786ng_data *data = i2c_get_clientdata(client);
449 u8 reg;
450 unsigned long val;
451 int err;
452
453 err = kstrtoul(buf, 10, &val);
454 if (err)
455 return err;
456
457 if (val > 1)
458 return -EINVAL;
459 mutex_lock(&data->update_lock);
460 data->pwm_mode[nr] = val;
461 reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG);
462 reg &= ~(1 << W83L786NG_PWM_MODE_SHIFT[nr]);
463 if (!val)
464 reg |= 1 << W83L786NG_PWM_MODE_SHIFT[nr];
465 w83l786ng_write_value(client, W83L786NG_REG_FAN_CFG, reg);
466 mutex_unlock(&data->update_lock);
467 return count;
468}
469
470static ssize_t
471store_pwm(struct device *dev, struct device_attribute *attr,
472 const char *buf, size_t count)
473{
474 int nr = to_sensor_dev_attr(attr)->index;
475 struct i2c_client *client = to_i2c_client(dev);
476 struct w83l786ng_data *data = i2c_get_clientdata(client);
477 unsigned long val;
478 int err;
479
480 err = kstrtoul(buf, 10, &val);
481 if (err)
482 return err;
483 val = clamp_val(val, 0, 255);
484
485 mutex_lock(&data->update_lock);
486 data->pwm[nr] = val;
487 w83l786ng_write_value(client, W83L786NG_REG_PWM[nr], val);
488 mutex_unlock(&data->update_lock);
489 return count;
490}
491
492static ssize_t
493store_pwm_enable(struct device *dev, struct device_attribute *attr,
494 const char *buf, size_t count)
495{
496 int nr = to_sensor_dev_attr(attr)->index;
497 struct i2c_client *client = to_i2c_client(dev);
498 struct w83l786ng_data *data = i2c_get_clientdata(client);
499 u8 reg;
500 unsigned long val;
501 int err;
502
503 err = kstrtoul(buf, 10, &val);
504 if (err)
505 return err;
506
507 if (!val || val > 2)
508 return -EINVAL;
509
510 mutex_lock(&data->update_lock);
511 reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG);
512 data->pwm_enable[nr] = val;
513 reg &= ~(0x02 << W83L786NG_PWM_ENABLE_SHIFT[nr]);
514 reg |= (val - 1) << W83L786NG_PWM_ENABLE_SHIFT[nr];
515 w83l786ng_write_value(client, W83L786NG_REG_FAN_CFG, reg);
516 mutex_unlock(&data->update_lock);
517 return count;
518}
519
520static struct sensor_device_attribute sda_pwm[] = {
521 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
522 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
523};
524
525static struct sensor_device_attribute sda_pwm_mode[] = {
526 SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
527 store_pwm_mode, 0),
528 SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
529 store_pwm_mode, 1),
530};
531
532static struct sensor_device_attribute sda_pwm_enable[] = {
533 SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
534 store_pwm_enable, 0),
535 SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
536 store_pwm_enable, 1),
537};
538
539
540static ssize_t
541show_tolerance(struct device *dev, struct device_attribute *attr, char *buf)
542{
543 int nr = to_sensor_dev_attr(attr)->index;
544 struct w83l786ng_data *data = w83l786ng_update_device(dev);
545 return sprintf(buf, "%ld\n", (long)data->tolerance[nr]);
546}
547
548static ssize_t
549store_tolerance(struct device *dev, struct device_attribute *attr,
550 const char *buf, size_t count)
551{
552 int nr = to_sensor_dev_attr(attr)->index;
553 struct i2c_client *client = to_i2c_client(dev);
554 struct w83l786ng_data *data = i2c_get_clientdata(client);
555 u8 tol_tmp, tol_mask;
556 unsigned long val;
557 int err;
558
559 err = kstrtoul(buf, 10, &val);
560 if (err)
561 return err;
562
563 mutex_lock(&data->update_lock);
564 tol_mask = w83l786ng_read_value(client,
565 W83L786NG_REG_TOLERANCE) & ((nr == 1) ? 0x0f : 0xf0);
566 tol_tmp = clamp_val(val, 0, 15);
567 tol_tmp &= 0x0f;
568 data->tolerance[nr] = tol_tmp;
569 if (nr == 1)
570 tol_tmp <<= 4;
571
572 w83l786ng_write_value(client, W83L786NG_REG_TOLERANCE,
573 tol_mask | tol_tmp);
574 mutex_unlock(&data->update_lock);
575 return count;
576}
577
578static struct sensor_device_attribute sda_tolerance[] = {
579 SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO,
580 show_tolerance, store_tolerance, 0),
581 SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO,
582 show_tolerance, store_tolerance, 1),
583};
584
585
586#define IN_UNIT_ATTRS(X) \
587 &sda_in_input[X].dev_attr.attr, \
588 &sda_in_min[X].dev_attr.attr, \
589 &sda_in_max[X].dev_attr.attr
590
591#define FAN_UNIT_ATTRS(X) \
592 &sda_fan_input[X].dev_attr.attr, \
593 &sda_fan_min[X].dev_attr.attr, \
594 &sda_fan_div[X].dev_attr.attr
595
596#define TEMP_UNIT_ATTRS(X) \
597 &sda_temp_input[X].dev_attr.attr, \
598 &sda_temp_max[X].dev_attr.attr, \
599 &sda_temp_max_hyst[X].dev_attr.attr
600
601#define PWM_UNIT_ATTRS(X) \
602 &sda_pwm[X].dev_attr.attr, \
603 &sda_pwm_mode[X].dev_attr.attr, \
604 &sda_pwm_enable[X].dev_attr.attr
605
606#define TOLERANCE_UNIT_ATTRS(X) \
607 &sda_tolerance[X].dev_attr.attr
608
609static struct attribute *w83l786ng_attributes[] = {
610 IN_UNIT_ATTRS(0),
611 IN_UNIT_ATTRS(1),
612 IN_UNIT_ATTRS(2),
613 FAN_UNIT_ATTRS(0),
614 FAN_UNIT_ATTRS(1),
615 TEMP_UNIT_ATTRS(0),
616 TEMP_UNIT_ATTRS(1),
617 PWM_UNIT_ATTRS(0),
618 PWM_UNIT_ATTRS(1),
619 TOLERANCE_UNIT_ATTRS(0),
620 TOLERANCE_UNIT_ATTRS(1),
621 NULL
622};
623
624static const struct attribute_group w83l786ng_group = {
625 .attrs = w83l786ng_attributes,
626};
627
628static int
629w83l786ng_detect(struct i2c_client *client, struct i2c_board_info *info)
630{
631 struct i2c_adapter *adapter = client->adapter;
632 u16 man_id;
633 u8 chip_id;
634
635 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
636 return -ENODEV;
637
638
639 if ((w83l786ng_read_value(client, W83L786NG_REG_CONFIG) & 0x80)) {
640 dev_dbg(&adapter->dev, "W83L786NG detection failed at 0x%02x\n",
641 client->addr);
642 return -ENODEV;
643 }
644
645
646 man_id = (w83l786ng_read_value(client, W83L786NG_REG_MAN_ID1) << 8) +
647 w83l786ng_read_value(client, W83L786NG_REG_MAN_ID2);
648 chip_id = w83l786ng_read_value(client, W83L786NG_REG_CHIP_ID);
649
650 if (man_id != 0x5CA3 ||
651 chip_id != 0x80) {
652 dev_dbg(&adapter->dev,
653 "Unsupported chip (man_id=0x%04X, chip_id=0x%02X)\n",
654 man_id, chip_id);
655 return -ENODEV;
656 }
657
658 strlcpy(info->type, "w83l786ng", I2C_NAME_SIZE);
659
660 return 0;
661}
662
663static int
664w83l786ng_probe(struct i2c_client *client, const struct i2c_device_id *id)
665{
666 struct device *dev = &client->dev;
667 struct w83l786ng_data *data;
668 int i, err = 0;
669 u8 reg_tmp;
670
671 data = devm_kzalloc(&client->dev, sizeof(struct w83l786ng_data),
672 GFP_KERNEL);
673 if (!data)
674 return -ENOMEM;
675
676 i2c_set_clientdata(client, data);
677 mutex_init(&data->update_lock);
678
679
680 w83l786ng_init_client(client);
681
682
683 for (i = 0; i < 2; i++) {
684 data->fan_min[i] = w83l786ng_read_value(client,
685 W83L786NG_REG_FAN_MIN(i));
686 }
687
688
689 reg_tmp = w83l786ng_read_value(client, W83L786NG_REG_FAN_DIV);
690 data->fan_div[0] = reg_tmp & 0x07;
691 data->fan_div[1] = (reg_tmp >> 4) & 0x07;
692
693
694 err = sysfs_create_group(&client->dev.kobj, &w83l786ng_group);
695 if (err)
696 goto exit_remove;
697
698 data->hwmon_dev = hwmon_device_register(dev);
699 if (IS_ERR(data->hwmon_dev)) {
700 err = PTR_ERR(data->hwmon_dev);
701 goto exit_remove;
702 }
703
704 return 0;
705
706
707
708exit_remove:
709 sysfs_remove_group(&client->dev.kobj, &w83l786ng_group);
710 return err;
711}
712
713static int
714w83l786ng_remove(struct i2c_client *client)
715{
716 struct w83l786ng_data *data = i2c_get_clientdata(client);
717
718 hwmon_device_unregister(data->hwmon_dev);
719 sysfs_remove_group(&client->dev.kobj, &w83l786ng_group);
720
721 return 0;
722}
723
724static void
725w83l786ng_init_client(struct i2c_client *client)
726{
727 u8 tmp;
728
729 if (reset)
730 w83l786ng_write_value(client, W83L786NG_REG_CONFIG, 0x80);
731
732
733 tmp = w83l786ng_read_value(client, W83L786NG_REG_CONFIG);
734 if (!(tmp & 0x01))
735 w83l786ng_write_value(client, W83L786NG_REG_CONFIG, tmp | 0x01);
736}
737
738static struct w83l786ng_data *w83l786ng_update_device(struct device *dev)
739{
740 struct i2c_client *client = to_i2c_client(dev);
741 struct w83l786ng_data *data = i2c_get_clientdata(client);
742 int i, j;
743 u8 reg_tmp, pwmcfg;
744
745 mutex_lock(&data->update_lock);
746 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
747 || !data->valid) {
748 dev_dbg(&client->dev, "Updating w83l786ng data.\n");
749
750
751 for (i = 0; i < 3; i++) {
752 data->in[i] = w83l786ng_read_value(client,
753 W83L786NG_REG_IN(i));
754 data->in_min[i] = w83l786ng_read_value(client,
755 W83L786NG_REG_IN_MIN(i));
756 data->in_max[i] = w83l786ng_read_value(client,
757 W83L786NG_REG_IN_MAX(i));
758 }
759
760
761 for (i = 0; i < 2; i++) {
762 data->fan[i] = w83l786ng_read_value(client,
763 W83L786NG_REG_FAN(i));
764 data->fan_min[i] = w83l786ng_read_value(client,
765 W83L786NG_REG_FAN_MIN(i));
766 }
767
768
769 reg_tmp = w83l786ng_read_value(client, W83L786NG_REG_FAN_DIV);
770 data->fan_div[0] = reg_tmp & 0x07;
771 data->fan_div[1] = (reg_tmp >> 4) & 0x07;
772
773 pwmcfg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG);
774 for (i = 0; i < 2; i++) {
775 data->pwm_mode[i] =
776 ((pwmcfg >> W83L786NG_PWM_MODE_SHIFT[i]) & 1)
777 ? 0 : 1;
778 data->pwm_enable[i] =
779 ((pwmcfg >> W83L786NG_PWM_ENABLE_SHIFT[i]) & 2) + 1;
780 data->pwm[i] = w83l786ng_read_value(client,
781 W83L786NG_REG_PWM[i]);
782 }
783
784
785
786 for (i = 0; i < 2; i++) {
787 for (j = 0; j < 3; j++) {
788 data->temp[i][j] = w83l786ng_read_value(client,
789 W83L786NG_REG_TEMP[i][j]);
790 }
791 }
792
793
794 reg_tmp = w83l786ng_read_value(client, W83L786NG_REG_TOLERANCE);
795 data->tolerance[0] = reg_tmp & 0x0f;
796 data->tolerance[1] = (reg_tmp >> 4) & 0x0f;
797
798 data->last_updated = jiffies;
799 data->valid = 1;
800
801 }
802
803 mutex_unlock(&data->update_lock);
804
805 return data;
806}
807
808module_i2c_driver(w83l786ng_driver);
809
810MODULE_AUTHOR("Kevin Lo");
811MODULE_DESCRIPTION("w83l786ng driver");
812MODULE_LICENSE("GPL");
813
