Input: keyboards - switch to using input_dev->dev.parent
[linux-2.6/linux-loongson.git] / drivers / hwmon / sis5595.c
blob95a4b5d9eaf29820cdba79472de2f97ea482f269
1 /*
2 sis5595.c - Part of lm_sensors, Linux kernel modules
3 for hardware monitoring
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>
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.
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.
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.
27 SiS southbridge has a LM78-like chip integrated on the same IC.
28 This driver is a customized copy of lm78.c
30 Supports following revisions:
31 Version PCI ID PCI Revision
32 1 1039/0008 AF or less
33 2 1039/0008 B0 or greater
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.
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
53 #include <linux/module.h>
54 #include <linux/slab.h>
55 #include <linux/ioport.h>
56 #include <linux/pci.h>
57 #include <linux/i2c.h>
58 #include <linux/i2c-isa.h>
59 #include <linux/hwmon.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>
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");
75 /* Device address
76 Note that we can't determine the ISA address until we have initialized
77 our module */
78 static unsigned short address;
80 /* Many SIS5595 constants specified below */
82 /* Length of ISA address segment */
83 #define SIS5595_EXTENT 8
84 /* PCI Config Registers */
85 #define SIS5595_REVISION_REG 0x08
86 #define SIS5595_BASE_REG 0x68
87 #define SIS5595_PIN_REG 0x7A
88 #define SIS5595_ENABLE_REG 0x7B
90 /* Where are the ISA address/data registers relative to the base address */
91 #define SIS5595_ADDR_REG_OFFSET 5
92 #define SIS5595_DATA_REG_OFFSET 6
94 /* The SIS5595 registers */
95 #define SIS5595_REG_IN_MAX(nr) (0x2b + (nr) * 2)
96 #define SIS5595_REG_IN_MIN(nr) (0x2c + (nr) * 2)
97 #define SIS5595_REG_IN(nr) (0x20 + (nr))
99 #define SIS5595_REG_FAN_MIN(nr) (0x3b + (nr))
100 #define SIS5595_REG_FAN(nr) (0x28 + (nr))
102 /* On the first version of the chip, the temp registers are separate.
103 On the second version,
104 TEMP pin is shared with IN4, configured in PCI register 0x7A.
105 The registers are the same as well.
106 OVER and HYST are really MAX and MIN. */
108 #define REV2MIN 0xb0
109 #define SIS5595_REG_TEMP (( data->revision) >= REV2MIN) ? \
110 SIS5595_REG_IN(4) : 0x27
111 #define SIS5595_REG_TEMP_OVER (( data->revision) >= REV2MIN) ? \
112 SIS5595_REG_IN_MAX(4) : 0x39
113 #define SIS5595_REG_TEMP_HYST (( data->revision) >= REV2MIN) ? \
114 SIS5595_REG_IN_MIN(4) : 0x3a
116 #define SIS5595_REG_CONFIG 0x40
117 #define SIS5595_REG_ALARM1 0x41
118 #define SIS5595_REG_ALARM2 0x42
119 #define SIS5595_REG_FANDIV 0x47
121 /* Conversions. Limit checking is only done on the TO_REG
122 variants. */
124 /* IN: mV, (0V to 4.08V)
125 REG: 16mV/bit */
126 static inline u8 IN_TO_REG(unsigned long val)
128 unsigned long nval = SENSORS_LIMIT(val, 0, 4080);
129 return (nval + 8) / 16;
131 #define IN_FROM_REG(val) ((val) * 16)
133 static inline u8 FAN_TO_REG(long rpm, int div)
135 if (rpm <= 0)
136 return 255;
137 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
140 static inline int FAN_FROM_REG(u8 val, int div)
142 return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
145 /* TEMP: mC (-54.12C to +157.53C)
146 REG: 0.83C/bit + 52.12, two's complement */
147 static inline int TEMP_FROM_REG(s8 val)
149 return val * 830 + 52120;
151 static inline s8 TEMP_TO_REG(int val)
153 int nval = SENSORS_LIMIT(val, -54120, 157530) ;
154 return nval<0 ? (nval-5212-415)/830 : (nval-5212+415)/830;
157 /* FAN DIV: 1, 2, 4, or 8 (defaults to 2)
158 REG: 0, 1, 2, or 3 (respectively) (defaults to 1) */
159 static inline u8 DIV_TO_REG(int val)
161 return val==8 ? 3 : val==4 ? 2 : val==1 ? 0 : 1;
163 #define DIV_FROM_REG(val) (1 << (val))
165 /* For the SIS5595, we need to keep some data in memory. That
166 data is pointed to by sis5595_list[NR]->data. The structure itself is
167 dynamically allocated, at the time when the new sis5595 client is
168 allocated. */
169 struct sis5595_data {
170 struct i2c_client client;
171 struct class_device *class_dev;
172 struct mutex lock;
174 struct mutex update_lock;
175 char valid; /* !=0 if following fields are valid */
176 unsigned long last_updated; /* In jiffies */
177 char maxins; /* == 3 if temp enabled, otherwise == 4 */
178 u8 revision; /* Reg. value */
180 u8 in[5]; /* Register value */
181 u8 in_max[5]; /* Register value */
182 u8 in_min[5]; /* Register value */
183 u8 fan[2]; /* Register value */
184 u8 fan_min[2]; /* Register value */
185 s8 temp; /* Register value */
186 s8 temp_over; /* Register value */
187 s8 temp_hyst; /* Register value */
188 u8 fan_div[2]; /* Register encoding, shifted right */
189 u16 alarms; /* Register encoding, combined */
192 static struct pci_dev *s_bridge; /* pointer to the (only) sis5595 */
194 static int sis5595_detect(struct i2c_adapter *adapter);
195 static int sis5595_detach_client(struct i2c_client *client);
197 static int sis5595_read_value(struct i2c_client *client, u8 reg);
198 static int sis5595_write_value(struct i2c_client *client, u8 reg, u8 value);
199 static struct sis5595_data *sis5595_update_device(struct device *dev);
200 static void sis5595_init_client(struct i2c_client *client);
202 static struct i2c_driver sis5595_driver = {
203 .driver = {
204 .owner = THIS_MODULE,
205 .name = "sis5595",
207 .attach_adapter = sis5595_detect,
208 .detach_client = sis5595_detach_client,
211 /* 4 Voltages */
212 static ssize_t show_in(struct device *dev, char *buf, int nr)
214 struct sis5595_data *data = sis5595_update_device(dev);
215 return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr]));
218 static ssize_t show_in_min(struct device *dev, char *buf, int nr)
220 struct sis5595_data *data = sis5595_update_device(dev);
221 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[nr]));
224 static ssize_t show_in_max(struct device *dev, char *buf, int nr)
226 struct sis5595_data *data = sis5595_update_device(dev);
227 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[nr]));
230 static ssize_t set_in_min(struct device *dev, const char *buf,
231 size_t count, int nr)
233 struct i2c_client *client = to_i2c_client(dev);
234 struct sis5595_data *data = i2c_get_clientdata(client);
235 unsigned long val = simple_strtoul(buf, NULL, 10);
237 mutex_lock(&data->update_lock);
238 data->in_min[nr] = IN_TO_REG(val);
239 sis5595_write_value(client, SIS5595_REG_IN_MIN(nr), data->in_min[nr]);
240 mutex_unlock(&data->update_lock);
241 return count;
244 static ssize_t set_in_max(struct device *dev, const char *buf,
245 size_t count, int nr)
247 struct i2c_client *client = to_i2c_client(dev);
248 struct sis5595_data *data = i2c_get_clientdata(client);
249 unsigned long val = simple_strtoul(buf, NULL, 10);
251 mutex_lock(&data->update_lock);
252 data->in_max[nr] = IN_TO_REG(val);
253 sis5595_write_value(client, SIS5595_REG_IN_MAX(nr), data->in_max[nr]);
254 mutex_unlock(&data->update_lock);
255 return count;
258 #define show_in_offset(offset) \
259 static ssize_t \
260 show_in##offset (struct device *dev, struct device_attribute *attr, char *buf) \
262 return show_in(dev, buf, offset); \
264 static DEVICE_ATTR(in##offset##_input, S_IRUGO, \
265 show_in##offset, NULL); \
266 static ssize_t \
267 show_in##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \
269 return show_in_min(dev, buf, offset); \
271 static ssize_t \
272 show_in##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \
274 return show_in_max(dev, buf, offset); \
276 static ssize_t set_in##offset##_min (struct device *dev, struct device_attribute *attr, \
277 const char *buf, size_t count) \
279 return set_in_min(dev, buf, count, offset); \
281 static ssize_t set_in##offset##_max (struct device *dev, struct device_attribute *attr, \
282 const char *buf, size_t count) \
284 return set_in_max(dev, buf, count, offset); \
286 static DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
287 show_in##offset##_min, set_in##offset##_min); \
288 static DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
289 show_in##offset##_max, set_in##offset##_max);
291 show_in_offset(0);
292 show_in_offset(1);
293 show_in_offset(2);
294 show_in_offset(3);
295 show_in_offset(4);
297 /* Temperature */
298 static ssize_t show_temp(struct device *dev, struct device_attribute *attr, char *buf)
300 struct sis5595_data *data = sis5595_update_device(dev);
301 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
304 static ssize_t show_temp_over(struct device *dev, struct device_attribute *attr, char *buf)
306 struct sis5595_data *data = sis5595_update_device(dev);
307 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
310 static ssize_t set_temp_over(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
312 struct i2c_client *client = to_i2c_client(dev);
313 struct sis5595_data *data = i2c_get_clientdata(client);
314 long val = simple_strtol(buf, NULL, 10);
316 mutex_lock(&data->update_lock);
317 data->temp_over = TEMP_TO_REG(val);
318 sis5595_write_value(client, SIS5595_REG_TEMP_OVER, data->temp_over);
319 mutex_unlock(&data->update_lock);
320 return count;
323 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *attr, char *buf)
325 struct sis5595_data *data = sis5595_update_device(dev);
326 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
329 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
331 struct i2c_client *client = to_i2c_client(dev);
332 struct sis5595_data *data = i2c_get_clientdata(client);
333 long val = simple_strtol(buf, NULL, 10);
335 mutex_lock(&data->update_lock);
336 data->temp_hyst = TEMP_TO_REG(val);
337 sis5595_write_value(client, SIS5595_REG_TEMP_HYST, data->temp_hyst);
338 mutex_unlock(&data->update_lock);
339 return count;
342 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
343 static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
344 show_temp_over, set_temp_over);
345 static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
346 show_temp_hyst, set_temp_hyst);
348 /* 2 Fans */
349 static ssize_t show_fan(struct device *dev, char *buf, int nr)
351 struct sis5595_data *data = sis5595_update_device(dev);
352 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
353 DIV_FROM_REG(data->fan_div[nr])) );
356 static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
358 struct sis5595_data *data = sis5595_update_device(dev);
359 return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan_min[nr],
360 DIV_FROM_REG(data->fan_div[nr])) );
363 static ssize_t set_fan_min(struct device *dev, const char *buf,
364 size_t count, int nr)
366 struct i2c_client *client = to_i2c_client(dev);
367 struct sis5595_data *data = i2c_get_clientdata(client);
368 unsigned long val = simple_strtoul(buf, NULL, 10);
370 mutex_lock(&data->update_lock);
371 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
372 sis5595_write_value(client, SIS5595_REG_FAN_MIN(nr), data->fan_min[nr]);
373 mutex_unlock(&data->update_lock);
374 return count;
377 static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
379 struct sis5595_data *data = sis5595_update_device(dev);
380 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]) );
383 /* Note: we save and restore the fan minimum here, because its value is
384 determined in part by the fan divisor. This follows the principle of
385 least surprise; the user doesn't expect the fan minimum to change just
386 because the divisor changed. */
387 static ssize_t set_fan_div(struct device *dev, const char *buf,
388 size_t count, int nr)
390 struct i2c_client *client = to_i2c_client(dev);
391 struct sis5595_data *data = i2c_get_clientdata(client);
392 unsigned long min;
393 unsigned long val = simple_strtoul(buf, NULL, 10);
394 int reg;
396 mutex_lock(&data->update_lock);
397 min = FAN_FROM_REG(data->fan_min[nr],
398 DIV_FROM_REG(data->fan_div[nr]));
399 reg = sis5595_read_value(client, SIS5595_REG_FANDIV);
401 switch (val) {
402 case 1: data->fan_div[nr] = 0; break;
403 case 2: data->fan_div[nr] = 1; break;
404 case 4: data->fan_div[nr] = 2; break;
405 case 8: data->fan_div[nr] = 3; break;
406 default:
407 dev_err(&client->dev, "fan_div value %ld not "
408 "supported. Choose one of 1, 2, 4 or 8!\n", val);
409 mutex_unlock(&data->update_lock);
410 return -EINVAL;
413 switch (nr) {
414 case 0:
415 reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
416 break;
417 case 1:
418 reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
419 break;
421 sis5595_write_value(client, SIS5595_REG_FANDIV, reg);
422 data->fan_min[nr] =
423 FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
424 sis5595_write_value(client, SIS5595_REG_FAN_MIN(nr), data->fan_min[nr]);
425 mutex_unlock(&data->update_lock);
426 return count;
429 #define show_fan_offset(offset) \
430 static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
432 return show_fan(dev, buf, offset - 1); \
434 static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \
436 return show_fan_min(dev, buf, offset - 1); \
438 static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf) \
440 return show_fan_div(dev, buf, offset - 1); \
442 static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr, \
443 const char *buf, size_t count) \
445 return set_fan_min(dev, buf, count, offset - 1); \
447 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset, NULL);\
448 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
449 show_fan_##offset##_min, set_fan_##offset##_min);
451 show_fan_offset(1);
452 show_fan_offset(2);
454 static ssize_t set_fan_1_div(struct device *dev, struct device_attribute *attr, const char *buf,
455 size_t count)
457 return set_fan_div(dev, buf, count, 0) ;
460 static ssize_t set_fan_2_div(struct device *dev, struct device_attribute *attr, const char *buf,
461 size_t count)
463 return set_fan_div(dev, buf, count, 1) ;
465 static DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
466 show_fan_1_div, set_fan_1_div);
467 static DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
468 show_fan_2_div, set_fan_2_div);
470 /* Alarms */
471 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
473 struct sis5595_data *data = sis5595_update_device(dev);
474 return sprintf(buf, "%d\n", data->alarms);
476 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
478 static struct attribute *sis5595_attributes[] = {
479 &dev_attr_in0_input.attr,
480 &dev_attr_in0_min.attr,
481 &dev_attr_in0_max.attr,
482 &dev_attr_in1_input.attr,
483 &dev_attr_in1_min.attr,
484 &dev_attr_in1_max.attr,
485 &dev_attr_in2_input.attr,
486 &dev_attr_in2_min.attr,
487 &dev_attr_in2_max.attr,
488 &dev_attr_in3_input.attr,
489 &dev_attr_in3_min.attr,
490 &dev_attr_in3_max.attr,
492 &dev_attr_fan1_input.attr,
493 &dev_attr_fan1_min.attr,
494 &dev_attr_fan1_div.attr,
495 &dev_attr_fan2_input.attr,
496 &dev_attr_fan2_min.attr,
497 &dev_attr_fan2_div.attr,
499 &dev_attr_alarms.attr,
500 NULL
503 static const struct attribute_group sis5595_group = {
504 .attrs = sis5595_attributes,
507 static struct attribute *sis5595_attributes_opt[] = {
508 &dev_attr_in4_input.attr,
509 &dev_attr_in4_min.attr,
510 &dev_attr_in4_max.attr,
512 &dev_attr_temp1_input.attr,
513 &dev_attr_temp1_max.attr,
514 &dev_attr_temp1_max_hyst.attr,
515 NULL
518 static const struct attribute_group sis5595_group_opt = {
519 .attrs = sis5595_attributes_opt,
522 /* This is called when the module is loaded */
523 static int sis5595_detect(struct i2c_adapter *adapter)
525 int err = 0;
526 int i;
527 struct i2c_client *new_client;
528 struct sis5595_data *data;
529 char val;
530 u16 a;
532 if (force_addr)
533 address = force_addr & ~(SIS5595_EXTENT - 1);
534 /* Reserve the ISA region */
535 if (!request_region(address, SIS5595_EXTENT,
536 sis5595_driver.driver.name)) {
537 err = -EBUSY;
538 goto exit;
540 if (force_addr) {
541 dev_warn(&adapter->dev, "forcing ISA address 0x%04X\n", address);
542 if (PCIBIOS_SUCCESSFUL !=
543 pci_write_config_word(s_bridge, SIS5595_BASE_REG, address))
544 goto exit_release;
545 if (PCIBIOS_SUCCESSFUL !=
546 pci_read_config_word(s_bridge, SIS5595_BASE_REG, &a))
547 goto exit_release;
548 if ((a & ~(SIS5595_EXTENT - 1)) != address)
549 /* doesn't work for some chips? */
550 goto exit_release;
553 if (PCIBIOS_SUCCESSFUL !=
554 pci_read_config_byte(s_bridge, SIS5595_ENABLE_REG, &val)) {
555 goto exit_release;
557 if ((val & 0x80) == 0) {
558 if (PCIBIOS_SUCCESSFUL !=
559 pci_write_config_byte(s_bridge, SIS5595_ENABLE_REG,
560 val | 0x80))
561 goto exit_release;
562 if (PCIBIOS_SUCCESSFUL !=
563 pci_read_config_byte(s_bridge, SIS5595_ENABLE_REG, &val))
564 goto exit_release;
565 if ((val & 0x80) == 0)
566 /* doesn't work for some chips! */
567 goto exit_release;
570 if (!(data = kzalloc(sizeof(struct sis5595_data), GFP_KERNEL))) {
571 err = -ENOMEM;
572 goto exit_release;
575 new_client = &data->client;
576 new_client->addr = address;
577 mutex_init(&data->lock);
578 i2c_set_clientdata(new_client, data);
579 new_client->adapter = adapter;
580 new_client->driver = &sis5595_driver;
581 new_client->flags = 0;
583 /* Check revision and pin registers to determine whether 4 or 5 voltages */
584 pci_read_config_byte(s_bridge, SIS5595_REVISION_REG, &(data->revision));
585 /* 4 voltages, 1 temp */
586 data->maxins = 3;
587 if (data->revision >= REV2MIN) {
588 pci_read_config_byte(s_bridge, SIS5595_PIN_REG, &val);
589 if (!(val & 0x80))
590 /* 5 voltages, no temps */
591 data->maxins = 4;
594 /* Fill in the remaining client fields and put it into the global list */
595 strlcpy(new_client->name, "sis5595", I2C_NAME_SIZE);
597 data->valid = 0;
598 mutex_init(&data->update_lock);
600 /* Tell the I2C layer a new client has arrived */
601 if ((err = i2c_attach_client(new_client)))
602 goto exit_free;
604 /* Initialize the SIS5595 chip */
605 sis5595_init_client(new_client);
607 /* A few vars need to be filled upon startup */
608 for (i = 0; i < 2; i++) {
609 data->fan_min[i] = sis5595_read_value(new_client,
610 SIS5595_REG_FAN_MIN(i));
613 /* Register sysfs hooks */
614 if ((err = sysfs_create_group(&new_client->dev.kobj, &sis5595_group)))
615 goto exit_detach;
616 if (data->maxins == 4) {
617 if ((err = device_create_file(&new_client->dev,
618 &dev_attr_in4_input))
619 || (err = device_create_file(&new_client->dev,
620 &dev_attr_in4_min))
621 || (err = device_create_file(&new_client->dev,
622 &dev_attr_in4_max)))
623 goto exit_remove_files;
624 } else {
625 if ((err = device_create_file(&new_client->dev,
626 &dev_attr_temp1_input))
627 || (err = device_create_file(&new_client->dev,
628 &dev_attr_temp1_max))
629 || (err = device_create_file(&new_client->dev,
630 &dev_attr_temp1_max_hyst)))
631 goto exit_remove_files;
634 data->class_dev = hwmon_device_register(&new_client->dev);
635 if (IS_ERR(data->class_dev)) {
636 err = PTR_ERR(data->class_dev);
637 goto exit_remove_files;
640 return 0;
642 exit_remove_files:
643 sysfs_remove_group(&new_client->dev.kobj, &sis5595_group);
644 sysfs_remove_group(&new_client->dev.kobj, &sis5595_group_opt);
645 exit_detach:
646 i2c_detach_client(new_client);
647 exit_free:
648 kfree(data);
649 exit_release:
650 release_region(address, SIS5595_EXTENT);
651 exit:
652 return err;
655 static int sis5595_detach_client(struct i2c_client *client)
657 struct sis5595_data *data = i2c_get_clientdata(client);
658 int err;
660 hwmon_device_unregister(data->class_dev);
661 sysfs_remove_group(&client->dev.kobj, &sis5595_group);
662 sysfs_remove_group(&client->dev.kobj, &sis5595_group_opt);
664 if ((err = i2c_detach_client(client)))
665 return err;
667 release_region(client->addr, SIS5595_EXTENT);
669 kfree(data);
671 return 0;
675 /* ISA access must be locked explicitly. */
676 static int sis5595_read_value(struct i2c_client *client, u8 reg)
678 int res;
680 struct sis5595_data *data = i2c_get_clientdata(client);
681 mutex_lock(&data->lock);
682 outb_p(reg, client->addr + SIS5595_ADDR_REG_OFFSET);
683 res = inb_p(client->addr + SIS5595_DATA_REG_OFFSET);
684 mutex_unlock(&data->lock);
685 return res;
688 static int sis5595_write_value(struct i2c_client *client, u8 reg, u8 value)
690 struct sis5595_data *data = i2c_get_clientdata(client);
691 mutex_lock(&data->lock);
692 outb_p(reg, client->addr + SIS5595_ADDR_REG_OFFSET);
693 outb_p(value, client->addr + SIS5595_DATA_REG_OFFSET);
694 mutex_unlock(&data->lock);
695 return 0;
698 /* Called when we have found a new SIS5595. */
699 static void sis5595_init_client(struct i2c_client *client)
701 u8 config = sis5595_read_value(client, SIS5595_REG_CONFIG);
702 if (!(config & 0x01))
703 sis5595_write_value(client, SIS5595_REG_CONFIG,
704 (config & 0xf7) | 0x01);
707 static struct sis5595_data *sis5595_update_device(struct device *dev)
709 struct i2c_client *client = to_i2c_client(dev);
710 struct sis5595_data *data = i2c_get_clientdata(client);
711 int i;
713 mutex_lock(&data->update_lock);
715 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
716 || !data->valid) {
718 for (i = 0; i <= data->maxins; i++) {
719 data->in[i] =
720 sis5595_read_value(client, SIS5595_REG_IN(i));
721 data->in_min[i] =
722 sis5595_read_value(client,
723 SIS5595_REG_IN_MIN(i));
724 data->in_max[i] =
725 sis5595_read_value(client,
726 SIS5595_REG_IN_MAX(i));
728 for (i = 0; i < 2; i++) {
729 data->fan[i] =
730 sis5595_read_value(client, SIS5595_REG_FAN(i));
731 data->fan_min[i] =
732 sis5595_read_value(client,
733 SIS5595_REG_FAN_MIN(i));
735 if (data->maxins == 3) {
736 data->temp =
737 sis5595_read_value(client, SIS5595_REG_TEMP);
738 data->temp_over =
739 sis5595_read_value(client, SIS5595_REG_TEMP_OVER);
740 data->temp_hyst =
741 sis5595_read_value(client, SIS5595_REG_TEMP_HYST);
743 i = sis5595_read_value(client, SIS5595_REG_FANDIV);
744 data->fan_div[0] = (i >> 4) & 0x03;
745 data->fan_div[1] = i >> 6;
746 data->alarms =
747 sis5595_read_value(client, SIS5595_REG_ALARM1) |
748 (sis5595_read_value(client, SIS5595_REG_ALARM2) << 8);
749 data->last_updated = jiffies;
750 data->valid = 1;
753 mutex_unlock(&data->update_lock);
755 return data;
758 static struct pci_device_id sis5595_pci_ids[] = {
759 { PCI_DEVICE(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_503) },
760 { 0, }
763 MODULE_DEVICE_TABLE(pci, sis5595_pci_ids);
765 static int blacklist[] __devinitdata = {
766 PCI_DEVICE_ID_SI_540,
767 PCI_DEVICE_ID_SI_550,
768 PCI_DEVICE_ID_SI_630,
769 PCI_DEVICE_ID_SI_645,
770 PCI_DEVICE_ID_SI_730,
771 PCI_DEVICE_ID_SI_735,
772 PCI_DEVICE_ID_SI_5511, /* 5513 chip has the 0008 device but
773 that ID shows up in other chips so we
774 use the 5511 ID for recognition */
775 PCI_DEVICE_ID_SI_5597,
776 PCI_DEVICE_ID_SI_5598,
777 0 };
779 static int __devinit sis5595_pci_probe(struct pci_dev *dev,
780 const struct pci_device_id *id)
782 u16 val;
783 int *i;
785 for (i = blacklist; *i != 0; i++) {
786 struct pci_dev *dev;
787 dev = pci_get_device(PCI_VENDOR_ID_SI, *i, NULL);
788 if (dev) {
789 dev_err(&dev->dev, "Looked for SIS5595 but found unsupported device %.4x\n", *i);
790 pci_dev_put(dev);
791 return -ENODEV;
795 if (PCIBIOS_SUCCESSFUL !=
796 pci_read_config_word(dev, SIS5595_BASE_REG, &val))
797 return -ENODEV;
799 address = val & ~(SIS5595_EXTENT - 1);
800 if (address == 0 && force_addr == 0) {
801 dev_err(&dev->dev, "Base address not set - upgrade BIOS or use force_addr=0xaddr\n");
802 return -ENODEV;
805 s_bridge = pci_dev_get(dev);
806 if (i2c_isa_add_driver(&sis5595_driver)) {
807 pci_dev_put(s_bridge);
808 s_bridge = NULL;
811 /* Always return failure here. This is to allow other drivers to bind
812 * to this pci device. We don't really want to have control over the
813 * pci device, we only wanted to read as few register values from it.
815 return -ENODEV;
818 static struct pci_driver sis5595_pci_driver = {
819 .name = "sis5595",
820 .id_table = sis5595_pci_ids,
821 .probe = sis5595_pci_probe,
824 static int __init sm_sis5595_init(void)
826 return pci_register_driver(&sis5595_pci_driver);
829 static void __exit sm_sis5595_exit(void)
831 pci_unregister_driver(&sis5595_pci_driver);
832 if (s_bridge != NULL) {
833 i2c_isa_del_driver(&sis5595_driver);
834 pci_dev_put(s_bridge);
835 s_bridge = NULL;
839 MODULE_AUTHOR("Aurelien Jarno <aurelien@aurel32.net>");
840 MODULE_DESCRIPTION("SiS 5595 Sensor device");
841 MODULE_LICENSE("GPL");
843 module_init(sm_sis5595_init);
844 module_exit(sm_sis5595_exit);