Fix unchecked return status, batch 5
[deliverable/linux.git] / drivers / hwmon / vt8231.c
CommitLineData
1de9e371
RL
1/*
2 vt8231.c - Part of lm_sensors, Linux kernel modules
3 for hardware monitoring
4
5 Copyright (c) 2005 Roger Lucas <roger@planbit.co.uk>
6 Copyright (c) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
7 Aaron M. Marsh <amarsh@sdf.lonestar.org>
8
9 This program is free software; you can redistribute it and/or modify
10 it under the terms of the GNU General Public License as published by
11 the Free Software Foundation; either version 2 of the License, or
12 (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful,
15 but WITHOUT ANY WARRANTY; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License
20 along with this program; if not, write to the Free Software
21 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22*/
23
24/* Supports VIA VT8231 South Bridge embedded sensors
25*/
26
27#include <linux/module.h>
28#include <linux/init.h>
29#include <linux/slab.h>
30#include <linux/pci.h>
31#include <linux/jiffies.h>
32#include <linux/i2c.h>
33#include <linux/i2c-isa.h>
34#include <linux/hwmon.h>
35#include <linux/hwmon-sysfs.h>
36#include <linux/hwmon-vid.h>
37#include <linux/err.h>
9a61bf63 38#include <linux/mutex.h>
1de9e371
RL
39#include <asm/io.h>
40
41static int force_addr;
42module_param(force_addr, int, 0);
43MODULE_PARM_DESC(force_addr, "Initialize the base address of the sensors");
44
45/* Device address
46 Note that we can't determine the ISA address until we have initialized
47 our module */
48static unsigned short isa_address;
49
50#define VT8231_EXTENT 0x80
51#define VT8231_BASE_REG 0x70
52#define VT8231_ENABLE_REG 0x74
53
54/* The VT8231 registers
55
56 The reset value for the input channel configuration is used (Reg 0x4A=0x07)
57 which sets the selected inputs marked with '*' below if multiple options are
58 possible:
59
60 Voltage Mode Temperature Mode
61 Sensor Linux Id Linux Id VIA Id
62 -------- -------- -------- ------
63 CPU Diode N/A temp1 0
64 UIC1 in0 temp2 * 1
65 UIC2 in1 * temp3 2
66 UIC3 in2 * temp4 3
67 UIC4 in3 * temp5 4
68 UIC5 in4 * temp6 5
69 3.3V in5 N/A
70
71 Note that the BIOS may set the configuration register to a different value
72 to match the motherboard configuration.
73*/
74
75/* fans numbered 0-1 */
76#define VT8231_REG_FAN_MIN(nr) (0x3b + (nr))
77#define VT8231_REG_FAN(nr) (0x29 + (nr))
78
79/* Voltage inputs numbered 0-5 */
80
81static const u8 regvolt[] = { 0x21, 0x22, 0x23, 0x24, 0x25, 0x26 };
82static const u8 regvoltmax[] = { 0x3d, 0x2b, 0x2d, 0x2f, 0x31, 0x33 };
83static const u8 regvoltmin[] = { 0x3e, 0x2c, 0x2e, 0x30, 0x32, 0x34 };
84
85/* Temperatures are numbered 1-6 according to the Linux kernel specification.
86**
87** In the VIA datasheet, however, the temperatures are numbered from zero.
88** Since it is important that this driver can easily be compared to the VIA
89** datasheet, we will use the VIA numbering within this driver and map the
90** kernel sysfs device name to the VIA number in the sysfs callback.
91*/
92
93#define VT8231_REG_TEMP_LOW01 0x49
94#define VT8231_REG_TEMP_LOW25 0x4d
95
96static const u8 regtemp[] = { 0x1f, 0x21, 0x22, 0x23, 0x24, 0x25 };
97static const u8 regtempmax[] = { 0x39, 0x3d, 0x2b, 0x2d, 0x2f, 0x31 };
98static const u8 regtempmin[] = { 0x3a, 0x3e, 0x2c, 0x2e, 0x30, 0x32 };
99
100#define TEMP_FROM_REG(reg) (((253 * 4 - (reg)) * 550 + 105) / 210)
101#define TEMP_MAXMIN_FROM_REG(reg) (((253 - (reg)) * 2200 + 105) / 210)
102#define TEMP_MAXMIN_TO_REG(val) (253 - ((val) * 210 + 1100) / 2200)
103
104#define VT8231_REG_CONFIG 0x40
105#define VT8231_REG_ALARM1 0x41
106#define VT8231_REG_ALARM2 0x42
107#define VT8231_REG_FANDIV 0x47
108#define VT8231_REG_UCH_CONFIG 0x4a
109#define VT8231_REG_TEMP1_CONFIG 0x4b
110#define VT8231_REG_TEMP2_CONFIG 0x4c
111
112/* temps 0-5 as numbered in VIA datasheet - see later for mapping to Linux
113** numbering
114*/
115#define ISTEMP(i, ch_config) ((i) == 0 ? 1 : \
116 ((ch_config) >> ((i)+1)) & 0x01)
117/* voltages 0-5 */
118#define ISVOLT(i, ch_config) ((i) == 5 ? 1 : \
119 !(((ch_config) >> ((i)+2)) & 0x01))
120
121#define DIV_FROM_REG(val) (1 << (val))
122
123/* NB The values returned here are NOT temperatures. The calibration curves
124** for the thermistor curves are board-specific and must go in the
125** sensors.conf file. Temperature sensors are actually ten bits, but the
126** VIA datasheet only considers the 8 MSBs obtained from the regtemp[]
127** register. The temperature value returned should have a magnitude of 3,
128** so we use the VIA scaling as the "true" scaling and use the remaining 2
129** LSBs as fractional precision.
130**
131** All the on-chip hardware temperature comparisons for the alarms are only
132** 8-bits wide, and compare against the 8 MSBs of the temperature. The bits
133** in the registers VT8231_REG_TEMP_LOW01 and VT8231_REG_TEMP_LOW25 are
134** ignored.
135*/
136
137/******** FAN RPM CONVERSIONS ********
138** This chip saturates back at 0, not at 255 like many the other chips.
139** So, 0 means 0 RPM
140*/
141static inline u8 FAN_TO_REG(long rpm, int div)
142{
143 if (rpm == 0)
144 return 0;
145 return SENSORS_LIMIT(1310720 / (rpm * div), 1, 255);
146}
147
148#define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : 1310720 / ((val) * (div)))
149
150struct vt8231_data {
151 struct i2c_client client;
9a61bf63 152 struct mutex update_lock;
1de9e371
RL
153 struct class_device *class_dev;
154 char valid; /* !=0 if following fields are valid */
155 unsigned long last_updated; /* In jiffies */
156
157 u8 in[6]; /* Register value */
158 u8 in_max[6]; /* Register value */
159 u8 in_min[6]; /* Register value */
160 u16 temp[6]; /* Register value 10 bit, right aligned */
161 u8 temp_max[6]; /* Register value */
162 u8 temp_min[6]; /* Register value */
163 u8 fan[2]; /* Register value */
164 u8 fan_min[2]; /* Register value */
165 u8 fan_div[2]; /* Register encoding, shifted right */
166 u16 alarms; /* Register encoding */
167 u8 uch_config;
168};
169
170static struct pci_dev *s_bridge;
171static int vt8231_detect(struct i2c_adapter *adapter);
172static int vt8231_detach_client(struct i2c_client *client);
173static struct vt8231_data *vt8231_update_device(struct device *dev);
174static void vt8231_init_client(struct i2c_client *client);
175
176static inline int vt8231_read_value(struct i2c_client *client, u8 reg)
177{
178 return inb_p(client->addr + reg);
179}
180
181static inline void vt8231_write_value(struct i2c_client *client, u8 reg,
182 u8 value)
183{
184 outb_p(value, client->addr + reg);
185}
186
187/* following are the sysfs callback functions */
188static ssize_t show_in(struct device *dev, struct device_attribute *attr,
189 char *buf)
190{
191 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
192 int nr = sensor_attr->index;
193 struct vt8231_data *data = vt8231_update_device(dev);
194
195 return sprintf(buf, "%d\n", ((data->in[nr] - 3) * 10000) / 958);
196}
197
198static ssize_t show_in_min(struct device *dev, struct device_attribute *attr,
199 char *buf)
200{
201 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
202 int nr = sensor_attr->index;
203 struct vt8231_data *data = vt8231_update_device(dev);
204
205 return sprintf(buf, "%d\n", ((data->in_min[nr] - 3) * 10000) / 958);
206}
207
208static ssize_t show_in_max(struct device *dev, struct device_attribute *attr,
209 char *buf)
210{
211 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
212 int nr = sensor_attr->index;
213 struct vt8231_data *data = vt8231_update_device(dev);
214
215 return sprintf(buf, "%d\n", (((data->in_max[nr] - 3) * 10000) / 958));
216}
217
218static ssize_t set_in_min(struct device *dev, struct device_attribute *attr,
219 const char *buf, size_t count)
220{
221 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
222 int nr = sensor_attr->index;
223 struct i2c_client *client = to_i2c_client(dev);
224 struct vt8231_data *data = i2c_get_clientdata(client);
225 unsigned long val = simple_strtoul(buf, NULL, 10);
226
9a61bf63 227 mutex_lock(&data->update_lock);
1de9e371
RL
228 data->in_min[nr] = SENSORS_LIMIT(((val * 958) / 10000) + 3, 0, 255);
229 vt8231_write_value(client, regvoltmin[nr], data->in_min[nr]);
9a61bf63 230 mutex_unlock(&data->update_lock);
1de9e371
RL
231 return count;
232}
233
234static ssize_t set_in_max(struct device *dev, struct device_attribute *attr,
235 const char *buf, size_t count)
236{
237 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
238 int nr = sensor_attr->index;
239 struct i2c_client *client = to_i2c_client(dev);
240 struct vt8231_data *data = i2c_get_clientdata(client);
241 unsigned long val = simple_strtoul(buf, NULL, 10);
242
9a61bf63 243 mutex_lock(&data->update_lock);
1de9e371
RL
244 data->in_max[nr] = SENSORS_LIMIT(((val * 958) / 10000) + 3, 0, 255);
245 vt8231_write_value(client, regvoltmax[nr], data->in_max[nr]);
9a61bf63 246 mutex_unlock(&data->update_lock);
1de9e371
RL
247 return count;
248}
249
250/* Special case for input 5 as this has 3.3V scaling built into the chip */
251static ssize_t show_in5(struct device *dev, struct device_attribute *attr,
252 char *buf)
253{
254 struct vt8231_data *data = vt8231_update_device(dev);
255
256 return sprintf(buf, "%d\n",
257 (((data->in[5] - 3) * 10000 * 54) / (958 * 34)));
258}
259
260static ssize_t show_in5_min(struct device *dev, struct device_attribute *attr,
261 char *buf)
262{
263 struct vt8231_data *data = vt8231_update_device(dev);
264
265 return sprintf(buf, "%d\n",
266 (((data->in_min[5] - 3) * 10000 * 54) / (958 * 34)));
267}
268
269static ssize_t show_in5_max(struct device *dev, struct device_attribute *attr,
270 char *buf)
271{
272 struct vt8231_data *data = vt8231_update_device(dev);
273
274 return sprintf(buf, "%d\n",
275 (((data->in_max[5] - 3) * 10000 * 54) / (958 * 34)));
276}
277
278static ssize_t set_in5_min(struct device *dev, struct device_attribute *attr,
279 const char *buf, size_t count)
280{
281 struct i2c_client *client = to_i2c_client(dev);
282 struct vt8231_data *data = i2c_get_clientdata(client);
283 unsigned long val = simple_strtoul(buf, NULL, 10);
284
9a61bf63 285 mutex_lock(&data->update_lock);
1de9e371
RL
286 data->in_min[5] = SENSORS_LIMIT(((val * 958 * 34) / (10000 * 54)) + 3,
287 0, 255);
288 vt8231_write_value(client, regvoltmin[5], data->in_min[5]);
9a61bf63 289 mutex_unlock(&data->update_lock);
1de9e371
RL
290 return count;
291}
292
293static ssize_t set_in5_max(struct device *dev, struct device_attribute *attr,
294 const char *buf, size_t count)
295{
296 struct i2c_client *client = to_i2c_client(dev);
297 struct vt8231_data *data = i2c_get_clientdata(client);
298 unsigned long val = simple_strtoul(buf, NULL, 10);
299
9a61bf63 300 mutex_lock(&data->update_lock);
1de9e371
RL
301 data->in_max[5] = SENSORS_LIMIT(((val * 958 * 34) / (10000 * 54)) + 3,
302 0, 255);
303 vt8231_write_value(client, regvoltmax[5], data->in_max[5]);
9a61bf63 304 mutex_unlock(&data->update_lock);
1de9e371
RL
305 return count;
306}
307
308#define define_voltage_sysfs(offset) \
309static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
310 show_in, NULL, offset); \
311static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
312 show_in_min, set_in_min, offset); \
313static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
314 show_in_max, set_in_max, offset)
315
316define_voltage_sysfs(0);
317define_voltage_sysfs(1);
318define_voltage_sysfs(2);
319define_voltage_sysfs(3);
320define_voltage_sysfs(4);
321
322static DEVICE_ATTR(in5_input, S_IRUGO, show_in5, NULL);
323static DEVICE_ATTR(in5_min, S_IRUGO | S_IWUSR, show_in5_min, set_in5_min);
324static DEVICE_ATTR(in5_max, S_IRUGO | S_IWUSR, show_in5_max, set_in5_max);
325
326/* Temperatures */
327static ssize_t show_temp0(struct device *dev, struct device_attribute *attr,
328 char *buf)
329{
330 struct vt8231_data *data = vt8231_update_device(dev);
331 return sprintf(buf, "%d\n", data->temp[0] * 250);
332}
333
334static ssize_t show_temp0_max(struct device *dev, struct device_attribute *attr,
335 char *buf)
336{
337 struct vt8231_data *data = vt8231_update_device(dev);
338 return sprintf(buf, "%d\n", data->temp_max[0] * 1000);
339}
340
341static ssize_t show_temp0_min(struct device *dev, struct device_attribute *attr,
342 char *buf)
343{
344 struct vt8231_data *data = vt8231_update_device(dev);
345 return sprintf(buf, "%d\n", data->temp_min[0] * 1000);
346}
347
348static ssize_t set_temp0_max(struct device *dev, struct device_attribute *attr,
349 const char *buf, size_t count)
350{
351 struct i2c_client *client = to_i2c_client(dev);
352 struct vt8231_data *data = i2c_get_clientdata(client);
353 int val = simple_strtol(buf, NULL, 10);
354
9a61bf63 355 mutex_lock(&data->update_lock);
1de9e371
RL
356 data->temp_max[0] = SENSORS_LIMIT((val + 500) / 1000, 0, 255);
357 vt8231_write_value(client, regtempmax[0], data->temp_max[0]);
9a61bf63 358 mutex_unlock(&data->update_lock);
1de9e371
RL
359 return count;
360}
361static ssize_t set_temp0_min(struct device *dev, struct device_attribute *attr,
362 const char *buf, size_t count)
363{
364 struct i2c_client *client = to_i2c_client(dev);
365 struct vt8231_data *data = i2c_get_clientdata(client);
366 int val = simple_strtol(buf, NULL, 10);
367
9a61bf63 368 mutex_lock(&data->update_lock);
1de9e371
RL
369 data->temp_min[0] = SENSORS_LIMIT((val + 500) / 1000, 0, 255);
370 vt8231_write_value(client, regtempmin[0], data->temp_min[0]);
9a61bf63 371 mutex_unlock(&data->update_lock);
1de9e371
RL
372 return count;
373}
374
375static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
376 char *buf)
377{
378 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
379 int nr = sensor_attr->index;
380 struct vt8231_data *data = vt8231_update_device(dev);
381 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr]));
382}
383
384static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr,
385 char *buf)
386{
387 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
388 int nr = sensor_attr->index;
389 struct vt8231_data *data = vt8231_update_device(dev);
390 return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_max[nr]));
391}
392
393static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr,
394 char *buf)
395{
396 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
397 int nr = sensor_attr->index;
398 struct vt8231_data *data = vt8231_update_device(dev);
399 return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_min[nr]));
400}
401
402static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
403 const char *buf, size_t count)
404{
405 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
406 int nr = sensor_attr->index;
407 struct i2c_client *client = to_i2c_client(dev);
408 struct vt8231_data *data = i2c_get_clientdata(client);
409 int val = simple_strtol(buf, NULL, 10);
410
9a61bf63 411 mutex_lock(&data->update_lock);
1de9e371
RL
412 data->temp_max[nr] = SENSORS_LIMIT(TEMP_MAXMIN_TO_REG(val), 0, 255);
413 vt8231_write_value(client, regtempmax[nr], data->temp_max[nr]);
9a61bf63 414 mutex_unlock(&data->update_lock);
1de9e371
RL
415 return count;
416}
417static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
418 const char *buf, size_t count)
419{
420 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
421 int nr = sensor_attr->index;
422 struct i2c_client *client = to_i2c_client(dev);
423 struct vt8231_data *data = i2c_get_clientdata(client);
424 int val = simple_strtol(buf, NULL, 10);
425
9a61bf63 426 mutex_lock(&data->update_lock);
1de9e371
RL
427 data->temp_min[nr] = SENSORS_LIMIT(TEMP_MAXMIN_TO_REG(val), 0, 255);
428 vt8231_write_value(client, regtempmin[nr], data->temp_min[nr]);
9a61bf63 429 mutex_unlock(&data->update_lock);
1de9e371
RL
430 return count;
431}
432
433/* Note that these map the Linux temperature sensor numbering (1-6) to the VIA
434** temperature sensor numbering (0-5)
435*/
436#define define_temperature_sysfs(offset) \
437static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
438 show_temp, NULL, offset - 1); \
439static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
440 show_temp_max, set_temp_max, offset - 1); \
e3efa5a7 441static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR, \
1de9e371
RL
442 show_temp_min, set_temp_min, offset - 1)
443
444static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp0, NULL);
445static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp0_max, set_temp0_max);
e3efa5a7 446static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp0_min, set_temp0_min);
1de9e371
RL
447
448define_temperature_sysfs(2);
449define_temperature_sysfs(3);
450define_temperature_sysfs(4);
451define_temperature_sysfs(5);
452define_temperature_sysfs(6);
453
454#define CFG_INFO_TEMP(id) { &sensor_dev_attr_temp##id##_input.dev_attr, \
e3efa5a7 455 &sensor_dev_attr_temp##id##_max_hyst.dev_attr, \
1de9e371
RL
456 &sensor_dev_attr_temp##id##_max.dev_attr }
457#define CFG_INFO_VOLT(id) { &sensor_dev_attr_in##id##_input.dev_attr, \
458 &sensor_dev_attr_in##id##_min.dev_attr, \
459 &sensor_dev_attr_in##id##_max.dev_attr }
460
461struct str_device_attr_table {
462 struct device_attribute *input;
463 struct device_attribute *min;
464 struct device_attribute *max;
465};
466
467static struct str_device_attr_table cfg_info_temp[] = {
e3efa5a7 468 { &dev_attr_temp1_input, &dev_attr_temp1_max_hyst, &dev_attr_temp1_max },
1de9e371
RL
469 CFG_INFO_TEMP(2),
470 CFG_INFO_TEMP(3),
471 CFG_INFO_TEMP(4),
472 CFG_INFO_TEMP(5),
473 CFG_INFO_TEMP(6)
474};
475
476static struct str_device_attr_table cfg_info_volt[] = {
477 CFG_INFO_VOLT(0),
478 CFG_INFO_VOLT(1),
479 CFG_INFO_VOLT(2),
480 CFG_INFO_VOLT(3),
481 CFG_INFO_VOLT(4),
482 { &dev_attr_in5_input, &dev_attr_in5_min, &dev_attr_in5_max }
483};
484
485/* Fans */
486static ssize_t show_fan(struct device *dev, struct device_attribute *attr,
487 char *buf)
488{
489 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
490 int nr = sensor_attr->index;
491 struct vt8231_data *data = vt8231_update_device(dev);
492 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
493 DIV_FROM_REG(data->fan_div[nr])));
494}
495
496static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr,
497 char *buf)
498{
499 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
500 int nr = sensor_attr->index;
501 struct vt8231_data *data = vt8231_update_device(dev);
502 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr],
503 DIV_FROM_REG(data->fan_div[nr])));
504}
505
506static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr,
507 char *buf)
508{
509 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
510 int nr = sensor_attr->index;
511 struct vt8231_data *data = vt8231_update_device(dev);
512 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]));
513}
514
515static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
516 const char *buf, size_t count)
517{
518 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
519 int nr = sensor_attr->index;
520 struct i2c_client *client = to_i2c_client(dev);
521 struct vt8231_data *data = i2c_get_clientdata(client);
522 int val = simple_strtoul(buf, NULL, 10);
523
9a61bf63 524 mutex_lock(&data->update_lock);
1de9e371
RL
525 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
526 vt8231_write_value(client, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
9a61bf63 527 mutex_unlock(&data->update_lock);
1de9e371
RL
528 return count;
529}
530
531static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
532 const char *buf, size_t count)
533{
534 struct i2c_client *client = to_i2c_client(dev);
535 struct vt8231_data *data = i2c_get_clientdata(client);
536 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
537 unsigned long val = simple_strtoul(buf, NULL, 10);
538 int nr = sensor_attr->index;
539 int old = vt8231_read_value(client, VT8231_REG_FANDIV);
540 long min = FAN_FROM_REG(data->fan_min[nr],
541 DIV_FROM_REG(data->fan_div[nr]));
542
9a61bf63 543 mutex_lock(&data->update_lock);
1de9e371
RL
544 switch (val) {
545 case 1: data->fan_div[nr] = 0; break;
546 case 2: data->fan_div[nr] = 1; break;
547 case 4: data->fan_div[nr] = 2; break;
548 case 8: data->fan_div[nr] = 3; break;
549 default:
550 dev_err(&client->dev, "fan_div value %ld not supported."
551 "Choose one of 1, 2, 4 or 8!\n", val);
9a61bf63 552 mutex_unlock(&data->update_lock);
1de9e371
RL
553 return -EINVAL;
554 }
555
556 /* Correct the fan minimum speed */
557 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
558 vt8231_write_value(client, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
559
560 old = (old & 0x0f) | (data->fan_div[1] << 6) | (data->fan_div[0] << 4);
561 vt8231_write_value(client, VT8231_REG_FANDIV, old);
9a61bf63 562 mutex_unlock(&data->update_lock);
1de9e371
RL
563 return count;
564}
565
566
567#define define_fan_sysfs(offset) \
568static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
569 show_fan, NULL, offset - 1); \
570static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
571 show_fan_div, set_fan_div, offset - 1); \
572static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
573 show_fan_min, set_fan_min, offset - 1)
574
575define_fan_sysfs(1);
576define_fan_sysfs(2);
577
578/* Alarms */
579static ssize_t show_alarms(struct device *dev, struct device_attribute *attr,
580 char *buf)
581{
582 struct vt8231_data *data = vt8231_update_device(dev);
583 return sprintf(buf, "%d\n", data->alarms);
584}
585
586static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
587
588static struct i2c_driver vt8231_driver = {
cdaf7934 589 .driver = {
87218842 590 .owner = THIS_MODULE,
cdaf7934
LR
591 .name = "vt8231",
592 },
1de9e371
RL
593 .attach_adapter = vt8231_detect,
594 .detach_client = vt8231_detach_client,
595};
596
597static struct pci_device_id vt8231_pci_ids[] = {
598 { PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8231_4) },
599 { 0, }
600};
601
602MODULE_DEVICE_TABLE(pci, vt8231_pci_ids);
603
604static int __devinit vt8231_pci_probe(struct pci_dev *dev,
605 const struct pci_device_id *id);
606
607static struct pci_driver vt8231_pci_driver = {
608 .name = "vt8231",
609 .id_table = vt8231_pci_ids,
610 .probe = vt8231_pci_probe,
611};
612
613int vt8231_detect(struct i2c_adapter *adapter)
614{
615 struct i2c_client *client;
616 struct vt8231_data *data;
617 int err = 0, i;
618 u16 val;
619
620 /* 8231 requires multiple of 256 */
621 if (force_addr) {
622 isa_address = force_addr & 0xFF00;
623 dev_warn(&adapter->dev, "forcing ISA address 0x%04X\n",
624 isa_address);
625 if (PCIBIOS_SUCCESSFUL != pci_write_config_word(s_bridge,
626 VT8231_BASE_REG, isa_address))
627 return -ENODEV;
628 }
629
630 if (PCIBIOS_SUCCESSFUL !=
631 pci_read_config_word(s_bridge, VT8231_ENABLE_REG, &val))
632 return -ENODEV;
633
634 if (!(val & 0x0001)) {
635 dev_warn(&adapter->dev, "enabling sensors\n");
636 if (PCIBIOS_SUCCESSFUL !=
637 pci_write_config_word(s_bridge, VT8231_ENABLE_REG,
638 val | 0x0001))
639 return -ENODEV;
640 }
641
642 /* Reserve the ISA region */
643 if (!request_region(isa_address, VT8231_EXTENT,
644 vt8231_pci_driver.name)) {
645 dev_err(&adapter->dev, "region 0x%x already in use!\n",
646 isa_address);
647 return -ENODEV;
648 }
649
650 if (!(data = kzalloc(sizeof(struct vt8231_data), GFP_KERNEL))) {
651 err = -ENOMEM;
652 goto exit_release;
653 }
654
655 client = &data->client;
656 i2c_set_clientdata(client, data);
657 client->addr = isa_address;
658 client->adapter = adapter;
659 client->driver = &vt8231_driver;
660 client->dev.parent = &adapter->dev;
661
662 /* Fill in the remaining client fields and put into the global list */
663 strlcpy(client->name, "vt8231", I2C_NAME_SIZE);
664
9a61bf63 665 mutex_init(&data->update_lock);
1de9e371
RL
666
667 /* Tell the I2C layer a new client has arrived */
668 if ((err = i2c_attach_client(client)))
669 goto exit_free;
670
671 vt8231_init_client(client);
672
673 /* Register sysfs hooks */
674 data->class_dev = hwmon_device_register(&client->dev);
675 if (IS_ERR(data->class_dev)) {
676 err = PTR_ERR(data->class_dev);
677 goto exit_detach;
678 }
679
680 /* Must update device information to find out the config field */
681 data->uch_config = vt8231_read_value(client, VT8231_REG_UCH_CONFIG);
682
683 for (i = 0; i < ARRAY_SIZE(cfg_info_temp); i++) {
684 if (ISTEMP(i, data->uch_config)) {
685 device_create_file(&client->dev,
686 cfg_info_temp[i].input);
687 device_create_file(&client->dev, cfg_info_temp[i].max);
688 device_create_file(&client->dev, cfg_info_temp[i].min);
689 }
690 }
691
692 for (i = 0; i < ARRAY_SIZE(cfg_info_volt); i++) {
693 if (ISVOLT(i, data->uch_config)) {
694 device_create_file(&client->dev,
695 cfg_info_volt[i].input);
696 device_create_file(&client->dev, cfg_info_volt[i].max);
697 device_create_file(&client->dev, cfg_info_volt[i].min);
698 }
699 }
700
701 device_create_file(&client->dev, &sensor_dev_attr_fan1_input.dev_attr);
702 device_create_file(&client->dev, &sensor_dev_attr_fan2_input.dev_attr);
703 device_create_file(&client->dev, &sensor_dev_attr_fan1_min.dev_attr);
704 device_create_file(&client->dev, &sensor_dev_attr_fan2_min.dev_attr);
705 device_create_file(&client->dev, &sensor_dev_attr_fan1_div.dev_attr);
706 device_create_file(&client->dev, &sensor_dev_attr_fan2_div.dev_attr);
707
708 device_create_file(&client->dev, &dev_attr_alarms);
709 return 0;
710
711exit_detach:
712 i2c_detach_client(client);
713exit_free:
714 kfree(data);
715exit_release:
716 release_region(isa_address, VT8231_EXTENT);
717 return err;
718}
719
720static int vt8231_detach_client(struct i2c_client *client)
721{
722 struct vt8231_data *data = i2c_get_clientdata(client);
723 int err;
724
725 hwmon_device_unregister(data->class_dev);
726
727 if ((err = i2c_detach_client(client))) {
728 return err;
729 }
730
731 release_region(client->addr, VT8231_EXTENT);
732 kfree(data);
733
734 return 0;
735}
736
737static void vt8231_init_client(struct i2c_client *client)
738{
739 vt8231_write_value(client, VT8231_REG_TEMP1_CONFIG, 0);
740 vt8231_write_value(client, VT8231_REG_TEMP2_CONFIG, 0);
741}
742
743static struct vt8231_data *vt8231_update_device(struct device *dev)
744{
745 struct i2c_client *client = to_i2c_client(dev);
746 struct vt8231_data *data = i2c_get_clientdata(client);
747 int i;
748 u16 low;
749
9a61bf63 750 mutex_lock(&data->update_lock);
1de9e371
RL
751
752 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
753 || !data->valid) {
754 for (i = 0; i < 6; i++) {
755 if (ISVOLT(i, data->uch_config)) {
756 data->in[i] = vt8231_read_value(client,
757 regvolt[i]);
758 data->in_min[i] = vt8231_read_value(client,
759 regvoltmin[i]);
760 data->in_max[i] = vt8231_read_value(client,
761 regvoltmax[i]);
762 }
763 }
764 for (i = 0; i < 2; i++) {
765 data->fan[i] = vt8231_read_value(client,
766 VT8231_REG_FAN(i));
767 data->fan_min[i] = vt8231_read_value(client,
768 VT8231_REG_FAN_MIN(i));
769 }
770
771 low = vt8231_read_value(client, VT8231_REG_TEMP_LOW01);
772 low = (low >> 6) | ((low & 0x30) >> 2)
773 | (vt8231_read_value(client, VT8231_REG_TEMP_LOW25) << 4);
774 for (i = 0; i < 6; i++) {
775 if (ISTEMP(i, data->uch_config)) {
776 data->temp[i] = (vt8231_read_value(client,
777 regtemp[i]) << 2)
778 | ((low >> (2 * i)) & 0x03);
779 data->temp_max[i] = vt8231_read_value(client,
780 regtempmax[i]);
781 data->temp_min[i] = vt8231_read_value(client,
782 regtempmin[i]);
783 }
784 }
785
786 i = vt8231_read_value(client, VT8231_REG_FANDIV);
787 data->fan_div[0] = (i >> 4) & 0x03;
788 data->fan_div[1] = i >> 6;
789 data->alarms = vt8231_read_value(client, VT8231_REG_ALARM1) |
790 (vt8231_read_value(client, VT8231_REG_ALARM2) << 8);
791
792 /* Set alarm flags correctly */
793 if (!data->fan[0] && data->fan_min[0]) {
794 data->alarms |= 0x40;
795 } else if (data->fan[0] && !data->fan_min[0]) {
796 data->alarms &= ~0x40;
797 }
798
799 if (!data->fan[1] && data->fan_min[1]) {
800 data->alarms |= 0x80;
801 } else if (data->fan[1] && !data->fan_min[1]) {
802 data->alarms &= ~0x80;
803 }
804
805 data->last_updated = jiffies;
806 data->valid = 1;
807 }
808
9a61bf63 809 mutex_unlock(&data->update_lock);
1de9e371
RL
810
811 return data;
812}
813
814static int __devinit vt8231_pci_probe(struct pci_dev *dev,
815 const struct pci_device_id *id)
816{
817 u16 val;
818
819 if (PCIBIOS_SUCCESSFUL != pci_read_config_word(dev, VT8231_BASE_REG,
820 &val))
821 return -ENODEV;
822
823 isa_address = val & ~(VT8231_EXTENT - 1);
824 if (isa_address == 0 && force_addr == 0) {
825 dev_err(&dev->dev, "base address not set -\
826 upgrade BIOS or use force_addr=0xaddr\n");
827 return -ENODEV;
828 }
829
830 s_bridge = pci_dev_get(dev);
831
832 if (i2c_isa_add_driver(&vt8231_driver)) {
833 pci_dev_put(s_bridge);
834 s_bridge = NULL;
835 }
836
837 /* Always return failure here. This is to allow other drivers to bind
838 * to this pci device. We don't really want to have control over the
839 * pci device, we only wanted to read as few register values from it.
840 */
841 return -ENODEV;
842}
843
844static int __init sm_vt8231_init(void)
845{
93b47684 846 return pci_register_driver(&vt8231_pci_driver);
1de9e371
RL
847}
848
849static void __exit sm_vt8231_exit(void)
850{
851 pci_unregister_driver(&vt8231_pci_driver);
852 if (s_bridge != NULL) {
853 i2c_isa_del_driver(&vt8231_driver);
854 pci_dev_put(s_bridge);
855 s_bridge = NULL;
856 }
857}
858
859MODULE_AUTHOR("Roger Lucas <roger@planbit.co.uk>");
860MODULE_DESCRIPTION("VT8231 sensors");
861MODULE_LICENSE("GPL");
862
863module_init(sm_vt8231_init);
864module_exit(sm_vt8231_exit);
This page took 0.148591 seconds and 5 git commands to generate.