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
30static int force_addr;
31module_param(force_addr, int, 0);
32MODULE_PARM_DESC(force_addr, "Initialize the base address of the sensors");
33
34static 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
70static const u8 regvolt[]    = { 0x21, 0x22, 0x23, 0x24, 0x25, 0x26 };
71static const u8 regvoltmax[] = { 0x3d, 0x2b, 0x2d, 0x2f, 0x31, 0x33 };
72static 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
86static const u8 regtemp[]    = { 0x1f, 0x21, 0x22, 0x23, 0x24, 0x25 };
87static const u8 regtempmax[] = { 0x39, 0x3d, 0x2b, 0x2d, 0x2f, 0x31 };
88static 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 */
134static 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
143struct 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
165static struct pci_dev *s_bridge;
166
167static inline int vt8231_read_value(struct vt8231_data *data, u8 reg)
168{
169	return inb_p(data->addr + reg);
170}
171
172static inline void vt8231_write_value(struct vt8231_data *data, u8 reg,
173					u8 value)
174{
175	outb_p(value, data->addr + reg);
176}
177
178static 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 */
247static 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
257static 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
267static 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
277static 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
297static 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 */
318static 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
327static 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
336static 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
345static 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
365static 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
385static SENSOR_DEVICE_ATTR_RO(in0_input, in, 0);
386static SENSOR_DEVICE_ATTR_RW(in0_min, in_min, 0);
387static SENSOR_DEVICE_ATTR_RW(in0_max, in_max, 0);
388static SENSOR_DEVICE_ATTR_RO(in1_input, in, 1);
389static SENSOR_DEVICE_ATTR_RW(in1_min, in_min, 1);
390static SENSOR_DEVICE_ATTR_RW(in1_max, in_max, 1);
391static SENSOR_DEVICE_ATTR_RO(in2_input, in, 2);
392static SENSOR_DEVICE_ATTR_RW(in2_min, in_min, 2);
393static SENSOR_DEVICE_ATTR_RW(in2_max, in_max, 2);
394static SENSOR_DEVICE_ATTR_RO(in3_input, in, 3);
395static SENSOR_DEVICE_ATTR_RW(in3_min, in_min, 3);
396static SENSOR_DEVICE_ATTR_RW(in3_max, in_max, 3);
397static SENSOR_DEVICE_ATTR_RO(in4_input, in, 4);
398static SENSOR_DEVICE_ATTR_RW(in4_min, in_min, 4);
399static SENSOR_DEVICE_ATTR_RW(in4_max, in_max, 4);
400
401static DEVICE_ATTR_RO(in5_input);
402static DEVICE_ATTR_RW(in5_min);
403static DEVICE_ATTR_RW(in5_max);
404
405/* Temperatures */
406static 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
413static 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
420static 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
427static 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}
445static 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
464static 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
473static 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
482static 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
491static 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}
511static 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
537static DEVICE_ATTR_RO(temp1_input);
538static DEVICE_ATTR_RW(temp1_max);
539static DEVICE_ATTR_RW(temp1_max_hyst);
540
541static SENSOR_DEVICE_ATTR_RO(temp2_input, temp, 1);
542static SENSOR_DEVICE_ATTR_RW(temp2_max, temp_max, 1);
543static SENSOR_DEVICE_ATTR_RW(temp2_max_hyst, temp_min, 1);
544static SENSOR_DEVICE_ATTR_RO(temp3_input, temp, 2);
545static SENSOR_DEVICE_ATTR_RW(temp3_max, temp_max, 2);
546static SENSOR_DEVICE_ATTR_RW(temp3_max_hyst, temp_min, 2);
547static SENSOR_DEVICE_ATTR_RO(temp4_input, temp, 3);
548static SENSOR_DEVICE_ATTR_RW(temp4_max, temp_max, 3);
549static SENSOR_DEVICE_ATTR_RW(temp4_max_hyst, temp_min, 3);
550static SENSOR_DEVICE_ATTR_RO(temp5_input, temp, 4);
551static SENSOR_DEVICE_ATTR_RW(temp5_max, temp_max, 4);
552static SENSOR_DEVICE_ATTR_RW(temp5_max_hyst, temp_min, 4);
553static SENSOR_DEVICE_ATTR_RO(temp6_input, temp, 5);
554static SENSOR_DEVICE_ATTR_RW(temp6_max, temp_max, 5);
555static SENSOR_DEVICE_ATTR_RW(temp6_max_hyst, temp_min, 5);
556
557/* Fans */
558static 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
568static 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
578static 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
587static 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
608static 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
657static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0);
658static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0);
659static SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0);
660static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1);
661static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1);
662static SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1);
663
664/* Alarms */
665static 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}
671static DEVICE_ATTR_RO(alarms);
672
673static 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}
680static SENSOR_DEVICE_ATTR_RO(temp1_alarm, alarm, 4);
681static SENSOR_DEVICE_ATTR_RO(temp2_alarm, alarm, 11);
682static SENSOR_DEVICE_ATTR_RO(temp3_alarm, alarm, 0);
683static SENSOR_DEVICE_ATTR_RO(temp4_alarm, alarm, 1);
684static SENSOR_DEVICE_ATTR_RO(temp5_alarm, alarm, 3);
685static SENSOR_DEVICE_ATTR_RO(temp6_alarm, alarm, 8);
686static SENSOR_DEVICE_ATTR_RO(in0_alarm, alarm, 11);
687static SENSOR_DEVICE_ATTR_RO(in1_alarm, alarm, 0);
688static SENSOR_DEVICE_ATTR_RO(in2_alarm, alarm, 1);
689static SENSOR_DEVICE_ATTR_RO(in3_alarm, alarm, 3);
690static SENSOR_DEVICE_ATTR_RO(in4_alarm, alarm, 8);
691static SENSOR_DEVICE_ATTR_RO(in5_alarm, alarm, 2);
692static SENSOR_DEVICE_ATTR_RO(fan1_alarm, alarm, 6);
693static SENSOR_DEVICE_ATTR_RO(fan2_alarm, alarm, 7);
694
695static 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}
701static DEVICE_ATTR_RO(name);
702
703static 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
743static 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
752static 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
792static 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
801static 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
815static const struct attribute_group vt8231_group = {
816	.attrs = vt8231_attributes,
817};
818
819static 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
825static 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
884exit_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
895static 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
912static struct platform_driver vt8231_driver = {
913	.driver = {
914		.name	= DRIVER_NAME,
915	},
916	.probe	= vt8231_probe,
917	.remove_new = vt8231_remove,
918};
919
920static 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
925MODULE_DEVICE_TABLE(pci, vt8231_pci_ids);
926
927static 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
962exit_device_put:
963	platform_device_put(pdev);
964exit:
965	return err;
966}
967
968static 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
1025exit_unregister:
1026	platform_driver_unregister(&vt8231_driver);
1027exit:
1028	return -ENODEV;
1029}
1030
1031static struct pci_driver vt8231_pci_driver = {
1032	.name		= DRIVER_NAME,
1033	.id_table	= vt8231_pci_ids,
1034	.probe		= vt8231_pci_probe,
1035};
1036
1037static int __init sm_vt8231_init(void)
1038{
1039	return pci_register_driver(&vt8231_pci_driver);
1040}
1041
1042static 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
1053MODULE_AUTHOR("Roger Lucas <vt8231@hiddenengine.co.uk>");
1054MODULE_DESCRIPTION("VT8231 sensors");
1055MODULE_LICENSE("GPL");
1056
1057module_init(sm_vt8231_init);
1058module_exit(sm_vt8231_exit);
1059