1 /* 2 it87.c - Part of lm_sensors, Linux kernel modules for hardware 3 monitoring. 4 5 Supports: IT8705F Super I/O chip w/LPC interface 6 IT8712F Super I/O chip w/LPC interface 7 IT8716F Super I/O chip w/LPC interface 8 IT8718F Super I/O chip w/LPC interface 9 IT8726F Super I/O chip w/LPC interface 10 Sis950 A clone of the IT8705F 11 12 Copyright (C) 2001 Chris Gauthron <chrisg@0-in.com> 13 Copyright (C) 2005-2006 Jean Delvare <khali@linux-fr.org> 14 15 This program is free software; you can redistribute it and/or modify 16 it under the terms of the GNU General Public License as published by 17 the Free Software Foundation; either version 2 of the License, or 18 (at your option) any later version. 19 20 This program is distributed in the hope that it will be useful, 21 but WITHOUT ANY WARRANTY; without even the implied warranty of 22 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 23 GNU General Public License for more details. 24 25 You should have received a copy of the GNU General Public License 26 along with this program; if not, write to the Free Software 27 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 28 */ 29 30 #include <linux/module.h> 31 #include <linux/init.h> 32 #include <linux/slab.h> 33 #include <linux/jiffies.h> 34 #include <linux/platform_device.h> 35 #include <linux/hwmon.h> 36 #include <linux/hwmon-sysfs.h> 37 #include <linux/hwmon-vid.h> 38 #include <linux/err.h> 39 #include <linux/mutex.h> 40 #include <linux/sysfs.h> 41 #include <asm/io.h> 42 43 #define DRVNAME "it87" 44 45 enum chips { it87, it8712, it8716, it8718 }; 46 47 static struct platform_device *pdev; 48 49 #define REG 0x2e /* The register to read/write */ 50 #define DEV 0x07 /* Register: Logical device select */ 51 #define VAL 0x2f /* The value to read/write */ 52 #define PME 0x04 /* The device with the fan registers in it */ 53 #define GPIO 0x07 /* The device with the IT8718F VID value in it */ 54 #define DEVID 0x20 /* Register: Device ID */ 55 #define DEVREV 0x22 /* Register: Device Revision */ 56 57 static inline int 58 superio_inb(int reg) 59 { 60 outb(reg, REG); 61 return inb(VAL); 62 } 63 64 static int superio_inw(int reg) 65 { 66 int val; 67 outb(reg++, REG); 68 val = inb(VAL) << 8; 69 outb(reg, REG); 70 val |= inb(VAL); 71 return val; 72 } 73 74 static inline void 75 superio_select(int ldn) 76 { 77 outb(DEV, REG); 78 outb(ldn, VAL); 79 } 80 81 static inline void 82 superio_enter(void) 83 { 84 outb(0x87, REG); 85 outb(0x01, REG); 86 outb(0x55, REG); 87 outb(0x55, REG); 88 } 89 90 static inline void 91 superio_exit(void) 92 { 93 outb(0x02, REG); 94 outb(0x02, VAL); 95 } 96 97 /* Logical device 4 registers */ 98 #define IT8712F_DEVID 0x8712 99 #define IT8705F_DEVID 0x8705 100 #define IT8716F_DEVID 0x8716 101 #define IT8718F_DEVID 0x8718 102 #define IT8726F_DEVID 0x8726 103 #define IT87_ACT_REG 0x30 104 #define IT87_BASE_REG 0x60 105 106 /* Logical device 7 registers (IT8712F and later) */ 107 #define IT87_SIO_PINX2_REG 0x2c /* Pin selection */ 108 #define IT87_SIO_VID_REG 0xfc /* VID value */ 109 110 /* Update battery voltage after every reading if true */ 111 static int update_vbat; 112 113 /* Not all BIOSes properly configure the PWM registers */ 114 static int fix_pwm_polarity; 115 116 /* Many IT87 constants specified below */ 117 118 /* Length of ISA address segment */ 119 #define IT87_EXTENT 8 120 121 /* Where are the ISA address/data registers relative to the base address */ 122 #define IT87_ADDR_REG_OFFSET 5 123 #define IT87_DATA_REG_OFFSET 6 124 125 /*----- The IT87 registers -----*/ 126 127 #define IT87_REG_CONFIG 0x00 128 129 #define IT87_REG_ALARM1 0x01 130 #define IT87_REG_ALARM2 0x02 131 #define IT87_REG_ALARM3 0x03 132 133 /* The IT8718F has the VID value in a different register, in Super-I/O 134 configuration space. */ 135 #define IT87_REG_VID 0x0a 136 /* Warning: register 0x0b is used for something completely different in 137 new chips/revisions. I suspect only 16-bit tachometer mode will work 138 for these. */ 139 #define IT87_REG_FAN_DIV 0x0b 140 #define IT87_REG_FAN_16BIT 0x0c 141 142 /* Monitors: 9 voltage (0 to 7, battery), 3 temp (1 to 3), 3 fan (1 to 3) */ 143 144 static const u8 IT87_REG_FAN[] = { 0x0d, 0x0e, 0x0f, 0x80, 0x82 }; 145 static const u8 IT87_REG_FAN_MIN[] = { 0x10, 0x11, 0x12, 0x84, 0x86 }; 146 static const u8 IT87_REG_FANX[] = { 0x18, 0x19, 0x1a, 0x81, 0x83 }; 147 static const u8 IT87_REG_FANX_MIN[] = { 0x1b, 0x1c, 0x1d, 0x85, 0x87 }; 148 #define IT87_REG_FAN_MAIN_CTRL 0x13 149 #define IT87_REG_FAN_CTL 0x14 150 #define IT87_REG_PWM(nr) (0x15 + (nr)) 151 152 #define IT87_REG_VIN(nr) (0x20 + (nr)) 153 #define IT87_REG_TEMP(nr) (0x29 + (nr)) 154 155 #define IT87_REG_VIN_MAX(nr) (0x30 + (nr) * 2) 156 #define IT87_REG_VIN_MIN(nr) (0x31 + (nr) * 2) 157 #define IT87_REG_TEMP_HIGH(nr) (0x40 + (nr) * 2) 158 #define IT87_REG_TEMP_LOW(nr) (0x41 + (nr) * 2) 159 160 #define IT87_REG_VIN_ENABLE 0x50 161 #define IT87_REG_TEMP_ENABLE 0x51 162 163 #define IT87_REG_CHIPID 0x58 164 165 #define IN_TO_REG(val) (SENSORS_LIMIT((((val) + 8)/16),0,255)) 166 #define IN_FROM_REG(val) ((val) * 16) 167 168 static inline u8 FAN_TO_REG(long rpm, int div) 169 { 170 if (rpm == 0) 171 return 255; 172 rpm = SENSORS_LIMIT(rpm, 1, 1000000); 173 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 174 254); 175 } 176 177 static inline u16 FAN16_TO_REG(long rpm) 178 { 179 if (rpm == 0) 180 return 0xffff; 181 return SENSORS_LIMIT((1350000 + rpm) / (rpm * 2), 1, 0xfffe); 182 } 183 184 #define FAN_FROM_REG(val,div) ((val)==0?-1:(val)==255?0:1350000/((val)*(div))) 185 /* The divider is fixed to 2 in 16-bit mode */ 186 #define FAN16_FROM_REG(val) ((val)==0?-1:(val)==0xffff?0:1350000/((val)*2)) 187 188 #define TEMP_TO_REG(val) (SENSORS_LIMIT(((val)<0?(((val)-500)/1000):\ 189 ((val)+500)/1000),-128,127)) 190 #define TEMP_FROM_REG(val) (((val)>0x80?(val)-0x100:(val))*1000) 191 192 #define PWM_TO_REG(val) ((val) >> 1) 193 #define PWM_FROM_REG(val) (((val)&0x7f) << 1) 194 195 static int DIV_TO_REG(int val) 196 { 197 int answer = 0; 198 while (answer < 7 && (val >>= 1)) 199 answer++; 200 return answer; 201 } 202 #define DIV_FROM_REG(val) (1 << (val)) 203 204 static const unsigned int pwm_freq[8] = { 205 48000000 / 128, 206 24000000 / 128, 207 12000000 / 128, 208 8000000 / 128, 209 6000000 / 128, 210 3000000 / 128, 211 1500000 / 128, 212 750000 / 128, 213 }; 214 215 216 struct it87_sio_data { 217 enum chips type; 218 /* Values read from Super-I/O config space */ 219 u8 vid_value; 220 }; 221 222 /* For each registered chip, we need to keep some data in memory. 223 The structure is dynamically allocated. */ 224 struct it87_data { 225 struct device *hwmon_dev; 226 enum chips type; 227 228 unsigned short addr; 229 const char *name; 230 struct mutex update_lock; 231 char valid; /* !=0 if following fields are valid */ 232 unsigned long last_updated; /* In jiffies */ 233 234 u8 in[9]; /* Register value */ 235 u8 in_max[8]; /* Register value */ 236 u8 in_min[8]; /* Register value */ 237 u8 has_fan; /* Bitfield, fans enabled */ 238 u16 fan[5]; /* Register values, possibly combined */ 239 u16 fan_min[5]; /* Register values, possibly combined */ 240 u8 temp[3]; /* Register value */ 241 u8 temp_high[3]; /* Register value */ 242 u8 temp_low[3]; /* Register value */ 243 u8 sensor; /* Register value */ 244 u8 fan_div[3]; /* Register encoding, shifted right */ 245 u8 vid; /* Register encoding, combined */ 246 u8 vrm; 247 u32 alarms; /* Register encoding, combined */ 248 u8 fan_main_ctrl; /* Register value */ 249 u8 fan_ctl; /* Register value */ 250 u8 manual_pwm_ctl[3]; /* manual PWM value set by user */ 251 }; 252 253 254 static int it87_probe(struct platform_device *pdev); 255 static int __devexit it87_remove(struct platform_device *pdev); 256 257 static int it87_read_value(struct it87_data *data, u8 reg); 258 static void it87_write_value(struct it87_data *data, u8 reg, u8 value); 259 static struct it87_data *it87_update_device(struct device *dev); 260 static int it87_check_pwm(struct device *dev); 261 static void it87_init_device(struct platform_device *pdev); 262 263 264 static struct platform_driver it87_driver = { 265 .driver = { 266 .owner = THIS_MODULE, 267 .name = DRVNAME, 268 }, 269 .probe = it87_probe, 270 .remove = __devexit_p(it87_remove), 271 }; 272 273 static ssize_t show_in(struct device *dev, struct device_attribute *attr, 274 char *buf) 275 { 276 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 277 int nr = sensor_attr->index; 278 279 struct it87_data *data = it87_update_device(dev); 280 return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr])); 281 } 282 283 static ssize_t show_in_min(struct device *dev, struct device_attribute *attr, 284 char *buf) 285 { 286 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 287 int nr = sensor_attr->index; 288 289 struct it87_data *data = it87_update_device(dev); 290 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[nr])); 291 } 292 293 static ssize_t show_in_max(struct device *dev, struct device_attribute *attr, 294 char *buf) 295 { 296 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 297 int nr = sensor_attr->index; 298 299 struct it87_data *data = it87_update_device(dev); 300 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[nr])); 301 } 302 303 static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, 304 const char *buf, size_t count) 305 { 306 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 307 int nr = sensor_attr->index; 308 309 struct it87_data *data = dev_get_drvdata(dev); 310 unsigned long val = simple_strtoul(buf, NULL, 10); 311 312 mutex_lock(&data->update_lock); 313 data->in_min[nr] = IN_TO_REG(val); 314 it87_write_value(data, IT87_REG_VIN_MIN(nr), 315 data->in_min[nr]); 316 mutex_unlock(&data->update_lock); 317 return count; 318 } 319 static ssize_t set_in_max(struct device *dev, struct device_attribute *attr, 320 const char *buf, size_t count) 321 { 322 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 323 int nr = sensor_attr->index; 324 325 struct it87_data *data = dev_get_drvdata(dev); 326 unsigned long val = simple_strtoul(buf, NULL, 10); 327 328 mutex_lock(&data->update_lock); 329 data->in_max[nr] = IN_TO_REG(val); 330 it87_write_value(data, IT87_REG_VIN_MAX(nr), 331 data->in_max[nr]); 332 mutex_unlock(&data->update_lock); 333 return count; 334 } 335 336 #define show_in_offset(offset) \ 337 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \ 338 show_in, NULL, offset); 339 340 #define limit_in_offset(offset) \ 341 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \ 342 show_in_min, set_in_min, offset); \ 343 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \ 344 show_in_max, set_in_max, offset); 345 346 show_in_offset(0); 347 limit_in_offset(0); 348 show_in_offset(1); 349 limit_in_offset(1); 350 show_in_offset(2); 351 limit_in_offset(2); 352 show_in_offset(3); 353 limit_in_offset(3); 354 show_in_offset(4); 355 limit_in_offset(4); 356 show_in_offset(5); 357 limit_in_offset(5); 358 show_in_offset(6); 359 limit_in_offset(6); 360 show_in_offset(7); 361 limit_in_offset(7); 362 show_in_offset(8); 363 364 /* 3 temperatures */ 365 static ssize_t show_temp(struct device *dev, struct device_attribute *attr, 366 char *buf) 367 { 368 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 369 int nr = sensor_attr->index; 370 371 struct it87_data *data = it87_update_device(dev); 372 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr])); 373 } 374 static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr, 375 char *buf) 376 { 377 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 378 int nr = sensor_attr->index; 379 380 struct it87_data *data = it87_update_device(dev); 381 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_high[nr])); 382 } 383 static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr, 384 char *buf) 385 { 386 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 387 int nr = sensor_attr->index; 388 389 struct it87_data *data = it87_update_device(dev); 390 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_low[nr])); 391 } 392 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, 393 const char *buf, size_t count) 394 { 395 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 396 int nr = sensor_attr->index; 397 398 struct it87_data *data = dev_get_drvdata(dev); 399 int val = simple_strtol(buf, NULL, 10); 400 401 mutex_lock(&data->update_lock); 402 data->temp_high[nr] = TEMP_TO_REG(val); 403 it87_write_value(data, IT87_REG_TEMP_HIGH(nr), data->temp_high[nr]); 404 mutex_unlock(&data->update_lock); 405 return count; 406 } 407 static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr, 408 const char *buf, size_t count) 409 { 410 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 411 int nr = sensor_attr->index; 412 413 struct it87_data *data = dev_get_drvdata(dev); 414 int val = simple_strtol(buf, NULL, 10); 415 416 mutex_lock(&data->update_lock); 417 data->temp_low[nr] = TEMP_TO_REG(val); 418 it87_write_value(data, IT87_REG_TEMP_LOW(nr), data->temp_low[nr]); 419 mutex_unlock(&data->update_lock); 420 return count; 421 } 422 #define show_temp_offset(offset) \ 423 static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \ 424 show_temp, NULL, offset - 1); \ 425 static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \ 426 show_temp_max, set_temp_max, offset - 1); \ 427 static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \ 428 show_temp_min, set_temp_min, offset - 1); 429 430 show_temp_offset(1); 431 show_temp_offset(2); 432 show_temp_offset(3); 433 434 static ssize_t show_sensor(struct device *dev, struct device_attribute *attr, 435 char *buf) 436 { 437 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 438 int nr = sensor_attr->index; 439 440 struct it87_data *data = it87_update_device(dev); 441 u8 reg = data->sensor; /* In case the value is updated while we use it */ 442 443 if (reg & (1 << nr)) 444 return sprintf(buf, "3\n"); /* thermal diode */ 445 if (reg & (8 << nr)) 446 return sprintf(buf, "2\n"); /* thermistor */ 447 return sprintf(buf, "0\n"); /* disabled */ 448 } 449 static ssize_t set_sensor(struct device *dev, struct device_attribute *attr, 450 const char *buf, size_t count) 451 { 452 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 453 int nr = sensor_attr->index; 454 455 struct it87_data *data = dev_get_drvdata(dev); 456 int val = simple_strtol(buf, NULL, 10); 457 458 mutex_lock(&data->update_lock); 459 460 data->sensor &= ~(1 << nr); 461 data->sensor &= ~(8 << nr); 462 /* 3 = thermal diode; 2 = thermistor; 0 = disabled */ 463 if (val == 3) 464 data->sensor |= 1 << nr; 465 else if (val == 2) 466 data->sensor |= 8 << nr; 467 else if (val != 0) { 468 mutex_unlock(&data->update_lock); 469 return -EINVAL; 470 } 471 it87_write_value(data, IT87_REG_TEMP_ENABLE, data->sensor); 472 mutex_unlock(&data->update_lock); 473 return count; 474 } 475 #define show_sensor_offset(offset) \ 476 static SENSOR_DEVICE_ATTR(temp##offset##_type, S_IRUGO | S_IWUSR, \ 477 show_sensor, set_sensor, offset - 1); 478 479 show_sensor_offset(1); 480 show_sensor_offset(2); 481 show_sensor_offset(3); 482 483 /* 3 Fans */ 484 static ssize_t show_fan(struct device *dev, struct device_attribute *attr, 485 char *buf) 486 { 487 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 488 int nr = sensor_attr->index; 489 490 struct it87_data *data = it87_update_device(dev); 491 return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan[nr], 492 DIV_FROM_REG(data->fan_div[nr]))); 493 } 494 static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr, 495 char *buf) 496 { 497 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 498 int nr = sensor_attr->index; 499 500 struct it87_data *data = it87_update_device(dev); 501 return sprintf(buf,"%d\n", 502 FAN_FROM_REG(data->fan_min[nr], DIV_FROM_REG(data->fan_div[nr]))); 503 } 504 static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr, 505 char *buf) 506 { 507 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 508 int nr = sensor_attr->index; 509 510 struct it87_data *data = it87_update_device(dev); 511 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); 512 } 513 static ssize_t show_pwm_enable(struct device *dev, struct device_attribute *attr, 514 char *buf) 515 { 516 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 517 int nr = sensor_attr->index; 518 519 struct it87_data *data = it87_update_device(dev); 520 return sprintf(buf,"%d\n", (data->fan_main_ctrl & (1 << nr)) ? 1 : 0); 521 } 522 static ssize_t show_pwm(struct device *dev, struct device_attribute *attr, 523 char *buf) 524 { 525 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 526 int nr = sensor_attr->index; 527 528 struct it87_data *data = it87_update_device(dev); 529 return sprintf(buf,"%d\n", data->manual_pwm_ctl[nr]); 530 } 531 static ssize_t show_pwm_freq(struct device *dev, struct device_attribute *attr, 532 char *buf) 533 { 534 struct it87_data *data = it87_update_device(dev); 535 int index = (data->fan_ctl >> 4) & 0x07; 536 537 return sprintf(buf, "%u\n", pwm_freq[index]); 538 } 539 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, 540 const char *buf, size_t count) 541 { 542 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 543 int nr = sensor_attr->index; 544 545 struct it87_data *data = dev_get_drvdata(dev); 546 int val = simple_strtol(buf, NULL, 10); 547 u8 reg; 548 549 mutex_lock(&data->update_lock); 550 reg = it87_read_value(data, IT87_REG_FAN_DIV); 551 switch (nr) { 552 case 0: data->fan_div[nr] = reg & 0x07; break; 553 case 1: data->fan_div[nr] = (reg >> 3) & 0x07; break; 554 case 2: data->fan_div[nr] = (reg & 0x40) ? 3 : 1; break; 555 } 556 557 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr])); 558 it87_write_value(data, IT87_REG_FAN_MIN[nr], data->fan_min[nr]); 559 mutex_unlock(&data->update_lock); 560 return count; 561 } 562 static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, 563 const char *buf, size_t count) 564 { 565 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 566 int nr = sensor_attr->index; 567 568 struct it87_data *data = dev_get_drvdata(dev); 569 unsigned long val = simple_strtoul(buf, NULL, 10); 570 int min; 571 u8 old; 572 573 mutex_lock(&data->update_lock); 574 old = it87_read_value(data, IT87_REG_FAN_DIV); 575 576 /* Save fan min limit */ 577 min = FAN_FROM_REG(data->fan_min[nr], DIV_FROM_REG(data->fan_div[nr])); 578 579 switch (nr) { 580 case 0: 581 case 1: 582 data->fan_div[nr] = DIV_TO_REG(val); 583 break; 584 case 2: 585 if (val < 8) 586 data->fan_div[nr] = 1; 587 else 588 data->fan_div[nr] = 3; 589 } 590 val = old & 0x80; 591 val |= (data->fan_div[0] & 0x07); 592 val |= (data->fan_div[1] & 0x07) << 3; 593 if (data->fan_div[2] == 3) 594 val |= 0x1 << 6; 595 it87_write_value(data, IT87_REG_FAN_DIV, val); 596 597 /* Restore fan min limit */ 598 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr])); 599 it87_write_value(data, IT87_REG_FAN_MIN[nr], data->fan_min[nr]); 600 601 mutex_unlock(&data->update_lock); 602 return count; 603 } 604 static ssize_t set_pwm_enable(struct device *dev, 605 struct device_attribute *attr, const char *buf, size_t count) 606 { 607 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 608 int nr = sensor_attr->index; 609 610 struct it87_data *data = dev_get_drvdata(dev); 611 int val = simple_strtol(buf, NULL, 10); 612 613 mutex_lock(&data->update_lock); 614 615 if (val == 0) { 616 int tmp; 617 /* make sure the fan is on when in on/off mode */ 618 tmp = it87_read_value(data, IT87_REG_FAN_CTL); 619 it87_write_value(data, IT87_REG_FAN_CTL, tmp | (1 << nr)); 620 /* set on/off mode */ 621 data->fan_main_ctrl &= ~(1 << nr); 622 it87_write_value(data, IT87_REG_FAN_MAIN_CTRL, data->fan_main_ctrl); 623 } else if (val == 1) { 624 /* set SmartGuardian mode */ 625 data->fan_main_ctrl |= (1 << nr); 626 it87_write_value(data, IT87_REG_FAN_MAIN_CTRL, data->fan_main_ctrl); 627 /* set saved pwm value, clear FAN_CTLX PWM mode bit */ 628 it87_write_value(data, IT87_REG_PWM(nr), PWM_TO_REG(data->manual_pwm_ctl[nr])); 629 } else { 630 mutex_unlock(&data->update_lock); 631 return -EINVAL; 632 } 633 634 mutex_unlock(&data->update_lock); 635 return count; 636 } 637 static ssize_t set_pwm(struct device *dev, struct device_attribute *attr, 638 const char *buf, size_t count) 639 { 640 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 641 int nr = sensor_attr->index; 642 643 struct it87_data *data = dev_get_drvdata(dev); 644 int val = simple_strtol(buf, NULL, 10); 645 646 if (val < 0 || val > 255) 647 return -EINVAL; 648 649 mutex_lock(&data->update_lock); 650 data->manual_pwm_ctl[nr] = val; 651 if (data->fan_main_ctrl & (1 << nr)) 652 it87_write_value(data, IT87_REG_PWM(nr), PWM_TO_REG(data->manual_pwm_ctl[nr])); 653 mutex_unlock(&data->update_lock); 654 return count; 655 } 656 static ssize_t set_pwm_freq(struct device *dev, 657 struct device_attribute *attr, const char *buf, size_t count) 658 { 659 struct it87_data *data = dev_get_drvdata(dev); 660 unsigned long val = simple_strtoul(buf, NULL, 10); 661 int i; 662 663 /* Search for the nearest available frequency */ 664 for (i = 0; i < 7; i++) { 665 if (val > (pwm_freq[i] + pwm_freq[i+1]) / 2) 666 break; 667 } 668 669 mutex_lock(&data->update_lock); 670 data->fan_ctl = it87_read_value(data, IT87_REG_FAN_CTL) & 0x8f; 671 data->fan_ctl |= i << 4; 672 it87_write_value(data, IT87_REG_FAN_CTL, data->fan_ctl); 673 mutex_unlock(&data->update_lock); 674 675 return count; 676 } 677 678 #define show_fan_offset(offset) \ 679 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \ 680 show_fan, NULL, offset - 1); \ 681 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ 682 show_fan_min, set_fan_min, offset - 1); \ 683 static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ 684 show_fan_div, set_fan_div, offset - 1); 685 686 show_fan_offset(1); 687 show_fan_offset(2); 688 show_fan_offset(3); 689 690 #define show_pwm_offset(offset) \ 691 static SENSOR_DEVICE_ATTR(pwm##offset##_enable, S_IRUGO | S_IWUSR, \ 692 show_pwm_enable, set_pwm_enable, offset - 1); \ 693 static SENSOR_DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ 694 show_pwm, set_pwm, offset - 1); \ 695 static DEVICE_ATTR(pwm##offset##_freq, \ 696 (offset == 1 ? S_IRUGO | S_IWUSR : S_IRUGO), \ 697 show_pwm_freq, (offset == 1 ? set_pwm_freq : NULL)); 698 699 show_pwm_offset(1); 700 show_pwm_offset(2); 701 show_pwm_offset(3); 702 703 /* A different set of callbacks for 16-bit fans */ 704 static ssize_t show_fan16(struct device *dev, struct device_attribute *attr, 705 char *buf) 706 { 707 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 708 int nr = sensor_attr->index; 709 struct it87_data *data = it87_update_device(dev); 710 return sprintf(buf, "%d\n", FAN16_FROM_REG(data->fan[nr])); 711 } 712 713 static ssize_t show_fan16_min(struct device *dev, struct device_attribute *attr, 714 char *buf) 715 { 716 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 717 int nr = sensor_attr->index; 718 struct it87_data *data = it87_update_device(dev); 719 return sprintf(buf, "%d\n", FAN16_FROM_REG(data->fan_min[nr])); 720 } 721 722 static ssize_t set_fan16_min(struct device *dev, struct device_attribute *attr, 723 const char *buf, size_t count) 724 { 725 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 726 int nr = sensor_attr->index; 727 struct it87_data *data = dev_get_drvdata(dev); 728 int val = simple_strtol(buf, NULL, 10); 729 730 mutex_lock(&data->update_lock); 731 data->fan_min[nr] = FAN16_TO_REG(val); 732 it87_write_value(data, IT87_REG_FAN_MIN[nr], 733 data->fan_min[nr] & 0xff); 734 it87_write_value(data, IT87_REG_FANX_MIN[nr], 735 data->fan_min[nr] >> 8); 736 mutex_unlock(&data->update_lock); 737 return count; 738 } 739 740 /* We want to use the same sysfs file names as 8-bit fans, but we need 741 different variable names, so we have to use SENSOR_ATTR instead of 742 SENSOR_DEVICE_ATTR. */ 743 #define show_fan16_offset(offset) \ 744 static struct sensor_device_attribute sensor_dev_attr_fan##offset##_input16 \ 745 = SENSOR_ATTR(fan##offset##_input, S_IRUGO, \ 746 show_fan16, NULL, offset - 1); \ 747 static struct sensor_device_attribute sensor_dev_attr_fan##offset##_min16 \ 748 = SENSOR_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ 749 show_fan16_min, set_fan16_min, offset - 1) 750 751 show_fan16_offset(1); 752 show_fan16_offset(2); 753 show_fan16_offset(3); 754 show_fan16_offset(4); 755 show_fan16_offset(5); 756 757 /* Alarms */ 758 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) 759 { 760 struct it87_data *data = it87_update_device(dev); 761 return sprintf(buf, "%u\n", data->alarms); 762 } 763 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); 764 765 static ssize_t 766 show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf) 767 { 768 struct it87_data *data = dev_get_drvdata(dev); 769 return sprintf(buf, "%u\n", data->vrm); 770 } 771 static ssize_t 772 store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 773 { 774 struct it87_data *data = dev_get_drvdata(dev); 775 u32 val; 776 777 val = simple_strtoul(buf, NULL, 10); 778 data->vrm = val; 779 780 return count; 781 } 782 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg); 783 784 static ssize_t 785 show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf) 786 { 787 struct it87_data *data = it87_update_device(dev); 788 return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm)); 789 } 790 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL); 791 792 static ssize_t show_name(struct device *dev, struct device_attribute 793 *devattr, char *buf) 794 { 795 struct it87_data *data = dev_get_drvdata(dev); 796 return sprintf(buf, "%s\n", data->name); 797 } 798 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL); 799 800 static struct attribute *it87_attributes[] = { 801 &sensor_dev_attr_in0_input.dev_attr.attr, 802 &sensor_dev_attr_in1_input.dev_attr.attr, 803 &sensor_dev_attr_in2_input.dev_attr.attr, 804 &sensor_dev_attr_in3_input.dev_attr.attr, 805 &sensor_dev_attr_in4_input.dev_attr.attr, 806 &sensor_dev_attr_in5_input.dev_attr.attr, 807 &sensor_dev_attr_in6_input.dev_attr.attr, 808 &sensor_dev_attr_in7_input.dev_attr.attr, 809 &sensor_dev_attr_in8_input.dev_attr.attr, 810 &sensor_dev_attr_in0_min.dev_attr.attr, 811 &sensor_dev_attr_in1_min.dev_attr.attr, 812 &sensor_dev_attr_in2_min.dev_attr.attr, 813 &sensor_dev_attr_in3_min.dev_attr.attr, 814 &sensor_dev_attr_in4_min.dev_attr.attr, 815 &sensor_dev_attr_in5_min.dev_attr.attr, 816 &sensor_dev_attr_in6_min.dev_attr.attr, 817 &sensor_dev_attr_in7_min.dev_attr.attr, 818 &sensor_dev_attr_in0_max.dev_attr.attr, 819 &sensor_dev_attr_in1_max.dev_attr.attr, 820 &sensor_dev_attr_in2_max.dev_attr.attr, 821 &sensor_dev_attr_in3_max.dev_attr.attr, 822 &sensor_dev_attr_in4_max.dev_attr.attr, 823 &sensor_dev_attr_in5_max.dev_attr.attr, 824 &sensor_dev_attr_in6_max.dev_attr.attr, 825 &sensor_dev_attr_in7_max.dev_attr.attr, 826 827 &sensor_dev_attr_temp1_input.dev_attr.attr, 828 &sensor_dev_attr_temp2_input.dev_attr.attr, 829 &sensor_dev_attr_temp3_input.dev_attr.attr, 830 &sensor_dev_attr_temp1_max.dev_attr.attr, 831 &sensor_dev_attr_temp2_max.dev_attr.attr, 832 &sensor_dev_attr_temp3_max.dev_attr.attr, 833 &sensor_dev_attr_temp1_min.dev_attr.attr, 834 &sensor_dev_attr_temp2_min.dev_attr.attr, 835 &sensor_dev_attr_temp3_min.dev_attr.attr, 836 &sensor_dev_attr_temp1_type.dev_attr.attr, 837 &sensor_dev_attr_temp2_type.dev_attr.attr, 838 &sensor_dev_attr_temp3_type.dev_attr.attr, 839 840 &dev_attr_alarms.attr, 841 &dev_attr_name.attr, 842 NULL 843 }; 844 845 static const struct attribute_group it87_group = { 846 .attrs = it87_attributes, 847 }; 848 849 static struct attribute *it87_attributes_opt[] = { 850 &sensor_dev_attr_fan1_input16.dev_attr.attr, 851 &sensor_dev_attr_fan1_min16.dev_attr.attr, 852 &sensor_dev_attr_fan2_input16.dev_attr.attr, 853 &sensor_dev_attr_fan2_min16.dev_attr.attr, 854 &sensor_dev_attr_fan3_input16.dev_attr.attr, 855 &sensor_dev_attr_fan3_min16.dev_attr.attr, 856 &sensor_dev_attr_fan4_input16.dev_attr.attr, 857 &sensor_dev_attr_fan4_min16.dev_attr.attr, 858 &sensor_dev_attr_fan5_input16.dev_attr.attr, 859 &sensor_dev_attr_fan5_min16.dev_attr.attr, 860 861 &sensor_dev_attr_fan1_input.dev_attr.attr, 862 &sensor_dev_attr_fan1_min.dev_attr.attr, 863 &sensor_dev_attr_fan1_div.dev_attr.attr, 864 &sensor_dev_attr_fan2_input.dev_attr.attr, 865 &sensor_dev_attr_fan2_min.dev_attr.attr, 866 &sensor_dev_attr_fan2_div.dev_attr.attr, 867 &sensor_dev_attr_fan3_input.dev_attr.attr, 868 &sensor_dev_attr_fan3_min.dev_attr.attr, 869 &sensor_dev_attr_fan3_div.dev_attr.attr, 870 871 &sensor_dev_attr_pwm1_enable.dev_attr.attr, 872 &sensor_dev_attr_pwm2_enable.dev_attr.attr, 873 &sensor_dev_attr_pwm3_enable.dev_attr.attr, 874 &sensor_dev_attr_pwm1.dev_attr.attr, 875 &sensor_dev_attr_pwm2.dev_attr.attr, 876 &sensor_dev_attr_pwm3.dev_attr.attr, 877 878 &dev_attr_vrm.attr, 879 &dev_attr_cpu0_vid.attr, 880 NULL 881 }; 882 883 static const struct attribute_group it87_group_opt = { 884 .attrs = it87_attributes_opt, 885 }; 886 887 /* SuperIO detection - will change isa_address if a chip is found */ 888 static int __init it87_find(unsigned short *address, 889 struct it87_sio_data *sio_data) 890 { 891 int err = -ENODEV; 892 u16 chip_type; 893 894 superio_enter(); 895 chip_type = superio_inw(DEVID); 896 897 switch (chip_type) { 898 case IT8705F_DEVID: 899 sio_data->type = it87; 900 break; 901 case IT8712F_DEVID: 902 sio_data->type = it8712; 903 break; 904 case IT8716F_DEVID: 905 case IT8726F_DEVID: 906 sio_data->type = it8716; 907 break; 908 case IT8718F_DEVID: 909 sio_data->type = it8718; 910 break; 911 case 0xffff: /* No device at all */ 912 goto exit; 913 default: 914 pr_debug(DRVNAME ": Unsupported chip (DEVID=0x%x)\n", 915 chip_type); 916 goto exit; 917 } 918 919 superio_select(PME); 920 if (!(superio_inb(IT87_ACT_REG) & 0x01)) { 921 pr_info("it87: Device not activated, skipping\n"); 922 goto exit; 923 } 924 925 *address = superio_inw(IT87_BASE_REG) & ~(IT87_EXTENT - 1); 926 if (*address == 0) { 927 pr_info("it87: Base address not set, skipping\n"); 928 goto exit; 929 } 930 931 err = 0; 932 pr_info("it87: Found IT%04xF chip at 0x%x, revision %d\n", 933 chip_type, *address, superio_inb(DEVREV) & 0x0f); 934 935 /* Read GPIO config and VID value from LDN 7 (GPIO) */ 936 if (chip_type != IT8705F_DEVID) { 937 int reg; 938 939 superio_select(GPIO); 940 if (chip_type == it8718) 941 sio_data->vid_value = superio_inb(IT87_SIO_VID_REG); 942 943 reg = superio_inb(IT87_SIO_PINX2_REG); 944 if (reg & (1 << 0)) 945 pr_info("it87: in3 is VCC (+5V)\n"); 946 if (reg & (1 << 1)) 947 pr_info("it87: in7 is VCCH (+5V Stand-By)\n"); 948 } 949 950 exit: 951 superio_exit(); 952 return err; 953 } 954 955 static int __devinit it87_probe(struct platform_device *pdev) 956 { 957 struct it87_data *data; 958 struct resource *res; 959 struct device *dev = &pdev->dev; 960 struct it87_sio_data *sio_data = dev->platform_data; 961 int err = 0; 962 int enable_pwm_interface; 963 static const char *names[] = { 964 "it87", 965 "it8712", 966 "it8716", 967 "it8718", 968 }; 969 970 res = platform_get_resource(pdev, IORESOURCE_IO, 0); 971 if (!request_region(res->start, IT87_EXTENT, DRVNAME)) { 972 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n", 973 (unsigned long)res->start, 974 (unsigned long)(res->start + IT87_EXTENT - 1)); 975 err = -EBUSY; 976 goto ERROR0; 977 } 978 979 if (!(data = kzalloc(sizeof(struct it87_data), GFP_KERNEL))) { 980 err = -ENOMEM; 981 goto ERROR1; 982 } 983 984 data->addr = res->start; 985 data->type = sio_data->type; 986 data->name = names[sio_data->type]; 987 988 /* Now, we do the remaining detection. */ 989 if ((it87_read_value(data, IT87_REG_CONFIG) & 0x80) 990 || it87_read_value(data, IT87_REG_CHIPID) != 0x90) { 991 err = -ENODEV; 992 goto ERROR2; 993 } 994 995 platform_set_drvdata(pdev, data); 996 997 mutex_init(&data->update_lock); 998 999 /* Check PWM configuration */ 1000 enable_pwm_interface = it87_check_pwm(dev); 1001 1002 /* Initialize the IT87 chip */ 1003 it87_init_device(pdev); 1004 1005 /* Register sysfs hooks */ 1006 if ((err = sysfs_create_group(&dev->kobj, &it87_group))) 1007 goto ERROR2; 1008 1009 /* Do not create fan files for disabled fans */ 1010 if (data->type == it8716 || data->type == it8718) { 1011 /* 16-bit tachometers */ 1012 if (data->has_fan & (1 << 0)) { 1013 if ((err = device_create_file(dev, 1014 &sensor_dev_attr_fan1_input16.dev_attr)) 1015 || (err = device_create_file(dev, 1016 &sensor_dev_attr_fan1_min16.dev_attr))) 1017 goto ERROR4; 1018 } 1019 if (data->has_fan & (1 << 1)) { 1020 if ((err = device_create_file(dev, 1021 &sensor_dev_attr_fan2_input16.dev_attr)) 1022 || (err = device_create_file(dev, 1023 &sensor_dev_attr_fan2_min16.dev_attr))) 1024 goto ERROR4; 1025 } 1026 if (data->has_fan & (1 << 2)) { 1027 if ((err = device_create_file(dev, 1028 &sensor_dev_attr_fan3_input16.dev_attr)) 1029 || (err = device_create_file(dev, 1030 &sensor_dev_attr_fan3_min16.dev_attr))) 1031 goto ERROR4; 1032 } 1033 if (data->has_fan & (1 << 3)) { 1034 if ((err = device_create_file(dev, 1035 &sensor_dev_attr_fan4_input16.dev_attr)) 1036 || (err = device_create_file(dev, 1037 &sensor_dev_attr_fan4_min16.dev_attr))) 1038 goto ERROR4; 1039 } 1040 if (data->has_fan & (1 << 4)) { 1041 if ((err = device_create_file(dev, 1042 &sensor_dev_attr_fan5_input16.dev_attr)) 1043 || (err = device_create_file(dev, 1044 &sensor_dev_attr_fan5_min16.dev_attr))) 1045 goto ERROR4; 1046 } 1047 } else { 1048 /* 8-bit tachometers with clock divider */ 1049 if (data->has_fan & (1 << 0)) { 1050 if ((err = device_create_file(dev, 1051 &sensor_dev_attr_fan1_input.dev_attr)) 1052 || (err = device_create_file(dev, 1053 &sensor_dev_attr_fan1_min.dev_attr)) 1054 || (err = device_create_file(dev, 1055 &sensor_dev_attr_fan1_div.dev_attr))) 1056 goto ERROR4; 1057 } 1058 if (data->has_fan & (1 << 1)) { 1059 if ((err = device_create_file(dev, 1060 &sensor_dev_attr_fan2_input.dev_attr)) 1061 || (err = device_create_file(dev, 1062 &sensor_dev_attr_fan2_min.dev_attr)) 1063 || (err = device_create_file(dev, 1064 &sensor_dev_attr_fan2_div.dev_attr))) 1065 goto ERROR4; 1066 } 1067 if (data->has_fan & (1 << 2)) { 1068 if ((err = device_create_file(dev, 1069 &sensor_dev_attr_fan3_input.dev_attr)) 1070 || (err = device_create_file(dev, 1071 &sensor_dev_attr_fan3_min.dev_attr)) 1072 || (err = device_create_file(dev, 1073 &sensor_dev_attr_fan3_div.dev_attr))) 1074 goto ERROR4; 1075 } 1076 } 1077 1078 if (enable_pwm_interface) { 1079 if ((err = device_create_file(dev, 1080 &sensor_dev_attr_pwm1_enable.dev_attr)) 1081 || (err = device_create_file(dev, 1082 &sensor_dev_attr_pwm2_enable.dev_attr)) 1083 || (err = device_create_file(dev, 1084 &sensor_dev_attr_pwm3_enable.dev_attr)) 1085 || (err = device_create_file(dev, 1086 &sensor_dev_attr_pwm1.dev_attr)) 1087 || (err = device_create_file(dev, 1088 &sensor_dev_attr_pwm2.dev_attr)) 1089 || (err = device_create_file(dev, 1090 &sensor_dev_attr_pwm3.dev_attr)) 1091 || (err = device_create_file(dev, 1092 &dev_attr_pwm1_freq)) 1093 || (err = device_create_file(dev, 1094 &dev_attr_pwm2_freq)) 1095 || (err = device_create_file(dev, 1096 &dev_attr_pwm3_freq))) 1097 goto ERROR4; 1098 } 1099 1100 if (data->type == it8712 || data->type == it8716 1101 || data->type == it8718) { 1102 data->vrm = vid_which_vrm(); 1103 /* VID reading from Super-I/O config space if available */ 1104 data->vid = sio_data->vid_value; 1105 if ((err = device_create_file(dev, 1106 &dev_attr_vrm)) 1107 || (err = device_create_file(dev, 1108 &dev_attr_cpu0_vid))) 1109 goto ERROR4; 1110 } 1111 1112 data->hwmon_dev = hwmon_device_register(dev); 1113 if (IS_ERR(data->hwmon_dev)) { 1114 err = PTR_ERR(data->hwmon_dev); 1115 goto ERROR4; 1116 } 1117 1118 return 0; 1119 1120 ERROR4: 1121 sysfs_remove_group(&dev->kobj, &it87_group); 1122 sysfs_remove_group(&dev->kobj, &it87_group_opt); 1123 ERROR2: 1124 platform_set_drvdata(pdev, NULL); 1125 kfree(data); 1126 ERROR1: 1127 release_region(res->start, IT87_EXTENT); 1128 ERROR0: 1129 return err; 1130 } 1131 1132 static int __devexit it87_remove(struct platform_device *pdev) 1133 { 1134 struct it87_data *data = platform_get_drvdata(pdev); 1135 1136 hwmon_device_unregister(data->hwmon_dev); 1137 sysfs_remove_group(&pdev->dev.kobj, &it87_group); 1138 sysfs_remove_group(&pdev->dev.kobj, &it87_group_opt); 1139 1140 release_region(data->addr, IT87_EXTENT); 1141 platform_set_drvdata(pdev, NULL); 1142 kfree(data); 1143 1144 return 0; 1145 } 1146 1147 /* Must be called with data->update_lock held, except during initialization. 1148 We ignore the IT87 BUSY flag at this moment - it could lead to deadlocks, 1149 would slow down the IT87 access and should not be necessary. */ 1150 static int it87_read_value(struct it87_data *data, u8 reg) 1151 { 1152 outb_p(reg, data->addr + IT87_ADDR_REG_OFFSET); 1153 return inb_p(data->addr + IT87_DATA_REG_OFFSET); 1154 } 1155 1156 /* Must be called with data->update_lock held, except during initialization. 1157 We ignore the IT87 BUSY flag at this moment - it could lead to deadlocks, 1158 would slow down the IT87 access and should not be necessary. */ 1159 static void it87_write_value(struct it87_data *data, u8 reg, u8 value) 1160 { 1161 outb_p(reg, data->addr + IT87_ADDR_REG_OFFSET); 1162 outb_p(value, data->addr + IT87_DATA_REG_OFFSET); 1163 } 1164 1165 /* Return 1 if and only if the PWM interface is safe to use */ 1166 static int __devinit it87_check_pwm(struct device *dev) 1167 { 1168 struct it87_data *data = dev_get_drvdata(dev); 1169 /* Some BIOSes fail to correctly configure the IT87 fans. All fans off 1170 * and polarity set to active low is sign that this is the case so we 1171 * disable pwm control to protect the user. */ 1172 int tmp = it87_read_value(data, IT87_REG_FAN_CTL); 1173 if ((tmp & 0x87) == 0) { 1174 if (fix_pwm_polarity) { 1175 /* The user asks us to attempt a chip reconfiguration. 1176 * This means switching to active high polarity and 1177 * inverting all fan speed values. */ 1178 int i; 1179 u8 pwm[3]; 1180 1181 for (i = 0; i < 3; i++) 1182 pwm[i] = it87_read_value(data, 1183 IT87_REG_PWM(i)); 1184 1185 /* If any fan is in automatic pwm mode, the polarity 1186 * might be correct, as suspicious as it seems, so we 1187 * better don't change anything (but still disable the 1188 * PWM interface). */ 1189 if (!((pwm[0] | pwm[1] | pwm[2]) & 0x80)) { 1190 dev_info(dev, "Reconfiguring PWM to " 1191 "active high polarity\n"); 1192 it87_write_value(data, IT87_REG_FAN_CTL, 1193 tmp | 0x87); 1194 for (i = 0; i < 3; i++) 1195 it87_write_value(data, 1196 IT87_REG_PWM(i), 1197 0x7f & ~pwm[i]); 1198 return 1; 1199 } 1200 1201 dev_info(dev, "PWM configuration is " 1202 "too broken to be fixed\n"); 1203 } 1204 1205 dev_info(dev, "Detected broken BIOS " 1206 "defaults, disabling PWM interface\n"); 1207 return 0; 1208 } else if (fix_pwm_polarity) { 1209 dev_info(dev, "PWM configuration looks " 1210 "sane, won't touch\n"); 1211 } 1212 1213 return 1; 1214 } 1215 1216 /* Called when we have found a new IT87. */ 1217 static void __devinit it87_init_device(struct platform_device *pdev) 1218 { 1219 struct it87_data *data = platform_get_drvdata(pdev); 1220 int tmp, i; 1221 1222 /* initialize to sane defaults: 1223 * - if the chip is in manual pwm mode, this will be overwritten with 1224 * the actual settings on the chip (so in this case, initialization 1225 * is not needed) 1226 * - if in automatic or on/off mode, we could switch to manual mode, 1227 * read the registers and set manual_pwm_ctl accordingly, but currently 1228 * this is not implemented, so we initialize to something sane */ 1229 for (i = 0; i < 3; i++) { 1230 data->manual_pwm_ctl[i] = 0xff; 1231 } 1232 1233 /* Some chips seem to have default value 0xff for all limit 1234 * registers. For low voltage limits it makes no sense and triggers 1235 * alarms, so change to 0 instead. For high temperature limits, it 1236 * means -1 degree C, which surprisingly doesn't trigger an alarm, 1237 * but is still confusing, so change to 127 degrees C. */ 1238 for (i = 0; i < 8; i++) { 1239 tmp = it87_read_value(data, IT87_REG_VIN_MIN(i)); 1240 if (tmp == 0xff) 1241 it87_write_value(data, IT87_REG_VIN_MIN(i), 0); 1242 } 1243 for (i = 0; i < 3; i++) { 1244 tmp = it87_read_value(data, IT87_REG_TEMP_HIGH(i)); 1245 if (tmp == 0xff) 1246 it87_write_value(data, IT87_REG_TEMP_HIGH(i), 127); 1247 } 1248 1249 /* Check if temperature channnels are reset manually or by some reason */ 1250 tmp = it87_read_value(data, IT87_REG_TEMP_ENABLE); 1251 if ((tmp & 0x3f) == 0) { 1252 /* Temp1,Temp3=thermistor; Temp2=thermal diode */ 1253 tmp = (tmp & 0xc0) | 0x2a; 1254 it87_write_value(data, IT87_REG_TEMP_ENABLE, tmp); 1255 } 1256 data->sensor = tmp; 1257 1258 /* Check if voltage monitors are reset manually or by some reason */ 1259 tmp = it87_read_value(data, IT87_REG_VIN_ENABLE); 1260 if ((tmp & 0xff) == 0) { 1261 /* Enable all voltage monitors */ 1262 it87_write_value(data, IT87_REG_VIN_ENABLE, 0xff); 1263 } 1264 1265 /* Check if tachometers are reset manually or by some reason */ 1266 data->fan_main_ctrl = it87_read_value(data, IT87_REG_FAN_MAIN_CTRL); 1267 if ((data->fan_main_ctrl & 0x70) == 0) { 1268 /* Enable all fan tachometers */ 1269 data->fan_main_ctrl |= 0x70; 1270 it87_write_value(data, IT87_REG_FAN_MAIN_CTRL, data->fan_main_ctrl); 1271 } 1272 data->has_fan = (data->fan_main_ctrl >> 4) & 0x07; 1273 1274 /* Set tachometers to 16-bit mode if needed */ 1275 if (data->type == it8716 || data->type == it8718) { 1276 tmp = it87_read_value(data, IT87_REG_FAN_16BIT); 1277 if (~tmp & 0x07 & data->has_fan) { 1278 dev_dbg(&pdev->dev, 1279 "Setting fan1-3 to 16-bit mode\n"); 1280 it87_write_value(data, IT87_REG_FAN_16BIT, 1281 tmp | 0x07); 1282 } 1283 if (tmp & (1 << 4)) 1284 data->has_fan |= (1 << 3); /* fan4 enabled */ 1285 if (tmp & (1 << 5)) 1286 data->has_fan |= (1 << 4); /* fan5 enabled */ 1287 } 1288 1289 /* Set current fan mode registers and the default settings for the 1290 * other mode registers */ 1291 for (i = 0; i < 3; i++) { 1292 if (data->fan_main_ctrl & (1 << i)) { 1293 /* pwm mode */ 1294 tmp = it87_read_value(data, IT87_REG_PWM(i)); 1295 if (tmp & 0x80) { 1296 /* automatic pwm - not yet implemented, but 1297 * leave the settings made by the BIOS alone 1298 * until a change is requested via the sysfs 1299 * interface */ 1300 } else { 1301 /* manual pwm */ 1302 data->manual_pwm_ctl[i] = PWM_FROM_REG(tmp); 1303 } 1304 } 1305 } 1306 1307 /* Start monitoring */ 1308 it87_write_value(data, IT87_REG_CONFIG, 1309 (it87_read_value(data, IT87_REG_CONFIG) & 0x36) 1310 | (update_vbat ? 0x41 : 0x01)); 1311 } 1312 1313 static struct it87_data *it87_update_device(struct device *dev) 1314 { 1315 struct it87_data *data = dev_get_drvdata(dev); 1316 int i; 1317 1318 mutex_lock(&data->update_lock); 1319 1320 if (time_after(jiffies, data->last_updated + HZ + HZ / 2) 1321 || !data->valid) { 1322 1323 if (update_vbat) { 1324 /* Cleared after each update, so reenable. Value 1325 returned by this read will be previous value */ 1326 it87_write_value(data, IT87_REG_CONFIG, 1327 it87_read_value(data, IT87_REG_CONFIG) | 0x40); 1328 } 1329 for (i = 0; i <= 7; i++) { 1330 data->in[i] = 1331 it87_read_value(data, IT87_REG_VIN(i)); 1332 data->in_min[i] = 1333 it87_read_value(data, IT87_REG_VIN_MIN(i)); 1334 data->in_max[i] = 1335 it87_read_value(data, IT87_REG_VIN_MAX(i)); 1336 } 1337 /* in8 (battery) has no limit registers */ 1338 data->in[8] = 1339 it87_read_value(data, IT87_REG_VIN(8)); 1340 1341 for (i = 0; i < 5; i++) { 1342 /* Skip disabled fans */ 1343 if (!(data->has_fan & (1 << i))) 1344 continue; 1345 1346 data->fan_min[i] = 1347 it87_read_value(data, IT87_REG_FAN_MIN[i]); 1348 data->fan[i] = it87_read_value(data, 1349 IT87_REG_FAN[i]); 1350 /* Add high byte if in 16-bit mode */ 1351 if (data->type == it8716 || data->type == it8718) { 1352 data->fan[i] |= it87_read_value(data, 1353 IT87_REG_FANX[i]) << 8; 1354 data->fan_min[i] |= it87_read_value(data, 1355 IT87_REG_FANX_MIN[i]) << 8; 1356 } 1357 } 1358 for (i = 0; i < 3; i++) { 1359 data->temp[i] = 1360 it87_read_value(data, IT87_REG_TEMP(i)); 1361 data->temp_high[i] = 1362 it87_read_value(data, IT87_REG_TEMP_HIGH(i)); 1363 data->temp_low[i] = 1364 it87_read_value(data, IT87_REG_TEMP_LOW(i)); 1365 } 1366 1367 /* Newer chips don't have clock dividers */ 1368 if ((data->has_fan & 0x07) && data->type != it8716 1369 && data->type != it8718) { 1370 i = it87_read_value(data, IT87_REG_FAN_DIV); 1371 data->fan_div[0] = i & 0x07; 1372 data->fan_div[1] = (i >> 3) & 0x07; 1373 data->fan_div[2] = (i & 0x40) ? 3 : 1; 1374 } 1375 1376 data->alarms = 1377 it87_read_value(data, IT87_REG_ALARM1) | 1378 (it87_read_value(data, IT87_REG_ALARM2) << 8) | 1379 (it87_read_value(data, IT87_REG_ALARM3) << 16); 1380 data->fan_main_ctrl = it87_read_value(data, 1381 IT87_REG_FAN_MAIN_CTRL); 1382 data->fan_ctl = it87_read_value(data, IT87_REG_FAN_CTL); 1383 1384 data->sensor = it87_read_value(data, IT87_REG_TEMP_ENABLE); 1385 /* The 8705 does not have VID capability */ 1386 if (data->type == it8712 || data->type == it8716) { 1387 data->vid = it87_read_value(data, IT87_REG_VID); 1388 /* The older IT8712F revisions had only 5 VID pins, 1389 but we assume it is always safe to read 6 bits. */ 1390 data->vid &= 0x3f; 1391 } 1392 data->last_updated = jiffies; 1393 data->valid = 1; 1394 } 1395 1396 mutex_unlock(&data->update_lock); 1397 1398 return data; 1399 } 1400 1401 static int __init it87_device_add(unsigned short address, 1402 const struct it87_sio_data *sio_data) 1403 { 1404 struct resource res = { 1405 .start = address , 1406 .end = address + IT87_EXTENT - 1, 1407 .name = DRVNAME, 1408 .flags = IORESOURCE_IO, 1409 }; 1410 int err; 1411 1412 pdev = platform_device_alloc(DRVNAME, address); 1413 if (!pdev) { 1414 err = -ENOMEM; 1415 printk(KERN_ERR DRVNAME ": Device allocation failed\n"); 1416 goto exit; 1417 } 1418 1419 err = platform_device_add_resources(pdev, &res, 1); 1420 if (err) { 1421 printk(KERN_ERR DRVNAME ": Device resource addition failed " 1422 "(%d)\n", err); 1423 goto exit_device_put; 1424 } 1425 1426 err = platform_device_add_data(pdev, sio_data, 1427 sizeof(struct it87_sio_data)); 1428 if (err) { 1429 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n"); 1430 goto exit_device_put; 1431 } 1432 1433 err = platform_device_add(pdev); 1434 if (err) { 1435 printk(KERN_ERR DRVNAME ": Device addition failed (%d)\n", 1436 err); 1437 goto exit_device_put; 1438 } 1439 1440 return 0; 1441 1442 exit_device_put: 1443 platform_device_put(pdev); 1444 exit: 1445 return err; 1446 } 1447 1448 static int __init sm_it87_init(void) 1449 { 1450 int err; 1451 unsigned short isa_address=0; 1452 struct it87_sio_data sio_data; 1453 1454 err = it87_find(&isa_address, &sio_data); 1455 if (err) 1456 return err; 1457 err = platform_driver_register(&it87_driver); 1458 if (err) 1459 return err; 1460 1461 err = it87_device_add(isa_address, &sio_data); 1462 if (err){ 1463 platform_driver_unregister(&it87_driver); 1464 return err; 1465 } 1466 1467 return 0; 1468 } 1469 1470 static void __exit sm_it87_exit(void) 1471 { 1472 platform_device_unregister(pdev); 1473 platform_driver_unregister(&it87_driver); 1474 } 1475 1476 1477 MODULE_AUTHOR("Chris Gauthron <chrisg@0-in.com>, " 1478 "Jean Delvare <khali@linux-fr.org>"); 1479 MODULE_DESCRIPTION("IT8705F/8712F/8716F/8718F/8726F, SiS950 driver"); 1480 module_param(update_vbat, bool, 0); 1481 MODULE_PARM_DESC(update_vbat, "Update vbat if set else return powerup value"); 1482 module_param(fix_pwm_polarity, bool, 0); 1483 MODULE_PARM_DESC(fix_pwm_polarity, "Force PWM polarity to active high (DANGEROUS)"); 1484 MODULE_LICENSE("GPL"); 1485 1486 module_init(sm_it87_init); 1487 module_exit(sm_it87_exit); 1488