1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
22
23#include <linux/module.h>
24#include <linux/slab.h>
25#include <linux/pci.h>
26#include <linux/jiffies.h>
27#include <linux/platform_device.h>
28#include <linux/hwmon.h>
29#include <linux/hwmon-sysfs.h>
30#include <linux/err.h>
31#include <linux/init.h>
32#include <linux/mutex.h>
33#include <linux/sysfs.h>
34#include <linux/acpi.h>
35#include <linux/io.h>
36
37
38
39
40
41static unsigned short force_addr;
42module_param(force_addr, ushort, 0);
43MODULE_PARM_DESC(force_addr,
44 "Initialize the base address of the sensors");
45
46static struct platform_device *pdev;
47
48
49
50
51
52
53
54
55
56#define VIA686A_EXTENT 0x80
57#define VIA686A_BASE_REG 0x70
58#define VIA686A_ENABLE_REG 0x74
59
60
61
62#define VIA686A_REG_IN_MAX(nr) (0x2b + ((nr) * 2))
63#define VIA686A_REG_IN_MIN(nr) (0x2c + ((nr) * 2))
64#define VIA686A_REG_IN(nr) (0x22 + (nr))
65
66
67#define VIA686A_REG_FAN_MIN(nr) (0x3a + (nr))
68#define VIA686A_REG_FAN(nr) (0x28 + (nr))
69
70
71static const u8 VIA686A_REG_TEMP[] = { 0x20, 0x21, 0x1f };
72static const u8 VIA686A_REG_TEMP_OVER[] = { 0x39, 0x3d, 0x1d };
73static const u8 VIA686A_REG_TEMP_HYST[] = { 0x3a, 0x3e, 0x1e };
74
75#define VIA686A_REG_TEMP_LOW1 0x4b
76
77#define VIA686A_REG_TEMP_LOW23 0x49
78
79#define VIA686A_REG_ALARM1 0x41
80#define VIA686A_REG_ALARM2 0x42
81#define VIA686A_REG_FANDIV 0x47
82#define VIA686A_REG_CONFIG 0x40
83
84
85
86
87
88
89
90
91#define VIA686A_REG_TEMP_MODE 0x4b
92
93#define VIA686A_TEMP_MODE_MASK 0x3F
94#define VIA686A_TEMP_MODE_CONTINUOUS 0x00
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114static inline u8 IN_TO_REG(long val, int in_num)
115{
116
117
118
119
120
121
122
123 if (in_num <= 1)
124 return (u8) clamp_val((val * 21024 - 1205000) / 250000, 0, 255);
125 else if (in_num == 2)
126 return (u8) clamp_val((val * 15737 - 1205000) / 250000, 0, 255);
127 else if (in_num == 3)
128 return (u8) clamp_val((val * 10108 - 1205000) / 250000, 0, 255);
129 else
130 return (u8) clamp_val((val * 41714 - 12050000) / 2500000, 0,
131 255);
132}
133
134static inline long IN_FROM_REG(u8 val, int in_num)
135{
136
137
138
139
140
141 if (in_num <= 1)
142 return (long) ((250000 * val + 1330000 + 21024 / 2) / 21024);
143 else if (in_num == 2)
144 return (long) ((250000 * val + 1330000 + 15737 / 2) / 15737);
145 else if (in_num == 3)
146 return (long) ((250000 * val + 1330000 + 10108 / 2) / 10108);
147 else
148 return (long) ((2500000 * val + 13300000 + 41714 / 2) / 41714);
149}
150
151
152
153
154
155
156
157static inline u8 FAN_TO_REG(long rpm, int div)
158{
159 if (rpm == 0)
160 return 0;
161 rpm = clamp_val(rpm, 1, 1000000);
162 return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 255);
163}
164
165#define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : (val) == 255 ? 0 : 1350000 / \
166 ((val) * (div)))
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202static const s16 temp_lut[] = {
203 -709, -688, -667, -646, -627, -607, -589, -570, -553, -536, -519,
204 -503, -487, -471, -456, -442, -428, -414, -400, -387, -375,
205 -362, -350, -339, -327, -316, -305, -295, -285, -275, -265,
206 -255, -246, -237, -229, -220, -212, -204, -196, -188, -180,
207 -173, -166, -159, -152, -145, -139, -132, -126, -120, -114,
208 -108, -102, -96, -91, -85, -80, -74, -69, -64, -59, -54, -49,
209 -44, -39, -34, -29, -25, -20, -15, -11, -6, -2, 3, 7, 12, 16,
210 20, 25, 29, 33, 37, 42, 46, 50, 54, 59, 63, 67, 71, 75, 79, 84,
211 88, 92, 96, 100, 104, 109, 113, 117, 121, 125, 130, 134, 138,
212 142, 146, 151, 155, 159, 163, 168, 172, 176, 181, 185, 189,
213 193, 198, 202, 206, 211, 215, 219, 224, 228, 232, 237, 241,
214 245, 250, 254, 259, 263, 267, 272, 276, 281, 285, 290, 294,
215 299, 303, 307, 312, 316, 321, 325, 330, 334, 339, 344, 348,
216 353, 357, 362, 366, 371, 376, 380, 385, 390, 395, 399, 404,
217 409, 414, 419, 423, 428, 433, 438, 443, 449, 454, 459, 464,
218 469, 475, 480, 486, 491, 497, 502, 508, 514, 520, 526, 532,
219 538, 544, 551, 557, 564, 571, 578, 584, 592, 599, 606, 614,
220 621, 629, 637, 645, 654, 662, 671, 680, 689, 698, 708, 718,
221 728, 738, 749, 759, 770, 782, 793, 805, 818, 830, 843, 856,
222 870, 883, 898, 912, 927, 943, 958, 975, 991, 1008, 1026, 1044,
223 1062, 1081, 1101, 1121, 1141, 1162, 1184, 1206, 1229, 1252,
224 1276, 1301, 1326, 1352, 1378, 1406, 1434, 1462
225};
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250static const u8 via_lut[] = {
251 12, 12, 13, 14, 14, 15, 16, 16, 17, 18, 18, 19, 20, 20, 21, 22, 23,
252 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 35, 36, 37, 39, 40,
253 41, 43, 45, 46, 48, 49, 51, 53, 55, 57, 59, 60, 62, 64, 66,
254 69, 71, 73, 75, 77, 79, 82, 84, 86, 88, 91, 93, 95, 98, 100,
255 103, 105, 107, 110, 112, 115, 117, 119, 122, 124, 126, 129,
256 131, 134, 136, 138, 140, 143, 145, 147, 150, 152, 154, 156,
257 158, 160, 162, 164, 166, 168, 170, 172, 174, 176, 178, 180,
258 182, 183, 185, 187, 188, 190, 192, 193, 195, 196, 198, 199,
259 200, 202, 203, 205, 206, 207, 208, 209, 210, 211, 212, 213,
260 214, 215, 216, 217, 218, 219, 220, 221, 222, 222, 223, 224,
261 225, 226, 226, 227, 228, 228, 229, 230, 230, 231, 232, 232,
262 233, 233, 234, 235, 235, 236, 236, 237, 237, 238, 238, 239,
263 239, 240
264};
265
266
267
268
269
270
271static inline u8 TEMP_TO_REG(long val)
272{
273 return via_lut[val <= -50000 ? 0 : val >= 110000 ? 160 :
274 (val < 0 ? val - 500 : val + 500) / 1000 + 50];
275}
276
277
278#define TEMP_FROM_REG(val) ((long)temp_lut[val] * 100)
279
280
281static inline long TEMP_FROM_REG10(u16 val)
282{
283 u16 eight_bits = val >> 2;
284 u16 two_bits = val & 3;
285
286
287 if (two_bits == 0 || eight_bits == 255)
288 return TEMP_FROM_REG(eight_bits);
289
290
291 return (temp_lut[eight_bits] * (4 - two_bits) +
292 temp_lut[eight_bits + 1] * two_bits) * 25;
293}
294
295#define DIV_FROM_REG(val) (1 << (val))
296#define DIV_TO_REG(val) ((val) == 8 ? 3 : (val) == 4 ? 2 : (val) == 1 ? 0 : 1)
297
298
299
300
301
302struct via686a_data {
303 unsigned short addr;
304 const char *name;
305 struct device *hwmon_dev;
306 struct mutex update_lock;
307 char valid;
308 unsigned long last_updated;
309
310 u8 in[5];
311 u8 in_max[5];
312 u8 in_min[5];
313 u8 fan[2];
314 u8 fan_min[2];
315 u16 temp[3];
316 u8 temp_over[3];
317 u8 temp_hyst[3];
318 u8 fan_div[2];
319 u16 alarms;
320};
321
322static struct pci_dev *s_bridge;
323
324static int via686a_probe(struct platform_device *pdev);
325static int via686a_remove(struct platform_device *pdev);
326
327static inline int via686a_read_value(struct via686a_data *data, u8 reg)
328{
329 return inb_p(data->addr + reg);
330}
331
332static inline void via686a_write_value(struct via686a_data *data, u8 reg,
333 u8 value)
334{
335 outb_p(value, data->addr + reg);
336}
337
338static struct via686a_data *via686a_update_device(struct device *dev);
339static void via686a_init_device(struct via686a_data *data);
340
341
342
343
344static ssize_t in_show(struct device *dev, struct device_attribute *da,
345 char *buf) {
346 struct via686a_data *data = via686a_update_device(dev);
347 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
348 int nr = attr->index;
349 return sprintf(buf, "%ld\n", IN_FROM_REG(data->in[nr], nr));
350}
351
352static ssize_t in_min_show(struct device *dev, struct device_attribute *da,
353 char *buf) {
354 struct via686a_data *data = via686a_update_device(dev);
355 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
356 int nr = attr->index;
357 return sprintf(buf, "%ld\n", IN_FROM_REG(data->in_min[nr], nr));
358}
359
360static ssize_t in_max_show(struct device *dev, struct device_attribute *da,
361 char *buf) {
362 struct via686a_data *data = via686a_update_device(dev);
363 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
364 int nr = attr->index;
365 return sprintf(buf, "%ld\n", IN_FROM_REG(data->in_max[nr], nr));
366}
367
368static ssize_t in_min_store(struct device *dev, struct device_attribute *da,
369 const char *buf, size_t count) {
370 struct via686a_data *data = dev_get_drvdata(dev);
371 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
372 int nr = attr->index;
373 unsigned long val;
374 int err;
375
376 err = kstrtoul(buf, 10, &val);
377 if (err)
378 return err;
379
380 mutex_lock(&data->update_lock);
381 data->in_min[nr] = IN_TO_REG(val, nr);
382 via686a_write_value(data, VIA686A_REG_IN_MIN(nr),
383 data->in_min[nr]);
384 mutex_unlock(&data->update_lock);
385 return count;
386}
387static ssize_t in_max_store(struct device *dev, struct device_attribute *da,
388 const char *buf, size_t count) {
389 struct via686a_data *data = dev_get_drvdata(dev);
390 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
391 int nr = attr->index;
392 unsigned long val;
393 int err;
394
395 err = kstrtoul(buf, 10, &val);
396 if (err)
397 return err;
398
399 mutex_lock(&data->update_lock);
400 data->in_max[nr] = IN_TO_REG(val, nr);
401 via686a_write_value(data, VIA686A_REG_IN_MAX(nr),
402 data->in_max[nr]);
403 mutex_unlock(&data->update_lock);
404 return count;
405}
406
407static SENSOR_DEVICE_ATTR_RO(in0_input, in, 0);
408static SENSOR_DEVICE_ATTR_RW(in0_min, in_min, 0);
409static SENSOR_DEVICE_ATTR_RW(in0_max, in_max, 0);
410static SENSOR_DEVICE_ATTR_RO(in1_input, in, 1);
411static SENSOR_DEVICE_ATTR_RW(in1_min, in_min, 1);
412static SENSOR_DEVICE_ATTR_RW(in1_max, in_max, 1);
413static SENSOR_DEVICE_ATTR_RO(in2_input, in, 2);
414static SENSOR_DEVICE_ATTR_RW(in2_min, in_min, 2);
415static SENSOR_DEVICE_ATTR_RW(in2_max, in_max, 2);
416static SENSOR_DEVICE_ATTR_RO(in3_input, in, 3);
417static SENSOR_DEVICE_ATTR_RW(in3_min, in_min, 3);
418static SENSOR_DEVICE_ATTR_RW(in3_max, in_max, 3);
419static SENSOR_DEVICE_ATTR_RO(in4_input, in, 4);
420static SENSOR_DEVICE_ATTR_RW(in4_min, in_min, 4);
421static SENSOR_DEVICE_ATTR_RW(in4_max, in_max, 4);
422
423
424static ssize_t temp_show(struct device *dev, struct device_attribute *da,
425 char *buf) {
426 struct via686a_data *data = via686a_update_device(dev);
427 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
428 int nr = attr->index;
429 return sprintf(buf, "%ld\n", TEMP_FROM_REG10(data->temp[nr]));
430}
431static ssize_t temp_over_show(struct device *dev, struct device_attribute *da,
432 char *buf) {
433 struct via686a_data *data = via686a_update_device(dev);
434 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
435 int nr = attr->index;
436 return sprintf(buf, "%ld\n", TEMP_FROM_REG(data->temp_over[nr]));
437}
438static ssize_t temp_hyst_show(struct device *dev, struct device_attribute *da,
439 char *buf) {
440 struct via686a_data *data = via686a_update_device(dev);
441 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
442 int nr = attr->index;
443 return sprintf(buf, "%ld\n", TEMP_FROM_REG(data->temp_hyst[nr]));
444}
445static ssize_t temp_over_store(struct device *dev,
446 struct device_attribute *da, const char *buf,
447 size_t count) {
448 struct via686a_data *data = dev_get_drvdata(dev);
449 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
450 int nr = attr->index;
451 long val;
452 int err;
453
454 err = kstrtol(buf, 10, &val);
455 if (err)
456 return err;
457
458 mutex_lock(&data->update_lock);
459 data->temp_over[nr] = TEMP_TO_REG(val);
460 via686a_write_value(data, VIA686A_REG_TEMP_OVER[nr],
461 data->temp_over[nr]);
462 mutex_unlock(&data->update_lock);
463 return count;
464}
465static ssize_t temp_hyst_store(struct device *dev,
466 struct device_attribute *da, const char *buf,
467 size_t count) {
468 struct via686a_data *data = dev_get_drvdata(dev);
469 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
470 int nr = attr->index;
471 long val;
472 int err;
473
474 err = kstrtol(buf, 10, &val);
475 if (err)
476 return err;
477
478 mutex_lock(&data->update_lock);
479 data->temp_hyst[nr] = TEMP_TO_REG(val);
480 via686a_write_value(data, VIA686A_REG_TEMP_HYST[nr],
481 data->temp_hyst[nr]);
482 mutex_unlock(&data->update_lock);
483 return count;
484}
485
486static SENSOR_DEVICE_ATTR_RO(temp1_input, temp, 0);
487static SENSOR_DEVICE_ATTR_RW(temp1_max, temp_over, 0);
488static SENSOR_DEVICE_ATTR_RW(temp1_max_hyst, temp_hyst, 0);
489static SENSOR_DEVICE_ATTR_RO(temp2_input, temp, 1);
490static SENSOR_DEVICE_ATTR_RW(temp2_max, temp_over, 1);
491static SENSOR_DEVICE_ATTR_RW(temp2_max_hyst, temp_hyst, 1);
492static SENSOR_DEVICE_ATTR_RO(temp3_input, temp, 2);
493static SENSOR_DEVICE_ATTR_RW(temp3_max, temp_over, 2);
494static SENSOR_DEVICE_ATTR_RW(temp3_max_hyst, temp_hyst, 2);
495
496
497static ssize_t fan_show(struct device *dev, struct device_attribute *da,
498 char *buf) {
499 struct via686a_data *data = via686a_update_device(dev);
500 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
501 int nr = attr->index;
502 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
503 DIV_FROM_REG(data->fan_div[nr])));
504}
505static ssize_t fan_min_show(struct device *dev, struct device_attribute *da,
506 char *buf) {
507 struct via686a_data *data = via686a_update_device(dev);
508 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
509 int nr = attr->index;
510 return sprintf(buf, "%d\n",
511 FAN_FROM_REG(data->fan_min[nr],
512 DIV_FROM_REG(data->fan_div[nr])));
513}
514static ssize_t fan_div_show(struct device *dev, struct device_attribute *da,
515 char *buf) {
516 struct via686a_data *data = via686a_update_device(dev);
517 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
518 int nr = attr->index;
519 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]));
520}
521static ssize_t fan_min_store(struct device *dev, struct device_attribute *da,
522 const char *buf, size_t count) {
523 struct via686a_data *data = dev_get_drvdata(dev);
524 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
525 int nr = attr->index;
526 unsigned long val;
527 int err;
528
529 err = kstrtoul(buf, 10, &val);
530 if (err)
531 return err;
532
533 mutex_lock(&data->update_lock);
534 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
535 via686a_write_value(data, VIA686A_REG_FAN_MIN(nr+1), data->fan_min[nr]);
536 mutex_unlock(&data->update_lock);
537 return count;
538}
539static ssize_t fan_div_store(struct device *dev, struct device_attribute *da,
540 const char *buf, size_t count) {
541 struct via686a_data *data = dev_get_drvdata(dev);
542 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
543 int nr = attr->index;
544 int old;
545 unsigned long val;
546 int err;
547
548 err = kstrtoul(buf, 10, &val);
549 if (err)
550 return err;
551
552 mutex_lock(&data->update_lock);
553 old = via686a_read_value(data, VIA686A_REG_FANDIV);
554 data->fan_div[nr] = DIV_TO_REG(val);
555 old = (old & 0x0f) | (data->fan_div[1] << 6) | (data->fan_div[0] << 4);
556 via686a_write_value(data, VIA686A_REG_FANDIV, old);
557 mutex_unlock(&data->update_lock);
558 return count;
559}
560
561static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0);
562static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0);
563static SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0);
564static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1);
565static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1);
566static SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1);
567
568
569static ssize_t alarms_show(struct device *dev, struct device_attribute *attr,
570 char *buf)
571{
572 struct via686a_data *data = via686a_update_device(dev);
573 return sprintf(buf, "%u\n", data->alarms);
574}
575
576static DEVICE_ATTR_RO(alarms);
577
578static ssize_t alarm_show(struct device *dev, struct device_attribute *attr,
579 char *buf)
580{
581 int bitnr = to_sensor_dev_attr(attr)->index;
582 struct via686a_data *data = via686a_update_device(dev);
583 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
584}
585static SENSOR_DEVICE_ATTR_RO(in0_alarm, alarm, 0);
586static SENSOR_DEVICE_ATTR_RO(in1_alarm, alarm, 1);
587static SENSOR_DEVICE_ATTR_RO(in2_alarm, alarm, 2);
588static SENSOR_DEVICE_ATTR_RO(in3_alarm, alarm, 3);
589static SENSOR_DEVICE_ATTR_RO(in4_alarm, alarm, 8);
590static SENSOR_DEVICE_ATTR_RO(temp1_alarm, alarm, 4);
591static SENSOR_DEVICE_ATTR_RO(temp2_alarm, alarm, 11);
592static SENSOR_DEVICE_ATTR_RO(temp3_alarm, alarm, 15);
593static SENSOR_DEVICE_ATTR_RO(fan1_alarm, alarm, 6);
594static SENSOR_DEVICE_ATTR_RO(fan2_alarm, alarm, 7);
595
596static ssize_t name_show(struct device *dev, struct device_attribute
597 *devattr, char *buf)
598{
599 struct via686a_data *data = dev_get_drvdata(dev);
600 return sprintf(buf, "%s\n", data->name);
601}
602static DEVICE_ATTR_RO(name);
603
604static struct attribute *via686a_attributes[] = {
605 &sensor_dev_attr_in0_input.dev_attr.attr,
606 &sensor_dev_attr_in1_input.dev_attr.attr,
607 &sensor_dev_attr_in2_input.dev_attr.attr,
608 &sensor_dev_attr_in3_input.dev_attr.attr,
609 &sensor_dev_attr_in4_input.dev_attr.attr,
610 &sensor_dev_attr_in0_min.dev_attr.attr,
611 &sensor_dev_attr_in1_min.dev_attr.attr,
612 &sensor_dev_attr_in2_min.dev_attr.attr,
613 &sensor_dev_attr_in3_min.dev_attr.attr,
614 &sensor_dev_attr_in4_min.dev_attr.attr,
615 &sensor_dev_attr_in0_max.dev_attr.attr,
616 &sensor_dev_attr_in1_max.dev_attr.attr,
617 &sensor_dev_attr_in2_max.dev_attr.attr,
618 &sensor_dev_attr_in3_max.dev_attr.attr,
619 &sensor_dev_attr_in4_max.dev_attr.attr,
620 &sensor_dev_attr_in0_alarm.dev_attr.attr,
621 &sensor_dev_attr_in1_alarm.dev_attr.attr,
622 &sensor_dev_attr_in2_alarm.dev_attr.attr,
623 &sensor_dev_attr_in3_alarm.dev_attr.attr,
624 &sensor_dev_attr_in4_alarm.dev_attr.attr,
625
626 &sensor_dev_attr_temp1_input.dev_attr.attr,
627 &sensor_dev_attr_temp2_input.dev_attr.attr,
628 &sensor_dev_attr_temp3_input.dev_attr.attr,
629 &sensor_dev_attr_temp1_max.dev_attr.attr,
630 &sensor_dev_attr_temp2_max.dev_attr.attr,
631 &sensor_dev_attr_temp3_max.dev_attr.attr,
632 &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
633 &sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
634 &sensor_dev_attr_temp3_max_hyst.dev_attr.attr,
635 &sensor_dev_attr_temp1_alarm.dev_attr.attr,
636 &sensor_dev_attr_temp2_alarm.dev_attr.attr,
637 &sensor_dev_attr_temp3_alarm.dev_attr.attr,
638
639 &sensor_dev_attr_fan1_input.dev_attr.attr,
640 &sensor_dev_attr_fan2_input.dev_attr.attr,
641 &sensor_dev_attr_fan1_min.dev_attr.attr,
642 &sensor_dev_attr_fan2_min.dev_attr.attr,
643 &sensor_dev_attr_fan1_div.dev_attr.attr,
644 &sensor_dev_attr_fan2_div.dev_attr.attr,
645 &sensor_dev_attr_fan1_alarm.dev_attr.attr,
646 &sensor_dev_attr_fan2_alarm.dev_attr.attr,
647
648 &dev_attr_alarms.attr,
649 &dev_attr_name.attr,
650 NULL
651};
652
653static const struct attribute_group via686a_group = {
654 .attrs = via686a_attributes,
655};
656
657static struct platform_driver via686a_driver = {
658 .driver = {
659 .name = "via686a",
660 },
661 .probe = via686a_probe,
662 .remove = via686a_remove,
663};
664
665
666static int via686a_probe(struct platform_device *pdev)
667{
668 struct via686a_data *data;
669 struct resource *res;
670 int err;
671
672
673 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
674 if (!devm_request_region(&pdev->dev, res->start, VIA686A_EXTENT,
675 via686a_driver.driver.name)) {
676 dev_err(&pdev->dev, "Region 0x%lx-0x%lx already in use!\n",
677 (unsigned long)res->start, (unsigned long)res->end);
678 return -ENODEV;
679 }
680
681 data = devm_kzalloc(&pdev->dev, sizeof(struct via686a_data),
682 GFP_KERNEL);
683 if (!data)
684 return -ENOMEM;
685
686 platform_set_drvdata(pdev, data);
687 data->addr = res->start;
688 data->name = "via686a";
689 mutex_init(&data->update_lock);
690
691
692 via686a_init_device(data);
693
694
695 err = sysfs_create_group(&pdev->dev.kobj, &via686a_group);
696 if (err)
697 return err;
698
699 data->hwmon_dev = hwmon_device_register(&pdev->dev);
700 if (IS_ERR(data->hwmon_dev)) {
701 err = PTR_ERR(data->hwmon_dev);
702 goto exit_remove_files;
703 }
704
705 return 0;
706
707exit_remove_files:
708 sysfs_remove_group(&pdev->dev.kobj, &via686a_group);
709 return err;
710}
711
712static int via686a_remove(struct platform_device *pdev)
713{
714 struct via686a_data *data = platform_get_drvdata(pdev);
715
716 hwmon_device_unregister(data->hwmon_dev);
717 sysfs_remove_group(&pdev->dev.kobj, &via686a_group);
718
719 return 0;
720}
721
722static void via686a_update_fan_div(struct via686a_data *data)
723{
724 int reg = via686a_read_value(data, VIA686A_REG_FANDIV);
725 data->fan_div[0] = (reg >> 4) & 0x03;
726 data->fan_div[1] = reg >> 6;
727}
728
729static void via686a_init_device(struct via686a_data *data)
730{
731 u8 reg;
732
733
734 reg = via686a_read_value(data, VIA686A_REG_CONFIG);
735 via686a_write_value(data, VIA686A_REG_CONFIG, (reg | 0x01) & 0x7F);
736
737
738 reg = via686a_read_value(data, VIA686A_REG_TEMP_MODE);
739 via686a_write_value(data, VIA686A_REG_TEMP_MODE,
740 (reg & ~VIA686A_TEMP_MODE_MASK)
741 | VIA686A_TEMP_MODE_CONTINUOUS);
742
743
744 via686a_update_fan_div(data);
745}
746
747static struct via686a_data *via686a_update_device(struct device *dev)
748{
749 struct via686a_data *data = dev_get_drvdata(dev);
750 int i;
751
752 mutex_lock(&data->update_lock);
753
754 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
755 || !data->valid) {
756 for (i = 0; i <= 4; i++) {
757 data->in[i] =
758 via686a_read_value(data, VIA686A_REG_IN(i));
759 data->in_min[i] = via686a_read_value(data,
760 VIA686A_REG_IN_MIN
761 (i));
762 data->in_max[i] =
763 via686a_read_value(data, VIA686A_REG_IN_MAX(i));
764 }
765 for (i = 1; i <= 2; i++) {
766 data->fan[i - 1] =
767 via686a_read_value(data, VIA686A_REG_FAN(i));
768 data->fan_min[i - 1] = via686a_read_value(data,
769 VIA686A_REG_FAN_MIN(i));
770 }
771 for (i = 0; i <= 2; i++) {
772 data->temp[i] = via686a_read_value(data,
773 VIA686A_REG_TEMP[i]) << 2;
774 data->temp_over[i] =
775 via686a_read_value(data,
776 VIA686A_REG_TEMP_OVER[i]);
777 data->temp_hyst[i] =
778 via686a_read_value(data,
779 VIA686A_REG_TEMP_HYST[i]);
780 }
781
782
783
784
785
786
787 data->temp[0] |= (via686a_read_value(data,
788 VIA686A_REG_TEMP_LOW1)
789 & 0xc0) >> 6;
790 data->temp[1] |=
791 (via686a_read_value(data, VIA686A_REG_TEMP_LOW23) &
792 0x30) >> 4;
793 data->temp[2] |=
794 (via686a_read_value(data, VIA686A_REG_TEMP_LOW23) &
795 0xc0) >> 6;
796
797 via686a_update_fan_div(data);
798 data->alarms =
799 via686a_read_value(data,
800 VIA686A_REG_ALARM1) |
801 (via686a_read_value(data, VIA686A_REG_ALARM2) << 8);
802 data->last_updated = jiffies;
803 data->valid = 1;
804 }
805
806 mutex_unlock(&data->update_lock);
807
808 return data;
809}
810
811static const struct pci_device_id via686a_pci_ids[] = {
812 { PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686_4) },
813 { }
814};
815MODULE_DEVICE_TABLE(pci, via686a_pci_ids);
816
817static int via686a_device_add(unsigned short address)
818{
819 struct resource res = {
820 .start = address,
821 .end = address + VIA686A_EXTENT - 1,
822 .name = "via686a",
823 .flags = IORESOURCE_IO,
824 };
825 int err;
826
827 err = acpi_check_resource_conflict(&res);
828 if (err)
829 goto exit;
830
831 pdev = platform_device_alloc("via686a", address);
832 if (!pdev) {
833 err = -ENOMEM;
834 pr_err("Device allocation failed\n");
835 goto exit;
836 }
837
838 err = platform_device_add_resources(pdev, &res, 1);
839 if (err) {
840 pr_err("Device resource addition failed (%d)\n", err);
841 goto exit_device_put;
842 }
843
844 err = platform_device_add(pdev);
845 if (err) {
846 pr_err("Device addition failed (%d)\n", err);
847 goto exit_device_put;
848 }
849
850 return 0;
851
852exit_device_put:
853 platform_device_put(pdev);
854exit:
855 return err;
856}
857
858static int via686a_pci_probe(struct pci_dev *dev,
859 const struct pci_device_id *id)
860{
861 u16 address, val;
862
863 if (force_addr) {
864 address = force_addr & ~(VIA686A_EXTENT - 1);
865 dev_warn(&dev->dev, "Forcing ISA address 0x%x\n", address);
866 if (PCIBIOS_SUCCESSFUL !=
867 pci_write_config_word(dev, VIA686A_BASE_REG, address | 1))
868 return -ENODEV;
869 }
870 if (PCIBIOS_SUCCESSFUL !=
871 pci_read_config_word(dev, VIA686A_BASE_REG, &val))
872 return -ENODEV;
873
874 address = val & ~(VIA686A_EXTENT - 1);
875 if (address == 0) {
876 dev_err(&dev->dev,
877 "base address not set - upgrade BIOS or use force_addr=0xaddr\n");
878 return -ENODEV;
879 }
880
881 if (PCIBIOS_SUCCESSFUL !=
882 pci_read_config_word(dev, VIA686A_ENABLE_REG, &val))
883 return -ENODEV;
884 if (!(val & 0x0001)) {
885 if (!force_addr) {
886 dev_warn(&dev->dev,
887 "Sensors disabled, enable with force_addr=0x%x\n",
888 address);
889 return -ENODEV;
890 }
891
892 dev_warn(&dev->dev, "Enabling sensors\n");
893 if (PCIBIOS_SUCCESSFUL !=
894 pci_write_config_word(dev, VIA686A_ENABLE_REG,
895 val | 0x0001))
896 return -ENODEV;
897 }
898
899 if (platform_driver_register(&via686a_driver))
900 goto exit;
901
902
903 if (via686a_device_add(address))
904 goto exit_unregister;
905
906
907
908
909
910
911 s_bridge = pci_dev_get(dev);
912 return -ENODEV;
913
914exit_unregister:
915 platform_driver_unregister(&via686a_driver);
916exit:
917 return -ENODEV;
918}
919
920static struct pci_driver via686a_pci_driver = {
921 .name = "via686a",
922 .id_table = via686a_pci_ids,
923 .probe = via686a_pci_probe,
924};
925
926static int __init sm_via686a_init(void)
927{
928 return pci_register_driver(&via686a_pci_driver);
929}
930
931static void __exit sm_via686a_exit(void)
932{
933 pci_unregister_driver(&via686a_pci_driver);
934 if (s_bridge != NULL) {
935 platform_device_unregister(pdev);
936 platform_driver_unregister(&via686a_driver);
937 pci_dev_put(s_bridge);
938 s_bridge = NULL;
939 }
940}
941
942MODULE_AUTHOR("Kyösti Mälkki <kmalkki@cc.hut.fi>, "
943 "Mark Studebaker <mdsxyz123@yahoo.com> "
944 "and Bob Dougherty <bobd@stanford.edu>");
945MODULE_DESCRIPTION("VIA 686A Sensor device");
946MODULE_LICENSE("GPL");
947
948module_init(sm_via686a_init);
949module_exit(sm_via686a_exit);
950