?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
async_tx: avoid the async xor_zero_sum path when src_cnt > device->max_xor
[wrt350n-kernel.git] / drivers / hwmon / sis5595.c
bloba276806f3d53cd8b9ab192f3283019b7550531c5
1 /*
2 sis5595.c - Part of lm_sensors, Linux kernel modules
3 for hardware monitoring
4
5 Copyright (C) 1998 - 2001 Frodo Looijaard <frodol@dds.nl>,
6 Kyösti Mälkki <kmalkki@cc.hut.fi>, and
7 Mark D. Studebaker <mdsxyz123@yahoo.com>
8 Ported to Linux 2.6 by Aurelien Jarno <aurelien@aurel32.net> with
9 the help of Jean Delvare <khali@linux-fr.org>
10
11 This program is free software; you can redistribute it and/or modify
12 it under the terms of the GNU General Public License as published by
13 the Free Software Foundation; either version 2 of the License, or
14 (at your option) any later version.
15
16 This program is distributed in the hope that it will be useful,
17 but WITHOUT ANY WARRANTY; without even the implied warranty of
18 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 GNU General Public License for more details.
20
21 You should have received a copy of the GNU General Public License
22 along with this program; if not, write to the Free Software
23 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24 */
25
26 /*
27 SiS southbridge has a LM78-like chip integrated on the same IC.
28 This driver is a customized copy of lm78.c
29
30 Supports following revisions:
31 Version PCI ID PCI Revision
32 1 1039/0008 AF or less
33 2 1039/0008 B0 or greater
34
35 Note: these chips contain a 0008 device which is incompatible with the
36 5595. We recognize these by the presence of the listed
37 "blacklist" PCI ID and refuse to load.
38
39 NOT SUPPORTED PCI ID BLACKLIST PCI ID
40 540 0008 0540
41 550 0008 0550
42 5513 0008 5511
43 5581 0008 5597
44 5582 0008 5597
45 5597 0008 5597
46 5598 0008 5597/5598
47 630 0008 0630
48 645 0008 0645
49 730 0008 0730
50 735 0008 0735
51 */
52
53 #include <linux/module.h>
54 #include <linux/slab.h>
55 #include <linux/ioport.h>
56 #include <linux/pci.h>
57 #include <linux/platform_device.h>
58 #include <linux/hwmon.h>
59 #include <linux/hwmon-sysfs.h>
60 #include <linux/err.h>
61 #include <linux/init.h>
62 #include <linux/jiffies.h>
63 #include <linux/mutex.h>
64 #include <linux/sysfs.h>
65 #include <asm/io.h>
66
67
68 /* If force_addr is set to anything different from 0, we forcibly enable
69 the device at the given address. */
70 static u16 force_addr;
71 module_param(force_addr, ushort, 0);
72 MODULE_PARM_DESC(force_addr,
73 "Initialize the base address of the sensors");
74
75 static struct platform_device *pdev;
76
77 /* Many SIS5595 constants specified below */
78
79 /* Length of ISA address segment */
80 #define SIS5595_EXTENT 8
81 /* PCI Config Registers */
82 #define SIS5595_BASE_REG 0x68
83 #define SIS5595_PIN_REG 0x7A
84 #define SIS5595_ENABLE_REG 0x7B
85
86 /* Where are the ISA address/data registers relative to the base address */
87 #define SIS5595_ADDR_REG_OFFSET 5
88 #define SIS5595_DATA_REG_OFFSET 6
89
90 /* The SIS5595 registers */
91 #define SIS5595_REG_IN_MAX(nr) (0x2b + (nr) * 2)
92 #define SIS5595_REG_IN_MIN(nr) (0x2c + (nr) * 2)
93 #define SIS5595_REG_IN(nr) (0x20 + (nr))
94
95 #define SIS5595_REG_FAN_MIN(nr) (0x3b + (nr))
96 #define SIS5595_REG_FAN(nr) (0x28 + (nr))
97
98 /* On the first version of the chip, the temp registers are separate.
99 On the second version,
100 TEMP pin is shared with IN4, configured in PCI register 0x7A.
101 The registers are the same as well.
102 OVER and HYST are really MAX and MIN. */
103
104 #define REV2MIN 0xb0
105 #define SIS5595_REG_TEMP (( data->revision) >= REV2MIN) ? \
106 SIS5595_REG_IN(4) : 0x27
107 #define SIS5595_REG_TEMP_OVER (( data->revision) >= REV2MIN) ? \
108 SIS5595_REG_IN_MAX(4) : 0x39
109 #define SIS5595_REG_TEMP_HYST (( data->revision) >= REV2MIN) ? \
110 SIS5595_REG_IN_MIN(4) : 0x3a
111
112 #define SIS5595_REG_CONFIG 0x40
113 #define SIS5595_REG_ALARM1 0x41
114 #define SIS5595_REG_ALARM2 0x42
115 #define SIS5595_REG_FANDIV 0x47
116
117 /* Conversions. Limit checking is only done on the TO_REG
118 variants. */
119
120 /* IN: mV, (0V to 4.08V)
121 REG: 16mV/bit */
122 static inline u8 IN_TO_REG(unsigned long val)
123 {
124 unsigned long nval = SENSORS_LIMIT(val, 0, 4080);
125 return (nval + 8) / 16;
126 }
127 #define IN_FROM_REG(val) ((val) * 16)
128
129 static inline u8 FAN_TO_REG(long rpm, int div)
130 {
131 if (rpm <= 0)
132 return 255;
133 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
134 }
135
136 static inline int FAN_FROM_REG(u8 val, int div)
137 {
138 return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
139 }
140
141 /* TEMP: mC (-54.12C to +157.53C)
142 REG: 0.83C/bit + 52.12, two's complement */
143 static inline int TEMP_FROM_REG(s8 val)
144 {
145 return val * 830 + 52120;
146 }
147 static inline s8 TEMP_TO_REG(int val)
148 {
149 int nval = SENSORS_LIMIT(val, -54120, 157530) ;
150 return nval<0 ? (nval-5212-415)/830 : (nval-5212+415)/830;
151 }
152
153 /* FAN DIV: 1, 2, 4, or 8 (defaults to 2)
154 REG: 0, 1, 2, or 3 (respectively) (defaults to 1) */
155 static inline u8 DIV_TO_REG(int val)
156 {
157 return val==8 ? 3 : val==4 ? 2 : val==1 ? 0 : 1;
158 }
159 #define DIV_FROM_REG(val) (1 << (val))
160
161 /* For each registered chip, we need to keep some data in memory.
162 The structure is dynamically allocated. */
163 struct sis5595_data {
164 unsigned short addr;
165 const char *name;
166 struct device *hwmon_dev;
167 struct mutex lock;
168
169 struct mutex update_lock;
170 char valid; /* !=0 if following fields are valid */
171 unsigned long last_updated; /* In jiffies */
172 char maxins; /* == 3 if temp enabled, otherwise == 4 */
173 u8 revision; /* Reg. value */
174
175 u8 in[5]; /* Register value */
176 u8 in_max[5]; /* Register value */
177 u8 in_min[5]; /* Register value */
178 u8 fan[2]; /* Register value */
179 u8 fan_min[2]; /* Register value */
180 s8 temp; /* Register value */
181 s8 temp_over; /* Register value */
182 s8 temp_hyst; /* Register value */
183 u8 fan_div[2]; /* Register encoding, shifted right */
184 u16 alarms; /* Register encoding, combined */
185 };
186
187 static struct pci_dev *s_bridge; /* pointer to the (only) sis5595 */
188
189 static int sis5595_probe(struct platform_device *pdev);
190 static int __devexit sis5595_remove(struct platform_device *pdev);
191
192 static int sis5595_read_value(struct sis5595_data *data, u8 reg);
193 static void sis5595_write_value(struct sis5595_data *data, u8 reg, u8 value);
194 static struct sis5595_data *sis5595_update_device(struct device *dev);
195 static void sis5595_init_device(struct sis5595_data *data);
196
197 static struct platform_driver sis5595_driver = {
198 .driver = {
199 .owner = THIS_MODULE,
200 .name = "sis5595",
201 },
202 .probe = sis5595_probe,
203 .remove = __devexit_p(sis5595_remove),
204 };
205
206 /* 4 Voltages */
207 static ssize_t show_in(struct device *dev, struct device_attribute *da,
208 char *buf)
209 {
210 struct sis5595_data *data = sis5595_update_device(dev);
211 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
212 int nr = attr->index;
213 return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr]));
214 }
215
216 static ssize_t show_in_min(struct device *dev, struct device_attribute *da,
217 char *buf)
218 {
219 struct sis5595_data *data = sis5595_update_device(dev);
220 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
221 int nr = attr->index;
222 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[nr]));
223 }
224
225 static ssize_t show_in_max(struct device *dev, struct device_attribute *da,
226 char *buf)
227 {
228 struct sis5595_data *data = sis5595_update_device(dev);
229 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
230 int nr = attr->index;
231 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[nr]));
232 }
233
234 static ssize_t set_in_min(struct device *dev, struct device_attribute *da,
235 const char *buf, size_t count)
236 {
237 struct sis5595_data *data = dev_get_drvdata(dev);
238 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
239 int nr = attr->index;
240 unsigned long val = simple_strtoul(buf, NULL, 10);
241
242 mutex_lock(&data->update_lock);
243 data->in_min[nr] = IN_TO_REG(val);
244 sis5595_write_value(data, SIS5595_REG_IN_MIN(nr), data->in_min[nr]);
245 mutex_unlock(&data->update_lock);
246 return count;
247 }
248
249 static ssize_t set_in_max(struct device *dev, struct device_attribute *da,
250 const char *buf, size_t count)
251 {
252 struct sis5595_data *data = dev_get_drvdata(dev);
253 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
254 int nr = attr->index;
255 unsigned long val = simple_strtoul(buf, NULL, 10);
256
257 mutex_lock(&data->update_lock);
258 data->in_max[nr] = IN_TO_REG(val);
259 sis5595_write_value(data, SIS5595_REG_IN_MAX(nr), data->in_max[nr]);
260 mutex_unlock(&data->update_lock);
261 return count;
262 }
263
264 #define show_in_offset(offset) \
265 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
266 show_in, NULL, offset); \
267 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
268 show_in_min, set_in_min, offset); \
269 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
270 show_in_max, set_in_max, offset);
271
272 show_in_offset(0);
273 show_in_offset(1);
274 show_in_offset(2);
275 show_in_offset(3);
276 show_in_offset(4);
277
278 /* Temperature */
279 static ssize_t show_temp(struct device *dev, struct device_attribute *attr, char *buf)
280 {
281 struct sis5595_data *data = sis5595_update_device(dev);
282 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
283 }
284
285 static ssize_t show_temp_over(struct device *dev, struct device_attribute *attr, char *buf)
286 {
287 struct sis5595_data *data = sis5595_update_device(dev);
288 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
289 }
290
291 static ssize_t set_temp_over(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
292 {
293 struct sis5595_data *data = dev_get_drvdata(dev);
294 long val = simple_strtol(buf, NULL, 10);
295
296 mutex_lock(&data->update_lock);
297 data->temp_over = TEMP_TO_REG(val);
298 sis5595_write_value(data, SIS5595_REG_TEMP_OVER, data->temp_over);
299 mutex_unlock(&data->update_lock);
300 return count;
301 }
302
303 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *attr, char *buf)
304 {
305 struct sis5595_data *data = sis5595_update_device(dev);
306 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
307 }
308
309 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
310 {
311 struct sis5595_data *data = dev_get_drvdata(dev);
312 long val = simple_strtol(buf, NULL, 10);
313
314 mutex_lock(&data->update_lock);
315 data->temp_hyst = TEMP_TO_REG(val);
316 sis5595_write_value(data, SIS5595_REG_TEMP_HYST, data->temp_hyst);
317 mutex_unlock(&data->update_lock);
318 return count;
319 }
320
321 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
322 static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
323 show_temp_over, set_temp_over);
324 static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
325 show_temp_hyst, set_temp_hyst);
326
327 /* 2 Fans */
328 static ssize_t show_fan(struct device *dev, struct device_attribute *da,
329 char *buf)
330 {
331 struct sis5595_data *data = sis5595_update_device(dev);
332 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
333 int nr = attr->index;
334 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
335 DIV_FROM_REG(data->fan_div[nr])) );
336 }
337
338 static ssize_t show_fan_min(struct device *dev, struct device_attribute *da,
339 char *buf)
340 {
341 struct sis5595_data *data = sis5595_update_device(dev);
342 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
343 int nr = attr->index;
344 return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan_min[nr],
345 DIV_FROM_REG(data->fan_div[nr])) );
346 }
347
348 static ssize_t set_fan_min(struct device *dev, struct device_attribute *da,
349 const char *buf, size_t count)
350 {
351 struct sis5595_data *data = dev_get_drvdata(dev);
352 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
353 int nr = attr->index;
354 unsigned long val = simple_strtoul(buf, NULL, 10);
355
356 mutex_lock(&data->update_lock);
357 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
358 sis5595_write_value(data, SIS5595_REG_FAN_MIN(nr), data->fan_min[nr]);
359 mutex_unlock(&data->update_lock);
360 return count;
361 }
362
363 static ssize_t show_fan_div(struct device *dev, struct device_attribute *da,
364 char *buf)
365 {
366 struct sis5595_data *data = sis5595_update_device(dev);
367 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
368 int nr = attr->index;
369 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]) );
370 }
371
372 /* Note: we save and restore the fan minimum here, because its value is
373 determined in part by the fan divisor. This follows the principle of
374 least surprise; the user doesn't expect the fan minimum to change just
375 because the divisor changed. */
376 static ssize_t set_fan_div(struct device *dev, struct device_attribute *da,
377 const char *buf, size_t count)
378 {
379 struct sis5595_data *data = dev_get_drvdata(dev);
380 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
381 int nr = attr->index;
382 unsigned long min;
383 unsigned long val = simple_strtoul(buf, NULL, 10);
384 int reg;
385
386 mutex_lock(&data->update_lock);
387 min = FAN_FROM_REG(data->fan_min[nr],
388 DIV_FROM_REG(data->fan_div[nr]));
389 reg = sis5595_read_value(data, SIS5595_REG_FANDIV);
390
391 switch (val) {
392 case 1: data->fan_div[nr] = 0; break;
393 case 2: data->fan_div[nr] = 1; break;
394 case 4: data->fan_div[nr] = 2; break;
395 case 8: data->fan_div[nr] = 3; break;
396 default:
397 dev_err(dev, "fan_div value %ld not "
398 "supported. Choose one of 1, 2, 4 or 8!\n", val);
399 mutex_unlock(&data->update_lock);
400 return -EINVAL;
401 }
402
403 switch (nr) {
404 case 0:
405 reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
406 break;
407 case 1:
408 reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
409 break;
410 }
411 sis5595_write_value(data, SIS5595_REG_FANDIV, reg);
412 data->fan_min[nr] =
413 FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
414 sis5595_write_value(data, SIS5595_REG_FAN_MIN(nr), data->fan_min[nr]);
415 mutex_unlock(&data->update_lock);
416 return count;
417 }
418
419 #define show_fan_offset(offset) \
420 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
421 show_fan, NULL, offset - 1); \
422 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
423 show_fan_min, set_fan_min, offset - 1); \
424 static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
425 show_fan_div, set_fan_div, offset - 1);
426
427 show_fan_offset(1);
428 show_fan_offset(2);
429
430 /* Alarms */
431 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
432 {
433 struct sis5595_data *data = sis5595_update_device(dev);
434 return sprintf(buf, "%d\n", data->alarms);
435 }
436 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
437
438 static ssize_t show_alarm(struct device *dev, struct device_attribute *da,
439 char *buf)
440 {
441 struct sis5595_data *data = sis5595_update_device(dev);
442 int nr = to_sensor_dev_attr(da)->index;
443 return sprintf(buf, "%u\n", (data->alarms >> nr) & 1);
444 }
445 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
446 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
447 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
448 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
449 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 15);
450 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
451 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
452 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 15);
453
454 static ssize_t show_name(struct device *dev, struct device_attribute *attr,
455 char *buf)
456 {
457 struct sis5595_data *data = dev_get_drvdata(dev);
458 return sprintf(buf, "%s\n", data->name);
459 }
460 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
461
462 static struct attribute *sis5595_attributes[] = {
463 &sensor_dev_attr_in0_input.dev_attr.attr,
464 &sensor_dev_attr_in0_min.dev_attr.attr,
465 &sensor_dev_attr_in0_max.dev_attr.attr,
466 &sensor_dev_attr_in0_alarm.dev_attr.attr,
467 &sensor_dev_attr_in1_input.dev_attr.attr,
468 &sensor_dev_attr_in1_min.dev_attr.attr,
469 &sensor_dev_attr_in1_max.dev_attr.attr,
470 &sensor_dev_attr_in1_alarm.dev_attr.attr,
471 &sensor_dev_attr_in2_input.dev_attr.attr,
472 &sensor_dev_attr_in2_min.dev_attr.attr,
473 &sensor_dev_attr_in2_max.dev_attr.attr,
474 &sensor_dev_attr_in2_alarm.dev_attr.attr,
475 &sensor_dev_attr_in3_input.dev_attr.attr,
476 &sensor_dev_attr_in3_min.dev_attr.attr,
477 &sensor_dev_attr_in3_max.dev_attr.attr,
478 &sensor_dev_attr_in3_alarm.dev_attr.attr,
479
480 &sensor_dev_attr_fan1_input.dev_attr.attr,
481 &sensor_dev_attr_fan1_min.dev_attr.attr,
482 &sensor_dev_attr_fan1_div.dev_attr.attr,
483 &sensor_dev_attr_fan1_alarm.dev_attr.attr,
484 &sensor_dev_attr_fan2_input.dev_attr.attr,
485 &sensor_dev_attr_fan2_min.dev_attr.attr,
486 &sensor_dev_attr_fan2_div.dev_attr.attr,
487 &sensor_dev_attr_fan2_alarm.dev_attr.attr,
488
489 &dev_attr_alarms.attr,
490 &dev_attr_name.attr,
491 NULL
492 };
493
494 static const struct attribute_group sis5595_group = {
495 .attrs = sis5595_attributes,
496 };
497
498 static struct attribute *sis5595_attributes_in4[] = {
499 &sensor_dev_attr_in4_input.dev_attr.attr,
500 &sensor_dev_attr_in4_min.dev_attr.attr,
501 &sensor_dev_attr_in4_max.dev_attr.attr,
502 &sensor_dev_attr_in4_alarm.dev_attr.attr,
503 NULL
504 };
505
506 static const struct attribute_group sis5595_group_in4 = {
507 .attrs = sis5595_attributes_in4,
508 };
509
510 static struct attribute *sis5595_attributes_temp1[] = {
511 &dev_attr_temp1_input.attr,
512 &dev_attr_temp1_max.attr,
513 &dev_attr_temp1_max_hyst.attr,
514 &sensor_dev_attr_temp1_alarm.dev_attr.attr,
515 NULL
516 };
517
518 static const struct attribute_group sis5595_group_temp1 = {
519 .attrs = sis5595_attributes_temp1,
520 };
521
522 /* This is called when the module is loaded */
523 static int __devinit sis5595_probe(struct platform_device *pdev)
524 {
525 int err = 0;
526 int i;
527 struct sis5595_data *data;
528 struct resource *res;
529 char val;
530
531 /* Reserve the ISA region */
532 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
533 if (!request_region(res->start, SIS5595_EXTENT,
534 sis5595_driver.driver.name)) {
535 err = -EBUSY;
536 goto exit;
537 }
538
539 if (!(data = kzalloc(sizeof(struct sis5595_data), GFP_KERNEL))) {
540 err = -ENOMEM;
541 goto exit_release;
542 }
543
544 mutex_init(&data->lock);
545 mutex_init(&data->update_lock);
546 data->addr = res->start;
547 data->name = "sis5595";
548 platform_set_drvdata(pdev, data);
549
550 /* Check revision and pin registers to determine whether 4 or 5 voltages */
551 data->revision = s_bridge->revision;
552 /* 4 voltages, 1 temp */
553 data->maxins = 3;
554 if (data->revision >= REV2MIN) {
555 pci_read_config_byte(s_bridge, SIS5595_PIN_REG, &val);
556 if (!(val & 0x80))
557 /* 5 voltages, no temps */
558 data->maxins = 4;
559 }
560
561 /* Initialize the SIS5595 chip */
562 sis5595_init_device(data);
563
564 /* A few vars need to be filled upon startup */
565 for (i = 0; i < 2; i++) {
566 data->fan_min[i] = sis5595_read_value(data,
567 SIS5595_REG_FAN_MIN(i));
568 }
569
570 /* Register sysfs hooks */
571 if ((err = sysfs_create_group(&pdev->dev.kobj, &sis5595_group)))
572 goto exit_free;
573 if (data->maxins == 4) {
574 if ((err = sysfs_create_group(&pdev->dev.kobj,
575 &sis5595_group_in4)))
576 goto exit_remove_files;
577 } else {
578 if ((err = sysfs_create_group(&pdev->dev.kobj,
579 &sis5595_group_temp1)))
580 goto exit_remove_files;
581 }
582
583 data->hwmon_dev = hwmon_device_register(&pdev->dev);
584 if (IS_ERR(data->hwmon_dev)) {
585 err = PTR_ERR(data->hwmon_dev);
586 goto exit_remove_files;
587 }
588
589 return 0;
590
591 exit_remove_files:
592 sysfs_remove_group(&pdev->dev.kobj, &sis5595_group);
593 sysfs_remove_group(&pdev->dev.kobj, &sis5595_group_in4);
594 sysfs_remove_group(&pdev->dev.kobj, &sis5595_group_temp1);
595 exit_free:
596 kfree(data);
597 exit_release:
598 release_region(res->start, SIS5595_EXTENT);
599 exit:
600 return err;
601 }
602
603 static int __devexit sis5595_remove(struct platform_device *pdev)
604 {
605 struct sis5595_data *data = platform_get_drvdata(pdev);
606
607 hwmon_device_unregister(data->hwmon_dev);
608 sysfs_remove_group(&pdev->dev.kobj, &sis5595_group);
609 sysfs_remove_group(&pdev->dev.kobj, &sis5595_group_in4);
610 sysfs_remove_group(&pdev->dev.kobj, &sis5595_group_temp1);
611
612 release_region(data->addr, SIS5595_EXTENT);
613 platform_set_drvdata(pdev, NULL);
614 kfree(data);
615
616 return 0;
617 }
618
619
620 /* ISA access must be locked explicitly. */
621 static int sis5595_read_value(struct sis5595_data *data, u8 reg)
622 {
623 int res;
624
625 mutex_lock(&data->lock);
626 outb_p(reg, data->addr + SIS5595_ADDR_REG_OFFSET);
627 res = inb_p(data->addr + SIS5595_DATA_REG_OFFSET);
628 mutex_unlock(&data->lock);
629 return res;
630 }
631
632 static void sis5595_write_value(struct sis5595_data *data, u8 reg, u8 value)
633 {
634 mutex_lock(&data->lock);
635 outb_p(reg, data->addr + SIS5595_ADDR_REG_OFFSET);
636 outb_p(value, data->addr + SIS5595_DATA_REG_OFFSET);
637 mutex_unlock(&data->lock);
638 }
639
640 /* Called when we have found a new SIS5595. */
641 static void __devinit sis5595_init_device(struct sis5595_data *data)
642 {
643 u8 config = sis5595_read_value(data, SIS5595_REG_CONFIG);
644 if (!(config & 0x01))
645 sis5595_write_value(data, SIS5595_REG_CONFIG,
646 (config & 0xf7) | 0x01);
647 }
648
649 static struct sis5595_data *sis5595_update_device(struct device *dev)
650 {
651 struct sis5595_data *data = dev_get_drvdata(dev);
652 int i;
653
654 mutex_lock(&data->update_lock);
655
656 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
657 || !data->valid) {
658
659 for (i = 0; i <= data->maxins; i++) {
660 data->in[i] =
661 sis5595_read_value(data, SIS5595_REG_IN(i));
662 data->in_min[i] =
663 sis5595_read_value(data,
664 SIS5595_REG_IN_MIN(i));
665 data->in_max[i] =
666 sis5595_read_value(data,
667 SIS5595_REG_IN_MAX(i));
668 }
669 for (i = 0; i < 2; i++) {
670 data->fan[i] =
671 sis5595_read_value(data, SIS5595_REG_FAN(i));
672 data->fan_min[i] =
673 sis5595_read_value(data,
674 SIS5595_REG_FAN_MIN(i));
675 }
676 if (data->maxins == 3) {
677 data->temp =
678 sis5595_read_value(data, SIS5595_REG_TEMP);
679 data->temp_over =
680 sis5595_read_value(data, SIS5595_REG_TEMP_OVER);
681 data->temp_hyst =
682 sis5595_read_value(data, SIS5595_REG_TEMP_HYST);
683 }
684 i = sis5595_read_value(data, SIS5595_REG_FANDIV);
685 data->fan_div[0] = (i >> 4) & 0x03;
686 data->fan_div[1] = i >> 6;
687 data->alarms =
688 sis5595_read_value(data, SIS5595_REG_ALARM1) |
689 (sis5595_read_value(data, SIS5595_REG_ALARM2) << 8);
690 data->last_updated = jiffies;
691 data->valid = 1;
692 }
693
694 mutex_unlock(&data->update_lock);
695
696 return data;
697 }
698
699 static struct pci_device_id sis5595_pci_ids[] = {
700 { PCI_DEVICE(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_503) },
701 { 0, }
702 };
703
704 MODULE_DEVICE_TABLE(pci, sis5595_pci_ids);
705
706 static int blacklist[] __devinitdata = {
707 PCI_DEVICE_ID_SI_540,
708 PCI_DEVICE_ID_SI_550,
709 PCI_DEVICE_ID_SI_630,
710 PCI_DEVICE_ID_SI_645,
711 PCI_DEVICE_ID_SI_730,
712 PCI_DEVICE_ID_SI_735,
713 PCI_DEVICE_ID_SI_5511, /* 5513 chip has the 0008 device but
714 that ID shows up in other chips so we
715 use the 5511 ID for recognition */
716 PCI_DEVICE_ID_SI_5597,
717 PCI_DEVICE_ID_SI_5598,
718 0 };
719
720 static int __devinit sis5595_device_add(unsigned short address)
721 {
722 struct resource res = {
723 .start = address,
724 .end = address + SIS5595_EXTENT - 1,
725 .name = "sis5595",
726 .flags = IORESOURCE_IO,
727 };
728 int err;
729
730 pdev = platform_device_alloc("sis5595", address);
731 if (!pdev) {
732 err = -ENOMEM;
733 printk(KERN_ERR "sis5595: Device allocation failed\n");
734 goto exit;
735 }
736
737 err = platform_device_add_resources(pdev, &res, 1);
738 if (err) {
739 printk(KERN_ERR "sis5595: Device resource addition failed "
740 "(%d)\n", err);
741 goto exit_device_put;
742 }
743
744 err = platform_device_add(pdev);
745 if (err) {
746 printk(KERN_ERR "sis5595: Device addition failed (%d)\n",
747 err);
748 goto exit_device_put;
749 }
750
751 return 0;
752
753 exit_device_put:
754 platform_device_put(pdev);
755 exit:
756 return err;
757 }
758
759 static int __devinit sis5595_pci_probe(struct pci_dev *dev,
760 const struct pci_device_id *id)
761 {
762 u16 address;
763 u8 enable;
764 int *i;
765
766 for (i = blacklist; *i != 0; i++) {
767 struct pci_dev *d;
768 if ((d = pci_get_device(PCI_VENDOR_ID_SI, *i, NULL))) {
769 dev_err(&d->dev, "Looked for SIS5595 but found unsupported device %.4x\n", *i);
770 pci_dev_put(d);
771 return -ENODEV;
772 }
773 }
774
775 force_addr &= ~(SIS5595_EXTENT - 1);
776 if (force_addr) {
777 dev_warn(&dev->dev, "Forcing ISA address 0x%x\n", force_addr);
778 pci_write_config_word(dev, SIS5595_BASE_REG, force_addr);
779 }
780
781 if (PCIBIOS_SUCCESSFUL !=
782 pci_read_config_word(dev, SIS5595_BASE_REG, &address)) {
783 dev_err(&dev->dev, "Failed to read ISA address\n");
784 return -ENODEV;
785 }
786
787 address &= ~(SIS5595_EXTENT - 1);
788 if (!address) {
789 dev_err(&dev->dev, "Base address not set - upgrade BIOS or use force_addr=0xaddr\n");
790 return -ENODEV;
791 }
792 if (force_addr && address != force_addr) {
793 /* doesn't work for some chips? */
794 dev_err(&dev->dev, "Failed to force ISA address\n");
795 return -ENODEV;
796 }
797
798 if (PCIBIOS_SUCCESSFUL !=
799 pci_read_config_byte(dev, SIS5595_ENABLE_REG, &enable)) {
800 dev_err(&dev->dev, "Failed to read enable register\n");
801 return -ENODEV;
802 }
803 if (!(enable & 0x80)) {
804 if ((PCIBIOS_SUCCESSFUL !=
805 pci_write_config_byte(dev, SIS5595_ENABLE_REG,
806 enable | 0x80))
807 || (PCIBIOS_SUCCESSFUL !=
808 pci_read_config_byte(dev, SIS5595_ENABLE_REG, &enable))
809 || (!(enable & 0x80))) {
810 /* doesn't work for some chips! */
811 dev_err(&dev->dev, "Failed to enable HWM device\n");
812 return -ENODEV;
813 }
814 }
815
816 if (platform_driver_register(&sis5595_driver)) {
817 dev_dbg(&dev->dev, "Failed to register sis5595 driver\n");
818 goto exit;
819 }
820
821 s_bridge = pci_dev_get(dev);
822 /* Sets global pdev as a side effect */
823 if (sis5595_device_add(address))
824 goto exit_unregister;
825
826 /* Always return failure here. This is to allow other drivers to bind
827 * to this pci device. We don't really want to have control over the
828 * pci device, we only wanted to read as few register values from it.
829 */
830 return -ENODEV;
831
832 exit_unregister:
833 pci_dev_put(dev);
834 platform_driver_unregister(&sis5595_driver);
835 exit:
836 return -ENODEV;
837 }
838
839 static struct pci_driver sis5595_pci_driver = {
840 .name = "sis5595",
841 .id_table = sis5595_pci_ids,
842 .probe = sis5595_pci_probe,
843 };
844
845 static int __init sm_sis5595_init(void)
846 {
847 return pci_register_driver(&sis5595_pci_driver);
848 }
849
850 static void __exit sm_sis5595_exit(void)
851 {
852 pci_unregister_driver(&sis5595_pci_driver);
853 if (s_bridge != NULL) {
854 platform_device_unregister(pdev);
855 platform_driver_unregister(&sis5595_driver);
856 pci_dev_put(s_bridge);
857 s_bridge = NULL;
858 }
859 }
860
861 MODULE_AUTHOR("Aurelien Jarno <aurelien@aurel32.net>");
862 MODULE_DESCRIPTION("SiS 5595 Sensor device");
863 MODULE_LICENSE("GPL");
864
865 module_init(sm_sis5595_init);
866 module_exit(sm_sis5595_exit);
WRT350N Kernel Patches