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