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