V4L/DVB (7561): videobuf-vmalloc: stop streaming before unmap
[linux-2.6] / drivers / hwmon / sis5595.c
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);