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); 867