1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
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
69
70static u16 force_addr;
71module_param(force_addr, ushort, 0);
72MODULE_PARM_DESC(force_addr,
73 "Initialize the base address of the sensors");
74
75static struct platform_device *pdev;
76
77
78
79
80#define SIS5595_EXTENT 8
81
82#define SIS5595_BASE_REG 0x68
83#define SIS5595_PIN_REG 0x7A
84#define SIS5595_ENABLE_REG 0x7B
85
86
87#define SIS5595_ADDR_REG_OFFSET 5
88#define SIS5595_DATA_REG_OFFSET 6
89
90
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
99
100
101
102
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
118
119
120
121
122static 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
129static 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
136static inline int FAN_FROM_REG(u8 val, int div)
137{
138 return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
139}
140
141
142
143static inline int TEMP_FROM_REG(s8 val)
144{
145 return val * 830 + 52120;
146}
147static 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
154
155static 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
162
163struct 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;
171 unsigned long last_updated;
172 char maxins;
173 u8 revision;
174
175 u8 in[5];
176 u8 in_max[5];
177 u8 in_min[5];
178 u8 fan[2];
179 u8 fan_min[2];
180 s8 temp;
181 s8 temp_over;
182 s8 temp_hyst;
183 u8 fan_div[2];
184 u16 alarms;
185};
186
187static struct pci_dev *s_bridge;
188
189static int sis5595_probe(struct platform_device *pdev);
190static int __devexit sis5595_remove(struct platform_device *pdev);
191
192static int sis5595_read_value(struct sis5595_data *data, u8 reg);
193static void sis5595_write_value(struct sis5595_data *data, u8 reg, u8 value);
194static struct sis5595_data *sis5595_update_device(struct device *dev);
195static void sis5595_init_device(struct sis5595_data *data);
196
197static 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
207static 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
216static 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
225static 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
234static 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
249static 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) \
265static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
266 show_in, NULL, offset); \
267static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
268 show_in_min, set_in_min, offset); \
269static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
270 show_in_max, set_in_max, offset);
271
272show_in_offset(0);
273show_in_offset(1);
274show_in_offset(2);
275show_in_offset(3);
276show_in_offset(4);
277
278
279static 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
285static 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
291static 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
303static 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
309static 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
321static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
322static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
323 show_temp_over, set_temp_over);
324static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
325 show_temp_hyst, set_temp_hyst);
326
327
328static 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
338static 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
348static 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
363static 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
373
374
375
376static 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) \
420static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
421 show_fan, NULL, offset - 1); \
422static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
423 show_fan_min, set_fan_min, offset - 1); \
424static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
425 show_fan_div, set_fan_div, offset - 1);
426
427show_fan_offset(1);
428show_fan_offset(2);
429
430
431static 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}
436static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
437
438static 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}
445static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
446static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
447static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
448static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
449static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 15);
450static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
451static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
452static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 15);
453
454static 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}
460static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
461
462static 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
494static const struct attribute_group sis5595_group = {
495 .attrs = sis5595_attributes,
496};
497
498static 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
506static const struct attribute_group sis5595_group_in4 = {
507 .attrs = sis5595_attributes_in4,
508};
509
510static 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
518static const struct attribute_group sis5595_group_temp1 = {
519 .attrs = sis5595_attributes_temp1,
520};
521
522
523static 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
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
551 data->revision = s_bridge->revision;
552
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
558 data->maxins = 4;
559 }
560
561
562 sis5595_init_device(data);
563
564
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
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
591exit_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);
595exit_free:
596 kfree(data);
597exit_release:
598 release_region(res->start, SIS5595_EXTENT);
599exit:
600 return err;
601}
602
603static 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
621static 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
632static 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
641static 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
649static 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
699static struct pci_device_id sis5595_pci_ids[] = {
700 { PCI_DEVICE(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_503) },
701 { 0, }
702};
703
704MODULE_DEVICE_TABLE(pci, sis5595_pci_ids);
705
706static 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,
714
715
716 PCI_DEVICE_ID_SI_5597,
717 PCI_DEVICE_ID_SI_5598,
718 0 };
719
720static 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
753exit_device_put:
754 platform_device_put(pdev);
755exit:
756 return err;
757}
758
759static 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
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
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
823 if (sis5595_device_add(address))
824 goto exit_unregister;
825
826
827
828
829
830 return -ENODEV;
831
832exit_unregister:
833 pci_dev_put(dev);
834 platform_driver_unregister(&sis5595_driver);
835exit:
836 return -ENODEV;
837}
838
839static struct pci_driver sis5595_pci_driver = {
840 .name = "sis5595",
841 .id_table = sis5595_pci_ids,
842 .probe = sis5595_pci_probe,
843};
844
845static int __init sm_sis5595_init(void)
846{
847 return pci_register_driver(&sis5595_pci_driver);
848}
849
850static 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
861MODULE_AUTHOR("Aurelien Jarno <aurelien@aurel32.net>");
862MODULE_DESCRIPTION("SiS 5595 Sensor device");
863MODULE_LICENSE("GPL");
864
865module_init(sm_sis5595_init);
866module_exit(sm_sis5595_exit);