?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge tag 'trace-printf-v6.13' of git://git.kernel.org/pub/scm/linux/kernel/git/trace...
[drm/drm-misc.git] / drivers / hwmon / vt8231.c
blob3bf27c21845ba505333fc3ecafbef842fc62587b
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * vt8231.c - Part of lm_sensors, Linux kernel modules
4 * for hardware monitoring
5 *
6 * Copyright (c) 2005 Roger Lucas <vt8231@hiddenengine.co.uk>
7 * Copyright (c) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
8 * Aaron M. Marsh <amarsh@sdf.lonestar.org>
9 */
10
11 /*
12 * Supports VIA VT8231 South Bridge embedded sensors
13 */
14
15 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
16
17 #include <linux/module.h>
18 #include <linux/init.h>
19 #include <linux/slab.h>
20 #include <linux/pci.h>
21 #include <linux/jiffies.h>
22 #include <linux/platform_device.h>
23 #include <linux/hwmon.h>
24 #include <linux/hwmon-sysfs.h>
25 #include <linux/err.h>
26 #include <linux/mutex.h>
27 #include <linux/acpi.h>
28 #include <linux/io.h>
29
30 static int force_addr;
31 module_param(force_addr, int, 0);
32 MODULE_PARM_DESC(force_addr, "Initialize the base address of the sensors");
33
34 static struct platform_device *pdev;
35
36 #define VT8231_EXTENT 0x80
37 #define VT8231_BASE_REG 0x70
38 #define VT8231_ENABLE_REG 0x74
39
40 #define DRIVER_NAME "vt8231"
41
42 /*
43 * The VT8231 registers
44 *
45 * The reset value for the input channel configuration is used (Reg 0x4A=0x07)
46 * which sets the selected inputs marked with '*' below if multiple options are
47 * possible:
48 *
49 * Voltage Mode Temperature Mode
50 * Sensor Linux Id Linux Id VIA Id
51 * -------- -------- -------- ------
52 * CPU Diode N/A temp1 0
53 * UIC1 in0 temp2 * 1
54 * UIC2 in1 * temp3 2
55 * UIC3 in2 * temp4 3
56 * UIC4 in3 * temp5 4
57 * UIC5 in4 * temp6 5
58 * 3.3V in5 N/A
59 *
60 * Note that the BIOS may set the configuration register to a different value
61 * to match the motherboard configuration.
62 */
63
64 /* fans numbered 0-1 */
65 #define VT8231_REG_FAN_MIN(nr) (0x3b + (nr))
66 #define VT8231_REG_FAN(nr) (0x29 + (nr))
67
68 /* Voltage inputs numbered 0-5 */
69
70 static const u8 regvolt[] = { 0x21, 0x22, 0x23, 0x24, 0x25, 0x26 };
71 static const u8 regvoltmax[] = { 0x3d, 0x2b, 0x2d, 0x2f, 0x31, 0x33 };
72 static const u8 regvoltmin[] = { 0x3e, 0x2c, 0x2e, 0x30, 0x32, 0x34 };
73
74 /*
75 * Temperatures are numbered 1-6 according to the Linux kernel specification.
76 *
77 * In the VIA datasheet, however, the temperatures are numbered from zero.
78 * Since it is important that this driver can easily be compared to the VIA
79 * datasheet, we will use the VIA numbering within this driver and map the
80 * kernel sysfs device name to the VIA number in the sysfs callback.
81 */
82
83 #define VT8231_REG_TEMP_LOW01 0x49
84 #define VT8231_REG_TEMP_LOW25 0x4d
85
86 static const u8 regtemp[] = { 0x1f, 0x21, 0x22, 0x23, 0x24, 0x25 };
87 static const u8 regtempmax[] = { 0x39, 0x3d, 0x2b, 0x2d, 0x2f, 0x31 };
88 static const u8 regtempmin[] = { 0x3a, 0x3e, 0x2c, 0x2e, 0x30, 0x32 };
89
90 #define TEMP_FROM_REG(reg) (((253 * 4 - (reg)) * 550 + 105) / 210)
91 #define TEMP_MAXMIN_FROM_REG(reg) (((253 - (reg)) * 2200 + 105) / 210)
92 #define TEMP_MAXMIN_TO_REG(val) (253 - ((val) * 210 + 1100) / 2200)
93
94 #define VT8231_REG_CONFIG 0x40
95 #define VT8231_REG_ALARM1 0x41
96 #define VT8231_REG_ALARM2 0x42
97 #define VT8231_REG_FANDIV 0x47
98 #define VT8231_REG_UCH_CONFIG 0x4a
99 #define VT8231_REG_TEMP1_CONFIG 0x4b
100 #define VT8231_REG_TEMP2_CONFIG 0x4c
101
102 /*
103 * temps 0-5 as numbered in VIA datasheet - see later for mapping to Linux
104 * numbering
105 */
106 #define ISTEMP(i, ch_config) ((i) == 0 ? 1 : \
107 ((ch_config) >> ((i)+1)) & 0x01)
108 /* voltages 0-5 */
109 #define ISVOLT(i, ch_config) ((i) == 5 ? 1 : \
110 !(((ch_config) >> ((i)+2)) & 0x01))
111
112 #define DIV_FROM_REG(val) (1 << (val))
113
114 /*
115 * NB The values returned here are NOT temperatures. The calibration curves
116 * for the thermistor curves are board-specific and must go in the
117 * sensors.conf file. Temperature sensors are actually ten bits, but the
118 * VIA datasheet only considers the 8 MSBs obtained from the regtemp[]
119 * register. The temperature value returned should have a magnitude of 3,
120 * so we use the VIA scaling as the "true" scaling and use the remaining 2
121 * LSBs as fractional precision.
122 *
123 * All the on-chip hardware temperature comparisons for the alarms are only
124 * 8-bits wide, and compare against the 8 MSBs of the temperature. The bits
125 * in the registers VT8231_REG_TEMP_LOW01 and VT8231_REG_TEMP_LOW25 are
126 * ignored.
127 */
128
129 /*
130 ****** FAN RPM CONVERSIONS ********
131 * This chip saturates back at 0, not at 255 like many the other chips.
132 * So, 0 means 0 RPM
133 */
134 static inline u8 FAN_TO_REG(long rpm, int div)
135 {
136 if (rpm <= 0 || rpm > 1310720)
137 return 0;
138 return clamp_val(1310720 / (rpm * div), 1, 255);
139 }
140
141 #define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : 1310720 / ((val) * (div)))
142
143 struct vt8231_data {
144 unsigned short addr;
145 const char *name;
146
147 struct mutex update_lock;
148 struct device *hwmon_dev;
149 bool valid; /* true if following fields are valid */
150 unsigned long last_updated; /* In jiffies */
151
152 u8 in[6]; /* Register value */
153 u8 in_max[6]; /* Register value */
154 u8 in_min[6]; /* Register value */
155 u16 temp[6]; /* Register value 10 bit, right aligned */
156 u8 temp_max[6]; /* Register value */
157 u8 temp_min[6]; /* Register value */
158 u8 fan[2]; /* Register value */
159 u8 fan_min[2]; /* Register value */
160 u8 fan_div[2]; /* Register encoding, shifted right */
161 u16 alarms; /* Register encoding */
162 u8 uch_config;
163 };
164
165 static struct pci_dev *s_bridge;
166
167 static inline int vt8231_read_value(struct vt8231_data *data, u8 reg)
168 {
169 return inb_p(data->addr + reg);
170 }
171
172 static inline void vt8231_write_value(struct vt8231_data *data, u8 reg,
173 u8 value)
174 {
175 outb_p(value, data->addr + reg);
176 }
177
178 static struct vt8231_data *vt8231_update_device(struct device *dev)
179 {
180 struct vt8231_data *data = dev_get_drvdata(dev);
181 int i;
182 u16 low;
183
184 mutex_lock(&data->update_lock);
185
186 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
187 || !data->valid) {
188 for (i = 0; i < 6; i++) {
189 if (ISVOLT(i, data->uch_config)) {
190 data->in[i] = vt8231_read_value(data,
191 regvolt[i]);
192 data->in_min[i] = vt8231_read_value(data,
193 regvoltmin[i]);
194 data->in_max[i] = vt8231_read_value(data,
195 regvoltmax[i]);
196 }
197 }
198 for (i = 0; i < 2; i++) {
199 data->fan[i] = vt8231_read_value(data,
200 VT8231_REG_FAN(i));
201 data->fan_min[i] = vt8231_read_value(data,
202 VT8231_REG_FAN_MIN(i));
203 }
204
205 low = vt8231_read_value(data, VT8231_REG_TEMP_LOW01);
206 low = (low >> 6) | ((low & 0x30) >> 2)
207 | (vt8231_read_value(data, VT8231_REG_TEMP_LOW25) << 4);
208 for (i = 0; i < 6; i++) {
209 if (ISTEMP(i, data->uch_config)) {
210 data->temp[i] = (vt8231_read_value(data,
211 regtemp[i]) << 2)
212 | ((low >> (2 * i)) & 0x03);
213 data->temp_max[i] = vt8231_read_value(data,
214 regtempmax[i]);
215 data->temp_min[i] = vt8231_read_value(data,
216 regtempmin[i]);
217 }
218 }
219
220 i = vt8231_read_value(data, VT8231_REG_FANDIV);
221 data->fan_div[0] = (i >> 4) & 0x03;
222 data->fan_div[1] = i >> 6;
223 data->alarms = vt8231_read_value(data, VT8231_REG_ALARM1) |
224 (vt8231_read_value(data, VT8231_REG_ALARM2) << 8);
225
226 /* Set alarm flags correctly */
227 if (!data->fan[0] && data->fan_min[0])
228 data->alarms |= 0x40;
229 else if (data->fan[0] && !data->fan_min[0])
230 data->alarms &= ~0x40;
231
232 if (!data->fan[1] && data->fan_min[1])
233 data->alarms |= 0x80;
234 else if (data->fan[1] && !data->fan_min[1])
235 data->alarms &= ~0x80;
236
237 data->last_updated = jiffies;
238 data->valid = true;
239 }
240
241 mutex_unlock(&data->update_lock);
242
243 return data;
244 }
245
246 /* following are the sysfs callback functions */
247 static ssize_t in_show(struct device *dev, struct device_attribute *attr,
248 char *buf)
249 {
250 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
251 int nr = sensor_attr->index;
252 struct vt8231_data *data = vt8231_update_device(dev);
253
254 return sprintf(buf, "%d\n", ((data->in[nr] - 3) * 10000) / 958);
255 }
256
257 static ssize_t in_min_show(struct device *dev, struct device_attribute *attr,
258 char *buf)
259 {
260 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
261 int nr = sensor_attr->index;
262 struct vt8231_data *data = vt8231_update_device(dev);
263
264 return sprintf(buf, "%d\n", ((data->in_min[nr] - 3) * 10000) / 958);
265 }
266
267 static ssize_t in_max_show(struct device *dev, struct device_attribute *attr,
268 char *buf)
269 {
270 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
271 int nr = sensor_attr->index;
272 struct vt8231_data *data = vt8231_update_device(dev);
273
274 return sprintf(buf, "%d\n", (((data->in_max[nr] - 3) * 10000) / 958));
275 }
276
277 static ssize_t in_min_store(struct device *dev, struct device_attribute *attr,
278 const char *buf, size_t count)
279 {
280 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
281 int nr = sensor_attr->index;
282 struct vt8231_data *data = dev_get_drvdata(dev);
283 unsigned long val;
284 int err;
285
286 err = kstrtoul(buf, 10, &val);
287 if (err)
288 return err;
289
290 mutex_lock(&data->update_lock);
291 data->in_min[nr] = clamp_val(((val * 958) / 10000) + 3, 0, 255);
292 vt8231_write_value(data, regvoltmin[nr], data->in_min[nr]);
293 mutex_unlock(&data->update_lock);
294 return count;
295 }
296
297 static ssize_t in_max_store(struct device *dev, struct device_attribute *attr,
298 const char *buf, size_t count)
299 {
300 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
301 int nr = sensor_attr->index;
302 struct vt8231_data *data = dev_get_drvdata(dev);
303 unsigned long val;
304 int err;
305
306 err = kstrtoul(buf, 10, &val);
307 if (err)
308 return err;
309
310 mutex_lock(&data->update_lock);
311 data->in_max[nr] = clamp_val(((val * 958) / 10000) + 3, 0, 255);
312 vt8231_write_value(data, regvoltmax[nr], data->in_max[nr]);
313 mutex_unlock(&data->update_lock);
314 return count;
315 }
316
317 /* Special case for input 5 as this has 3.3V scaling built into the chip */
318 static ssize_t in5_input_show(struct device *dev,
319 struct device_attribute *attr, char *buf)
320 {
321 struct vt8231_data *data = vt8231_update_device(dev);
322
323 return sprintf(buf, "%d\n",
324 (((data->in[5] - 3) * 10000 * 54) / (958 * 34)));
325 }
326
327 static ssize_t in5_min_show(struct device *dev, struct device_attribute *attr,
328 char *buf)
329 {
330 struct vt8231_data *data = vt8231_update_device(dev);
331
332 return sprintf(buf, "%d\n",
333 (((data->in_min[5] - 3) * 10000 * 54) / (958 * 34)));
334 }
335
336 static ssize_t in5_max_show(struct device *dev, struct device_attribute *attr,
337 char *buf)
338 {
339 struct vt8231_data *data = vt8231_update_device(dev);
340
341 return sprintf(buf, "%d\n",
342 (((data->in_max[5] - 3) * 10000 * 54) / (958 * 34)));
343 }
344
345 static ssize_t in5_min_store(struct device *dev,
346 struct device_attribute *attr, const char *buf,
347 size_t count)
348 {
349 struct vt8231_data *data = dev_get_drvdata(dev);
350 unsigned long val;
351 int err;
352
353 err = kstrtoul(buf, 10, &val);
354 if (err)
355 return err;
356
357 mutex_lock(&data->update_lock);
358 data->in_min[5] = clamp_val(((val * 958 * 34) / (10000 * 54)) + 3,
359 0, 255);
360 vt8231_write_value(data, regvoltmin[5], data->in_min[5]);
361 mutex_unlock(&data->update_lock);
362 return count;
363 }
364
365 static ssize_t in5_max_store(struct device *dev,
366 struct device_attribute *attr, const char *buf,
367 size_t count)
368 {
369 struct vt8231_data *data = dev_get_drvdata(dev);
370 unsigned long val;
371 int err;
372
373 err = kstrtoul(buf, 10, &val);
374 if (err)
375 return err;
376
377 mutex_lock(&data->update_lock);
378 data->in_max[5] = clamp_val(((val * 958 * 34) / (10000 * 54)) + 3,
379 0, 255);
380 vt8231_write_value(data, regvoltmax[5], data->in_max[5]);
381 mutex_unlock(&data->update_lock);
382 return count;
383 }
384
385 static SENSOR_DEVICE_ATTR_RO(in0_input, in, 0);
386 static SENSOR_DEVICE_ATTR_RW(in0_min, in_min, 0);
387 static SENSOR_DEVICE_ATTR_RW(in0_max, in_max, 0);
388 static SENSOR_DEVICE_ATTR_RO(in1_input, in, 1);
389 static SENSOR_DEVICE_ATTR_RW(in1_min, in_min, 1);
390 static SENSOR_DEVICE_ATTR_RW(in1_max, in_max, 1);
391 static SENSOR_DEVICE_ATTR_RO(in2_input, in, 2);
392 static SENSOR_DEVICE_ATTR_RW(in2_min, in_min, 2);
393 static SENSOR_DEVICE_ATTR_RW(in2_max, in_max, 2);
394 static SENSOR_DEVICE_ATTR_RO(in3_input, in, 3);
395 static SENSOR_DEVICE_ATTR_RW(in3_min, in_min, 3);
396 static SENSOR_DEVICE_ATTR_RW(in3_max, in_max, 3);
397 static SENSOR_DEVICE_ATTR_RO(in4_input, in, 4);
398 static SENSOR_DEVICE_ATTR_RW(in4_min, in_min, 4);
399 static SENSOR_DEVICE_ATTR_RW(in4_max, in_max, 4);
400
401 static DEVICE_ATTR_RO(in5_input);
402 static DEVICE_ATTR_RW(in5_min);
403 static DEVICE_ATTR_RW(in5_max);
404
405 /* Temperatures */
406 static ssize_t temp1_input_show(struct device *dev,
407 struct device_attribute *attr, char *buf)
408 {
409 struct vt8231_data *data = vt8231_update_device(dev);
410 return sprintf(buf, "%d\n", data->temp[0] * 250);
411 }
412
413 static ssize_t temp1_max_show(struct device *dev, struct device_attribute *attr,
414 char *buf)
415 {
416 struct vt8231_data *data = vt8231_update_device(dev);
417 return sprintf(buf, "%d\n", data->temp_max[0] * 1000);
418 }
419
420 static ssize_t temp1_max_hyst_show(struct device *dev,
421 struct device_attribute *attr, char *buf)
422 {
423 struct vt8231_data *data = vt8231_update_device(dev);
424 return sprintf(buf, "%d\n", data->temp_min[0] * 1000);
425 }
426
427 static ssize_t temp1_max_store(struct device *dev,
428 struct device_attribute *attr, const char *buf,
429 size_t count)
430 {
431 struct vt8231_data *data = dev_get_drvdata(dev);
432 long val;
433 int err;
434
435 err = kstrtol(buf, 10, &val);
436 if (err)
437 return err;
438
439 mutex_lock(&data->update_lock);
440 data->temp_max[0] = clamp_val((val + 500) / 1000, 0, 255);
441 vt8231_write_value(data, regtempmax[0], data->temp_max[0]);
442 mutex_unlock(&data->update_lock);
443 return count;
444 }
445 static ssize_t temp1_max_hyst_store(struct device *dev,
446 struct device_attribute *attr,
447 const char *buf, size_t count)
448 {
449 struct vt8231_data *data = dev_get_drvdata(dev);
450 long val;
451 int err;
452
453 err = kstrtol(buf, 10, &val);
454 if (err)
455 return err;
456
457 mutex_lock(&data->update_lock);
458 data->temp_min[0] = clamp_val((val + 500) / 1000, 0, 255);
459 vt8231_write_value(data, regtempmin[0], data->temp_min[0]);
460 mutex_unlock(&data->update_lock);
461 return count;
462 }
463
464 static ssize_t temp_show(struct device *dev, struct device_attribute *attr,
465 char *buf)
466 {
467 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
468 int nr = sensor_attr->index;
469 struct vt8231_data *data = vt8231_update_device(dev);
470 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr]));
471 }
472
473 static ssize_t temp_max_show(struct device *dev,
474 struct device_attribute *attr, char *buf)
475 {
476 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
477 int nr = sensor_attr->index;
478 struct vt8231_data *data = vt8231_update_device(dev);
479 return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_max[nr]));
480 }
481
482 static ssize_t temp_min_show(struct device *dev,
483 struct device_attribute *attr, char *buf)
484 {
485 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
486 int nr = sensor_attr->index;
487 struct vt8231_data *data = vt8231_update_device(dev);
488 return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_min[nr]));
489 }
490
491 static ssize_t temp_max_store(struct device *dev,
492 struct device_attribute *attr, const char *buf,
493 size_t count)
494 {
495 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
496 int nr = sensor_attr->index;
497 struct vt8231_data *data = dev_get_drvdata(dev);
498 long val;
499 int err;
500
501 err = kstrtol(buf, 10, &val);
502 if (err)
503 return err;
504
505 mutex_lock(&data->update_lock);
506 data->temp_max[nr] = clamp_val(TEMP_MAXMIN_TO_REG(val), 0, 255);
507 vt8231_write_value(data, regtempmax[nr], data->temp_max[nr]);
508 mutex_unlock(&data->update_lock);
509 return count;
510 }
511 static ssize_t temp_min_store(struct device *dev,
512 struct device_attribute *attr, const char *buf,
513 size_t count)
514 {
515 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
516 int nr = sensor_attr->index;
517 struct vt8231_data *data = dev_get_drvdata(dev);
518 long val;
519 int err;
520
521 err = kstrtol(buf, 10, &val);
522 if (err)
523 return err;
524
525 mutex_lock(&data->update_lock);
526 data->temp_min[nr] = clamp_val(TEMP_MAXMIN_TO_REG(val), 0, 255);
527 vt8231_write_value(data, regtempmin[nr], data->temp_min[nr]);
528 mutex_unlock(&data->update_lock);
529 return count;
530 }
531
532 /*
533 * Note that these map the Linux temperature sensor numbering (1-6) to the VIA
534 * temperature sensor numbering (0-5)
535 */
536
537 static DEVICE_ATTR_RO(temp1_input);
538 static DEVICE_ATTR_RW(temp1_max);
539 static DEVICE_ATTR_RW(temp1_max_hyst);
540
541 static SENSOR_DEVICE_ATTR_RO(temp2_input, temp, 1);
542 static SENSOR_DEVICE_ATTR_RW(temp2_max, temp_max, 1);
543 static SENSOR_DEVICE_ATTR_RW(temp2_max_hyst, temp_min, 1);
544 static SENSOR_DEVICE_ATTR_RO(temp3_input, temp, 2);
545 static SENSOR_DEVICE_ATTR_RW(temp3_max, temp_max, 2);
546 static SENSOR_DEVICE_ATTR_RW(temp3_max_hyst, temp_min, 2);
547 static SENSOR_DEVICE_ATTR_RO(temp4_input, temp, 3);
548 static SENSOR_DEVICE_ATTR_RW(temp4_max, temp_max, 3);
549 static SENSOR_DEVICE_ATTR_RW(temp4_max_hyst, temp_min, 3);
550 static SENSOR_DEVICE_ATTR_RO(temp5_input, temp, 4);
551 static SENSOR_DEVICE_ATTR_RW(temp5_max, temp_max, 4);
552 static SENSOR_DEVICE_ATTR_RW(temp5_max_hyst, temp_min, 4);
553 static SENSOR_DEVICE_ATTR_RO(temp6_input, temp, 5);
554 static SENSOR_DEVICE_ATTR_RW(temp6_max, temp_max, 5);
555 static SENSOR_DEVICE_ATTR_RW(temp6_max_hyst, temp_min, 5);
556
557 /* Fans */
558 static ssize_t fan_show(struct device *dev, struct device_attribute *attr,
559 char *buf)
560 {
561 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
562 int nr = sensor_attr->index;
563 struct vt8231_data *data = vt8231_update_device(dev);
564 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
565 DIV_FROM_REG(data->fan_div[nr])));
566 }
567
568 static ssize_t fan_min_show(struct device *dev, struct device_attribute *attr,
569 char *buf)
570 {
571 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
572 int nr = sensor_attr->index;
573 struct vt8231_data *data = vt8231_update_device(dev);
574 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr],
575 DIV_FROM_REG(data->fan_div[nr])));
576 }
577
578 static ssize_t fan_div_show(struct device *dev, struct device_attribute *attr,
579 char *buf)
580 {
581 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
582 int nr = sensor_attr->index;
583 struct vt8231_data *data = vt8231_update_device(dev);
584 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]));
585 }
586
587 static ssize_t fan_min_store(struct device *dev,
588 struct device_attribute *attr, const char *buf,
589 size_t count)
590 {
591 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
592 int nr = sensor_attr->index;
593 struct vt8231_data *data = dev_get_drvdata(dev);
594 unsigned long val;
595 int err;
596
597 err = kstrtoul(buf, 10, &val);
598 if (err)
599 return err;
600
601 mutex_lock(&data->update_lock);
602 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
603 vt8231_write_value(data, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
604 mutex_unlock(&data->update_lock);
605 return count;
606 }
607
608 static ssize_t fan_div_store(struct device *dev,
609 struct device_attribute *attr, const char *buf,
610 size_t count)
611 {
612 struct vt8231_data *data = dev_get_drvdata(dev);
613 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
614 unsigned long val;
615 int nr = sensor_attr->index;
616 int old = vt8231_read_value(data, VT8231_REG_FANDIV);
617 long min = FAN_FROM_REG(data->fan_min[nr],
618 DIV_FROM_REG(data->fan_div[nr]));
619 int err;
620
621 err = kstrtoul(buf, 10, &val);
622 if (err)
623 return err;
624
625 mutex_lock(&data->update_lock);
626 switch (val) {
627 case 1:
628 data->fan_div[nr] = 0;
629 break;
630 case 2:
631 data->fan_div[nr] = 1;
632 break;
633 case 4:
634 data->fan_div[nr] = 2;
635 break;
636 case 8:
637 data->fan_div[nr] = 3;
638 break;
639 default:
640 dev_err(dev,
641 "fan_div value %ld not supported. Choose one of 1, 2, 4 or 8!\n",
642 val);
643 mutex_unlock(&data->update_lock);
644 return -EINVAL;
645 }
646
647 /* Correct the fan minimum speed */
648 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
649 vt8231_write_value(data, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
650
651 old = (old & 0x0f) | (data->fan_div[1] << 6) | (data->fan_div[0] << 4);
652 vt8231_write_value(data, VT8231_REG_FANDIV, old);
653 mutex_unlock(&data->update_lock);
654 return count;
655 }
656
657 static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0);
658 static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0);
659 static SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0);
660 static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1);
661 static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1);
662 static SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1);
663
664 /* Alarms */
665 static ssize_t alarms_show(struct device *dev, struct device_attribute *attr,
666 char *buf)
667 {
668 struct vt8231_data *data = vt8231_update_device(dev);
669 return sprintf(buf, "%d\n", data->alarms);
670 }
671 static DEVICE_ATTR_RO(alarms);
672
673 static ssize_t alarm_show(struct device *dev, struct device_attribute *attr,
674 char *buf)
675 {
676 int bitnr = to_sensor_dev_attr(attr)->index;
677 struct vt8231_data *data = vt8231_update_device(dev);
678 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
679 }
680 static SENSOR_DEVICE_ATTR_RO(temp1_alarm, alarm, 4);
681 static SENSOR_DEVICE_ATTR_RO(temp2_alarm, alarm, 11);
682 static SENSOR_DEVICE_ATTR_RO(temp3_alarm, alarm, 0);
683 static SENSOR_DEVICE_ATTR_RO(temp4_alarm, alarm, 1);
684 static SENSOR_DEVICE_ATTR_RO(temp5_alarm, alarm, 3);
685 static SENSOR_DEVICE_ATTR_RO(temp6_alarm, alarm, 8);
686 static SENSOR_DEVICE_ATTR_RO(in0_alarm, alarm, 11);
687 static SENSOR_DEVICE_ATTR_RO(in1_alarm, alarm, 0);
688 static SENSOR_DEVICE_ATTR_RO(in2_alarm, alarm, 1);
689 static SENSOR_DEVICE_ATTR_RO(in3_alarm, alarm, 3);
690 static SENSOR_DEVICE_ATTR_RO(in4_alarm, alarm, 8);
691 static SENSOR_DEVICE_ATTR_RO(in5_alarm, alarm, 2);
692 static SENSOR_DEVICE_ATTR_RO(fan1_alarm, alarm, 6);
693 static SENSOR_DEVICE_ATTR_RO(fan2_alarm, alarm, 7);
694
695 static ssize_t name_show(struct device *dev, struct device_attribute
696 *devattr, char *buf)
697 {
698 struct vt8231_data *data = dev_get_drvdata(dev);
699 return sprintf(buf, "%s\n", data->name);
700 }
701 static DEVICE_ATTR_RO(name);
702
703 static struct attribute *vt8231_attributes_temps[6][5] = {
704 {
705 &dev_attr_temp1_input.attr,
706 &dev_attr_temp1_max_hyst.attr,
707 &dev_attr_temp1_max.attr,
708 &sensor_dev_attr_temp1_alarm.dev_attr.attr,
709 NULL
710 }, {
711 &sensor_dev_attr_temp2_input.dev_attr.attr,
712 &sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
713 &sensor_dev_attr_temp2_max.dev_attr.attr,
714 &sensor_dev_attr_temp2_alarm.dev_attr.attr,
715 NULL
716 }, {
717 &sensor_dev_attr_temp3_input.dev_attr.attr,
718 &sensor_dev_attr_temp3_max_hyst.dev_attr.attr,
719 &sensor_dev_attr_temp3_max.dev_attr.attr,
720 &sensor_dev_attr_temp3_alarm.dev_attr.attr,
721 NULL
722 }, {
723 &sensor_dev_attr_temp4_input.dev_attr.attr,
724 &sensor_dev_attr_temp4_max_hyst.dev_attr.attr,
725 &sensor_dev_attr_temp4_max.dev_attr.attr,
726 &sensor_dev_attr_temp4_alarm.dev_attr.attr,
727 NULL
728 }, {
729 &sensor_dev_attr_temp5_input.dev_attr.attr,
730 &sensor_dev_attr_temp5_max_hyst.dev_attr.attr,
731 &sensor_dev_attr_temp5_max.dev_attr.attr,
732 &sensor_dev_attr_temp5_alarm.dev_attr.attr,
733 NULL
734 }, {
735 &sensor_dev_attr_temp6_input.dev_attr.attr,
736 &sensor_dev_attr_temp6_max_hyst.dev_attr.attr,
737 &sensor_dev_attr_temp6_max.dev_attr.attr,
738 &sensor_dev_attr_temp6_alarm.dev_attr.attr,
739 NULL
740 }
741 };
742
743 static const struct attribute_group vt8231_group_temps[6] = {
744 { .attrs = vt8231_attributes_temps[0] },
745 { .attrs = vt8231_attributes_temps[1] },
746 { .attrs = vt8231_attributes_temps[2] },
747 { .attrs = vt8231_attributes_temps[3] },
748 { .attrs = vt8231_attributes_temps[4] },
749 { .attrs = vt8231_attributes_temps[5] },
750 };
751
752 static struct attribute *vt8231_attributes_volts[6][5] = {
753 {
754 &sensor_dev_attr_in0_input.dev_attr.attr,
755 &sensor_dev_attr_in0_min.dev_attr.attr,
756 &sensor_dev_attr_in0_max.dev_attr.attr,
757 &sensor_dev_attr_in0_alarm.dev_attr.attr,
758 NULL
759 }, {
760 &sensor_dev_attr_in1_input.dev_attr.attr,
761 &sensor_dev_attr_in1_min.dev_attr.attr,
762 &sensor_dev_attr_in1_max.dev_attr.attr,
763 &sensor_dev_attr_in1_alarm.dev_attr.attr,
764 NULL
765 }, {
766 &sensor_dev_attr_in2_input.dev_attr.attr,
767 &sensor_dev_attr_in2_min.dev_attr.attr,
768 &sensor_dev_attr_in2_max.dev_attr.attr,
769 &sensor_dev_attr_in2_alarm.dev_attr.attr,
770 NULL
771 }, {
772 &sensor_dev_attr_in3_input.dev_attr.attr,
773 &sensor_dev_attr_in3_min.dev_attr.attr,
774 &sensor_dev_attr_in3_max.dev_attr.attr,
775 &sensor_dev_attr_in3_alarm.dev_attr.attr,
776 NULL
777 }, {
778 &sensor_dev_attr_in4_input.dev_attr.attr,
779 &sensor_dev_attr_in4_min.dev_attr.attr,
780 &sensor_dev_attr_in4_max.dev_attr.attr,
781 &sensor_dev_attr_in4_alarm.dev_attr.attr,
782 NULL
783 }, {
784 &dev_attr_in5_input.attr,
785 &dev_attr_in5_min.attr,
786 &dev_attr_in5_max.attr,
787 &sensor_dev_attr_in5_alarm.dev_attr.attr,
788 NULL
789 }
790 };
791
792 static const struct attribute_group vt8231_group_volts[6] = {
793 { .attrs = vt8231_attributes_volts[0] },
794 { .attrs = vt8231_attributes_volts[1] },
795 { .attrs = vt8231_attributes_volts[2] },
796 { .attrs = vt8231_attributes_volts[3] },
797 { .attrs = vt8231_attributes_volts[4] },
798 { .attrs = vt8231_attributes_volts[5] },
799 };
800
801 static struct attribute *vt8231_attributes[] = {
802 &sensor_dev_attr_fan1_input.dev_attr.attr,
803 &sensor_dev_attr_fan2_input.dev_attr.attr,
804 &sensor_dev_attr_fan1_min.dev_attr.attr,
805 &sensor_dev_attr_fan2_min.dev_attr.attr,
806 &sensor_dev_attr_fan1_div.dev_attr.attr,
807 &sensor_dev_attr_fan2_div.dev_attr.attr,
808 &sensor_dev_attr_fan1_alarm.dev_attr.attr,
809 &sensor_dev_attr_fan2_alarm.dev_attr.attr,
810 &dev_attr_alarms.attr,
811 &dev_attr_name.attr,
812 NULL
813 };
814
815 static const struct attribute_group vt8231_group = {
816 .attrs = vt8231_attributes,
817 };
818
819 static void vt8231_init_device(struct vt8231_data *data)
820 {
821 vt8231_write_value(data, VT8231_REG_TEMP1_CONFIG, 0);
822 vt8231_write_value(data, VT8231_REG_TEMP2_CONFIG, 0);
823 }
824
825 static int vt8231_probe(struct platform_device *pdev)
826 {
827 struct resource *res;
828 struct vt8231_data *data;
829 int err = 0, i;
830
831 /* Reserve the ISA region */
832 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
833 if (!devm_request_region(&pdev->dev, res->start, VT8231_EXTENT,
834 DRIVER_NAME)) {
835 dev_err(&pdev->dev, "Region 0x%lx-0x%lx already in use!\n",
836 (unsigned long)res->start, (unsigned long)res->end);
837 return -ENODEV;
838 }
839
840 data = devm_kzalloc(&pdev->dev, sizeof(struct vt8231_data), GFP_KERNEL);
841 if (!data)
842 return -ENOMEM;
843
844 platform_set_drvdata(pdev, data);
845 data->addr = res->start;
846 data->name = DRIVER_NAME;
847
848 mutex_init(&data->update_lock);
849 vt8231_init_device(data);
850
851 /* Register sysfs hooks */
852 err = sysfs_create_group(&pdev->dev.kobj, &vt8231_group);
853 if (err)
854 return err;
855
856 /* Must update device information to find out the config field */
857 data->uch_config = vt8231_read_value(data, VT8231_REG_UCH_CONFIG);
858
859 for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++) {
860 if (ISTEMP(i, data->uch_config)) {
861 err = sysfs_create_group(&pdev->dev.kobj,
862 &vt8231_group_temps[i]);
863 if (err)
864 goto exit_remove_files;
865 }
866 }
867
868 for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++) {
869 if (ISVOLT(i, data->uch_config)) {
870 err = sysfs_create_group(&pdev->dev.kobj,
871 &vt8231_group_volts[i]);
872 if (err)
873 goto exit_remove_files;
874 }
875 }
876
877 data->hwmon_dev = hwmon_device_register(&pdev->dev);
878 if (IS_ERR(data->hwmon_dev)) {
879 err = PTR_ERR(data->hwmon_dev);
880 goto exit_remove_files;
881 }
882 return 0;
883
884 exit_remove_files:
885 for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++)
886 sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_volts[i]);
887
888 for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++)
889 sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_temps[i]);
890
891 sysfs_remove_group(&pdev->dev.kobj, &vt8231_group);
892 return err;
893 }
894
895 static void vt8231_remove(struct platform_device *pdev)
896 {
897 struct vt8231_data *data = platform_get_drvdata(pdev);
898 int i;
899
900 hwmon_device_unregister(data->hwmon_dev);
901
902 for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++)
903 sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_volts[i]);
904
905 for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++)
906 sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_temps[i]);
907
908 sysfs_remove_group(&pdev->dev.kobj, &vt8231_group);
909 }
910
911
912 static struct platform_driver vt8231_driver = {
913 .driver = {
914 .name = DRIVER_NAME,
915 },
916 .probe = vt8231_probe,
917 .remove = vt8231_remove,
918 };
919
920 static const struct pci_device_id vt8231_pci_ids[] = {
921 { PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8231_4) },
922 { 0, }
923 };
924
925 MODULE_DEVICE_TABLE(pci, vt8231_pci_ids);
926
927 static int vt8231_device_add(unsigned short address)
928 {
929 struct resource res = {
930 .start = address,
931 .end = address + VT8231_EXTENT - 1,
932 .name = DRIVER_NAME,
933 .flags = IORESOURCE_IO,
934 };
935 int err;
936
937 err = acpi_check_resource_conflict(&res);
938 if (err)
939 goto exit;
940
941 pdev = platform_device_alloc(DRIVER_NAME, address);
942 if (!pdev) {
943 err = -ENOMEM;
944 pr_err("Device allocation failed\n");
945 goto exit;
946 }
947
948 err = platform_device_add_resources(pdev, &res, 1);
949 if (err) {
950 pr_err("Device resource addition failed (%d)\n", err);
951 goto exit_device_put;
952 }
953
954 err = platform_device_add(pdev);
955 if (err) {
956 pr_err("Device addition failed (%d)\n", err);
957 goto exit_device_put;
958 }
959
960 return 0;
961
962 exit_device_put:
963 platform_device_put(pdev);
964 exit:
965 return err;
966 }
967
968 static int vt8231_pci_probe(struct pci_dev *dev,
969 const struct pci_device_id *id)
970 {
971 u16 address, val;
972 int ret;
973
974 if (force_addr) {
975 address = force_addr & 0xff00;
976 dev_warn(&dev->dev, "Forcing ISA address 0x%x\n",
977 address);
978
979 ret = pci_write_config_word(dev, VT8231_BASE_REG, address | 1);
980 if (ret != PCIBIOS_SUCCESSFUL)
981 return -ENODEV;
982 }
983
984 pci_read_config_word(dev, VT8231_BASE_REG, &val);
985 if (val == (u16)~0)
986 return -ENODEV;
987
988 address = val & ~(VT8231_EXTENT - 1);
989 if (address == 0) {
990 dev_err(&dev->dev, "base address not set - upgrade BIOS or use force_addr=0xaddr\n");
991 return -ENODEV;
992 }
993
994 pci_read_config_word(dev, VT8231_ENABLE_REG, &val);
995 if (val == (u16)~0)
996 return -ENODEV;
997
998 if (!(val & 0x0001)) {
999 dev_warn(&dev->dev, "enabling sensors\n");
1000 ret = pci_write_config_word(dev, VT8231_ENABLE_REG, val | 0x1);
1001 if (ret != PCIBIOS_SUCCESSFUL)
1002 return -ENODEV;
1003 }
1004
1005 if (platform_driver_register(&vt8231_driver))
1006 goto exit;
1007
1008 /* Sets global pdev as a side effect */
1009 if (vt8231_device_add(address))
1010 goto exit_unregister;
1011
1012 /*
1013 * Always return failure here. This is to allow other drivers to bind
1014 * to this pci device. We don't really want to have control over the
1015 * pci device, we only wanted to read as few register values from it.
1016 */
1017
1018 /*
1019 * We do, however, mark ourselves as using the PCI device to stop it
1020 * getting unloaded.
1021 */
1022 s_bridge = pci_dev_get(dev);
1023 return -ENODEV;
1024
1025 exit_unregister:
1026 platform_driver_unregister(&vt8231_driver);
1027 exit:
1028 return -ENODEV;
1029 }
1030
1031 static struct pci_driver vt8231_pci_driver = {
1032 .name = DRIVER_NAME,
1033 .id_table = vt8231_pci_ids,
1034 .probe = vt8231_pci_probe,
1035 };
1036
1037 static int __init sm_vt8231_init(void)
1038 {
1039 return pci_register_driver(&vt8231_pci_driver);
1040 }
1041
1042 static void __exit sm_vt8231_exit(void)
1043 {
1044 pci_unregister_driver(&vt8231_pci_driver);
1045 if (s_bridge != NULL) {
1046 platform_device_unregister(pdev);
1047 platform_driver_unregister(&vt8231_driver);
1048 pci_dev_put(s_bridge);
1049 s_bridge = NULL;
1050 }
1051 }
1052
1053 MODULE_AUTHOR("Roger Lucas <vt8231@hiddenengine.co.uk>");
1054 MODULE_DESCRIPTION("VT8231 sensors");
1055 MODULE_LICENSE("GPL");
1056
1057 module_init(sm_vt8231_init);
1058 module_exit(sm_vt8231_exit);
Kernel DRM miscellaneous fixes and cross-tree changes