1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * pc87427.c - hardware monitoring driver for the 4 * National Semiconductor PC87427 Super-I/O chip 5 * Copyright (C) 2006, 2008, 2010 Jean Delvare <jdelvare@suse.de> 6 * 7 * Supports the following chips: 8 * 9 * Chip #vin #fan #pwm #temp devid 10 * PC87427 - 8 4 6 0xF2 11 * 12 * This driver assumes that no more than one chip is present. 13 * Only fans are fully supported so far. Temperatures are in read-only 14 * mode, and voltages aren't supported at all. 15 */ 16 17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 18 19 #include <linux/module.h> 20 #include <linux/init.h> 21 #include <linux/slab.h> 22 #include <linux/jiffies.h> 23 #include <linux/platform_device.h> 24 #include <linux/hwmon.h> 25 #include <linux/hwmon-sysfs.h> 26 #include <linux/err.h> 27 #include <linux/mutex.h> 28 #include <linux/sysfs.h> 29 #include <linux/ioport.h> 30 #include <linux/acpi.h> 31 #include <linux/io.h> 32 33 static unsigned short force_id; 34 module_param(force_id, ushort, 0); 35 MODULE_PARM_DESC(force_id, "Override the detected device ID"); 36 37 static struct platform_device *pdev; 38 39 #define DRVNAME "pc87427" 40 41 /* 42 * The lock mutex protects both the I/O accesses (needed because the 43 * device is using banked registers) and the register cache (needed to keep 44 * the data in the registers and the cache in sync at any time). 45 */ 46 struct pc87427_data { 47 struct device *hwmon_dev; 48 struct mutex lock; 49 int address[2]; 50 const char *name; 51 52 unsigned long last_updated; /* in jiffies */ 53 u8 fan_enabled; /* bit vector */ 54 u16 fan[8]; /* register values */ 55 u16 fan_min[8]; /* register values */ 56 u8 fan_status[8]; /* register values */ 57 58 u8 pwm_enabled; /* bit vector */ 59 u8 pwm_auto_ok; /* bit vector */ 60 u8 pwm_enable[4]; /* register values */ 61 u8 pwm[4]; /* register values */ 62 63 u8 temp_enabled; /* bit vector */ 64 s16 temp[6]; /* register values */ 65 s8 temp_min[6]; /* register values */ 66 s8 temp_max[6]; /* register values */ 67 s8 temp_crit[6]; /* register values */ 68 u8 temp_status[6]; /* register values */ 69 u8 temp_type[6]; /* register values */ 70 }; 71 72 struct pc87427_sio_data { 73 unsigned short address[2]; 74 u8 has_fanin; 75 u8 has_fanout; 76 }; 77 78 /* 79 * Super-I/O registers and operations 80 */ 81 82 #define SIOREG_LDSEL 0x07 /* Logical device select */ 83 #define SIOREG_DEVID 0x20 /* Device ID */ 84 #define SIOREG_CF2 0x22 /* Configuration 2 */ 85 #define SIOREG_CF3 0x23 /* Configuration 3 */ 86 #define SIOREG_CF4 0x24 /* Configuration 4 */ 87 #define SIOREG_CF5 0x25 /* Configuration 5 */ 88 #define SIOREG_CFB 0x2B /* Configuration B */ 89 #define SIOREG_CFC 0x2C /* Configuration C */ 90 #define SIOREG_CFD 0x2D /* Configuration D */ 91 #define SIOREG_ACT 0x30 /* Device activation */ 92 #define SIOREG_MAP 0x50 /* I/O or memory mapping */ 93 #define SIOREG_IOBASE 0x60 /* I/O base address */ 94 95 static const u8 logdev[2] = { 0x09, 0x14 }; 96 static const char *logdev_str[2] = { DRVNAME " FMC", DRVNAME " HMC" }; 97 #define LD_FAN 0 98 #define LD_IN 1 99 #define LD_TEMP 1 100 101 static inline int superio_enter(int sioaddr) 102 { 103 if (!request_muxed_region(sioaddr, 2, DRVNAME)) 104 return -EBUSY; 105 return 0; 106 } 107 108 static inline void superio_outb(int sioaddr, int reg, int val) 109 { 110 outb(reg, sioaddr); 111 outb(val, sioaddr + 1); 112 } 113 114 static inline int superio_inb(int sioaddr, int reg) 115 { 116 outb(reg, sioaddr); 117 return inb(sioaddr + 1); 118 } 119 120 static inline void superio_exit(int sioaddr) 121 { 122 outb(0x02, sioaddr); 123 outb(0x02, sioaddr + 1); 124 release_region(sioaddr, 2); 125 } 126 127 /* 128 * Logical devices 129 */ 130 131 #define REGION_LENGTH 32 132 #define PC87427_REG_BANK 0x0f 133 #define BANK_FM(nr) (nr) 134 #define BANK_FT(nr) (0x08 + (nr)) 135 #define BANK_FC(nr) (0x10 + (nr) * 2) 136 #define BANK_TM(nr) (nr) 137 #define BANK_VM(nr) (0x08 + (nr)) 138 139 /* 140 * I/O access functions 141 */ 142 143 /* ldi is the logical device index */ 144 static inline int pc87427_read8(struct pc87427_data *data, u8 ldi, u8 reg) 145 { 146 return inb(data->address[ldi] + reg); 147 } 148 149 /* Must be called with data->lock held, except during init */ 150 static inline int pc87427_read8_bank(struct pc87427_data *data, u8 ldi, 151 u8 bank, u8 reg) 152 { 153 outb(bank, data->address[ldi] + PC87427_REG_BANK); 154 return inb(data->address[ldi] + reg); 155 } 156 157 /* Must be called with data->lock held, except during init */ 158 static inline void pc87427_write8_bank(struct pc87427_data *data, u8 ldi, 159 u8 bank, u8 reg, u8 value) 160 { 161 outb(bank, data->address[ldi] + PC87427_REG_BANK); 162 outb(value, data->address[ldi] + reg); 163 } 164 165 /* 166 * Fan registers and conversions 167 */ 168 169 /* fan data registers are 16-bit wide */ 170 #define PC87427_REG_FAN 0x12 171 #define PC87427_REG_FAN_MIN 0x14 172 #define PC87427_REG_FAN_STATUS 0x10 173 174 #define FAN_STATUS_STALL (1 << 3) 175 #define FAN_STATUS_LOSPD (1 << 1) 176 #define FAN_STATUS_MONEN (1 << 0) 177 178 /* 179 * Dedicated function to read all registers related to a given fan input. 180 * This saves us quite a few locks and bank selections. 181 * Must be called with data->lock held. 182 * nr is from 0 to 7 183 */ 184 static void pc87427_readall_fan(struct pc87427_data *data, u8 nr) 185 { 186 int iobase = data->address[LD_FAN]; 187 188 outb(BANK_FM(nr), iobase + PC87427_REG_BANK); 189 data->fan[nr] = inw(iobase + PC87427_REG_FAN); 190 data->fan_min[nr] = inw(iobase + PC87427_REG_FAN_MIN); 191 data->fan_status[nr] = inb(iobase + PC87427_REG_FAN_STATUS); 192 /* Clear fan alarm bits */ 193 outb(data->fan_status[nr], iobase + PC87427_REG_FAN_STATUS); 194 } 195 196 /* 197 * The 2 LSB of fan speed registers are used for something different. 198 * The actual 2 LSB of the measurements are not available. 199 */ 200 static inline unsigned long fan_from_reg(u16 reg) 201 { 202 reg &= 0xfffc; 203 if (reg == 0x0000 || reg == 0xfffc) 204 return 0; 205 return 5400000UL / reg; 206 } 207 208 /* The 2 LSB of the fan speed limit registers are not significant. */ 209 static inline u16 fan_to_reg(unsigned long val) 210 { 211 if (val < 83UL) 212 return 0xffff; 213 if (val >= 1350000UL) 214 return 0x0004; 215 return ((1350000UL + val / 2) / val) << 2; 216 } 217 218 /* 219 * PWM registers and conversions 220 */ 221 222 #define PC87427_REG_PWM_ENABLE 0x10 223 #define PC87427_REG_PWM_DUTY 0x12 224 225 #define PWM_ENABLE_MODE_MASK (7 << 4) 226 #define PWM_ENABLE_CTLEN (1 << 0) 227 228 #define PWM_MODE_MANUAL (0 << 4) 229 #define PWM_MODE_AUTO (1 << 4) 230 #define PWM_MODE_OFF (2 << 4) 231 #define PWM_MODE_ON (7 << 4) 232 233 /* 234 * Dedicated function to read all registers related to a given PWM output. 235 * This saves us quite a few locks and bank selections. 236 * Must be called with data->lock held. 237 * nr is from 0 to 3 238 */ 239 static void pc87427_readall_pwm(struct pc87427_data *data, u8 nr) 240 { 241 int iobase = data->address[LD_FAN]; 242 243 outb(BANK_FC(nr), iobase + PC87427_REG_BANK); 244 data->pwm_enable[nr] = inb(iobase + PC87427_REG_PWM_ENABLE); 245 data->pwm[nr] = inb(iobase + PC87427_REG_PWM_DUTY); 246 } 247 248 static inline int pwm_enable_from_reg(u8 reg) 249 { 250 switch (reg & PWM_ENABLE_MODE_MASK) { 251 case PWM_MODE_ON: 252 return 0; 253 case PWM_MODE_MANUAL: 254 case PWM_MODE_OFF: 255 return 1; 256 case PWM_MODE_AUTO: 257 return 2; 258 default: 259 return -EPROTO; 260 } 261 } 262 263 static inline u8 pwm_enable_to_reg(unsigned long val, u8 pwmval) 264 { 265 switch (val) { 266 default: 267 return PWM_MODE_ON; 268 case 1: 269 return pwmval ? PWM_MODE_MANUAL : PWM_MODE_OFF; 270 case 2: 271 return PWM_MODE_AUTO; 272 } 273 } 274 275 /* 276 * Temperature registers and conversions 277 */ 278 279 #define PC87427_REG_TEMP_STATUS 0x10 280 #define PC87427_REG_TEMP 0x14 281 #define PC87427_REG_TEMP_MAX 0x18 282 #define PC87427_REG_TEMP_MIN 0x19 283 #define PC87427_REG_TEMP_CRIT 0x1a 284 #define PC87427_REG_TEMP_TYPE 0x1d 285 286 #define TEMP_STATUS_CHANEN (1 << 0) 287 #define TEMP_STATUS_LOWFLG (1 << 1) 288 #define TEMP_STATUS_HIGHFLG (1 << 2) 289 #define TEMP_STATUS_CRITFLG (1 << 3) 290 #define TEMP_STATUS_SENSERR (1 << 5) 291 #define TEMP_TYPE_MASK (3 << 5) 292 293 #define TEMP_TYPE_THERMISTOR (1 << 5) 294 #define TEMP_TYPE_REMOTE_DIODE (2 << 5) 295 #define TEMP_TYPE_LOCAL_DIODE (3 << 5) 296 297 /* 298 * Dedicated function to read all registers related to a given temperature 299 * input. This saves us quite a few locks and bank selections. 300 * Must be called with data->lock held. 301 * nr is from 0 to 5 302 */ 303 static void pc87427_readall_temp(struct pc87427_data *data, u8 nr) 304 { 305 int iobase = data->address[LD_TEMP]; 306 307 outb(BANK_TM(nr), iobase + PC87427_REG_BANK); 308 data->temp[nr] = le16_to_cpu(inw(iobase + PC87427_REG_TEMP)); 309 data->temp_max[nr] = inb(iobase + PC87427_REG_TEMP_MAX); 310 data->temp_min[nr] = inb(iobase + PC87427_REG_TEMP_MIN); 311 data->temp_crit[nr] = inb(iobase + PC87427_REG_TEMP_CRIT); 312 data->temp_type[nr] = inb(iobase + PC87427_REG_TEMP_TYPE); 313 data->temp_status[nr] = inb(iobase + PC87427_REG_TEMP_STATUS); 314 /* Clear fan alarm bits */ 315 outb(data->temp_status[nr], iobase + PC87427_REG_TEMP_STATUS); 316 } 317 318 static inline unsigned int temp_type_from_reg(u8 reg) 319 { 320 switch (reg & TEMP_TYPE_MASK) { 321 case TEMP_TYPE_THERMISTOR: 322 return 4; 323 case TEMP_TYPE_REMOTE_DIODE: 324 case TEMP_TYPE_LOCAL_DIODE: 325 return 3; 326 default: 327 return 0; 328 } 329 } 330 331 /* 332 * We assume 8-bit thermal sensors; 9-bit thermal sensors are possible 333 * too, but I have no idea how to figure out when they are used. 334 */ 335 static inline long temp_from_reg(s16 reg) 336 { 337 return reg * 1000 / 256; 338 } 339 340 static inline long temp_from_reg8(s8 reg) 341 { 342 return reg * 1000; 343 } 344 345 /* 346 * Data interface 347 */ 348 349 static struct pc87427_data *pc87427_update_device(struct device *dev) 350 { 351 struct pc87427_data *data = dev_get_drvdata(dev); 352 int i; 353 354 mutex_lock(&data->lock); 355 if (!time_after(jiffies, data->last_updated + HZ) 356 && data->last_updated) 357 goto done; 358 359 /* Fans */ 360 for (i = 0; i < 8; i++) { 361 if (!(data->fan_enabled & (1 << i))) 362 continue; 363 pc87427_readall_fan(data, i); 364 } 365 366 /* PWM outputs */ 367 for (i = 0; i < 4; i++) { 368 if (!(data->pwm_enabled & (1 << i))) 369 continue; 370 pc87427_readall_pwm(data, i); 371 } 372 373 /* Temperature channels */ 374 for (i = 0; i < 6; i++) { 375 if (!(data->temp_enabled & (1 << i))) 376 continue; 377 pc87427_readall_temp(data, i); 378 } 379 380 data->last_updated = jiffies; 381 382 done: 383 mutex_unlock(&data->lock); 384 return data; 385 } 386 387 static ssize_t fan_input_show(struct device *dev, 388 struct device_attribute *devattr, char *buf) 389 { 390 struct pc87427_data *data = pc87427_update_device(dev); 391 int nr = to_sensor_dev_attr(devattr)->index; 392 393 return sprintf(buf, "%lu\n", fan_from_reg(data->fan[nr])); 394 } 395 396 static ssize_t fan_min_show(struct device *dev, 397 struct device_attribute *devattr, char *buf) 398 { 399 struct pc87427_data *data = pc87427_update_device(dev); 400 int nr = to_sensor_dev_attr(devattr)->index; 401 402 return sprintf(buf, "%lu\n", fan_from_reg(data->fan_min[nr])); 403 } 404 405 static ssize_t fan_alarm_show(struct device *dev, 406 struct device_attribute *devattr, char *buf) 407 { 408 struct pc87427_data *data = pc87427_update_device(dev); 409 int nr = to_sensor_dev_attr(devattr)->index; 410 411 return sprintf(buf, "%d\n", !!(data->fan_status[nr] 412 & FAN_STATUS_LOSPD)); 413 } 414 415 static ssize_t fan_fault_show(struct device *dev, 416 struct device_attribute *devattr, char *buf) 417 { 418 struct pc87427_data *data = pc87427_update_device(dev); 419 int nr = to_sensor_dev_attr(devattr)->index; 420 421 return sprintf(buf, "%d\n", !!(data->fan_status[nr] 422 & FAN_STATUS_STALL)); 423 } 424 425 static ssize_t fan_min_store(struct device *dev, 426 struct device_attribute *devattr, 427 const char *buf, size_t count) 428 { 429 struct pc87427_data *data = dev_get_drvdata(dev); 430 int nr = to_sensor_dev_attr(devattr)->index; 431 unsigned long val; 432 int iobase = data->address[LD_FAN]; 433 434 if (kstrtoul(buf, 10, &val) < 0) 435 return -EINVAL; 436 437 mutex_lock(&data->lock); 438 outb(BANK_FM(nr), iobase + PC87427_REG_BANK); 439 /* 440 * The low speed limit registers are read-only while monitoring 441 * is enabled, so we have to disable monitoring, then change the 442 * limit, and finally enable monitoring again. 443 */ 444 outb(0, iobase + PC87427_REG_FAN_STATUS); 445 data->fan_min[nr] = fan_to_reg(val); 446 outw(data->fan_min[nr], iobase + PC87427_REG_FAN_MIN); 447 outb(FAN_STATUS_MONEN, iobase + PC87427_REG_FAN_STATUS); 448 mutex_unlock(&data->lock); 449 450 return count; 451 } 452 453 static SENSOR_DEVICE_ATTR_RO(fan1_input, fan_input, 0); 454 static SENSOR_DEVICE_ATTR_RO(fan2_input, fan_input, 1); 455 static SENSOR_DEVICE_ATTR_RO(fan3_input, fan_input, 2); 456 static SENSOR_DEVICE_ATTR_RO(fan4_input, fan_input, 3); 457 static SENSOR_DEVICE_ATTR_RO(fan5_input, fan_input, 4); 458 static SENSOR_DEVICE_ATTR_RO(fan6_input, fan_input, 5); 459 static SENSOR_DEVICE_ATTR_RO(fan7_input, fan_input, 6); 460 static SENSOR_DEVICE_ATTR_RO(fan8_input, fan_input, 7); 461 462 static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0); 463 static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1); 464 static SENSOR_DEVICE_ATTR_RW(fan3_min, fan_min, 2); 465 static SENSOR_DEVICE_ATTR_RW(fan4_min, fan_min, 3); 466 static SENSOR_DEVICE_ATTR_RW(fan5_min, fan_min, 4); 467 static SENSOR_DEVICE_ATTR_RW(fan6_min, fan_min, 5); 468 static SENSOR_DEVICE_ATTR_RW(fan7_min, fan_min, 6); 469 static SENSOR_DEVICE_ATTR_RW(fan8_min, fan_min, 7); 470 471 static SENSOR_DEVICE_ATTR_RO(fan1_alarm, fan_alarm, 0); 472 static SENSOR_DEVICE_ATTR_RO(fan2_alarm, fan_alarm, 1); 473 static SENSOR_DEVICE_ATTR_RO(fan3_alarm, fan_alarm, 2); 474 static SENSOR_DEVICE_ATTR_RO(fan4_alarm, fan_alarm, 3); 475 static SENSOR_DEVICE_ATTR_RO(fan5_alarm, fan_alarm, 4); 476 static SENSOR_DEVICE_ATTR_RO(fan6_alarm, fan_alarm, 5); 477 static SENSOR_DEVICE_ATTR_RO(fan7_alarm, fan_alarm, 6); 478 static SENSOR_DEVICE_ATTR_RO(fan8_alarm, fan_alarm, 7); 479 480 static SENSOR_DEVICE_ATTR_RO(fan1_fault, fan_fault, 0); 481 static SENSOR_DEVICE_ATTR_RO(fan2_fault, fan_fault, 1); 482 static SENSOR_DEVICE_ATTR_RO(fan3_fault, fan_fault, 2); 483 static SENSOR_DEVICE_ATTR_RO(fan4_fault, fan_fault, 3); 484 static SENSOR_DEVICE_ATTR_RO(fan5_fault, fan_fault, 4); 485 static SENSOR_DEVICE_ATTR_RO(fan6_fault, fan_fault, 5); 486 static SENSOR_DEVICE_ATTR_RO(fan7_fault, fan_fault, 6); 487 static SENSOR_DEVICE_ATTR_RO(fan8_fault, fan_fault, 7); 488 489 static struct attribute *pc87427_attributes_fan[8][5] = { 490 { 491 &sensor_dev_attr_fan1_input.dev_attr.attr, 492 &sensor_dev_attr_fan1_min.dev_attr.attr, 493 &sensor_dev_attr_fan1_alarm.dev_attr.attr, 494 &sensor_dev_attr_fan1_fault.dev_attr.attr, 495 NULL 496 }, { 497 &sensor_dev_attr_fan2_input.dev_attr.attr, 498 &sensor_dev_attr_fan2_min.dev_attr.attr, 499 &sensor_dev_attr_fan2_alarm.dev_attr.attr, 500 &sensor_dev_attr_fan2_fault.dev_attr.attr, 501 NULL 502 }, { 503 &sensor_dev_attr_fan3_input.dev_attr.attr, 504 &sensor_dev_attr_fan3_min.dev_attr.attr, 505 &sensor_dev_attr_fan3_alarm.dev_attr.attr, 506 &sensor_dev_attr_fan3_fault.dev_attr.attr, 507 NULL 508 }, { 509 &sensor_dev_attr_fan4_input.dev_attr.attr, 510 &sensor_dev_attr_fan4_min.dev_attr.attr, 511 &sensor_dev_attr_fan4_alarm.dev_attr.attr, 512 &sensor_dev_attr_fan4_fault.dev_attr.attr, 513 NULL 514 }, { 515 &sensor_dev_attr_fan5_input.dev_attr.attr, 516 &sensor_dev_attr_fan5_min.dev_attr.attr, 517 &sensor_dev_attr_fan5_alarm.dev_attr.attr, 518 &sensor_dev_attr_fan5_fault.dev_attr.attr, 519 NULL 520 }, { 521 &sensor_dev_attr_fan6_input.dev_attr.attr, 522 &sensor_dev_attr_fan6_min.dev_attr.attr, 523 &sensor_dev_attr_fan6_alarm.dev_attr.attr, 524 &sensor_dev_attr_fan6_fault.dev_attr.attr, 525 NULL 526 }, { 527 &sensor_dev_attr_fan7_input.dev_attr.attr, 528 &sensor_dev_attr_fan7_min.dev_attr.attr, 529 &sensor_dev_attr_fan7_alarm.dev_attr.attr, 530 &sensor_dev_attr_fan7_fault.dev_attr.attr, 531 NULL 532 }, { 533 &sensor_dev_attr_fan8_input.dev_attr.attr, 534 &sensor_dev_attr_fan8_min.dev_attr.attr, 535 &sensor_dev_attr_fan8_alarm.dev_attr.attr, 536 &sensor_dev_attr_fan8_fault.dev_attr.attr, 537 NULL 538 } 539 }; 540 541 static const struct attribute_group pc87427_group_fan[8] = { 542 { .attrs = pc87427_attributes_fan[0] }, 543 { .attrs = pc87427_attributes_fan[1] }, 544 { .attrs = pc87427_attributes_fan[2] }, 545 { .attrs = pc87427_attributes_fan[3] }, 546 { .attrs = pc87427_attributes_fan[4] }, 547 { .attrs = pc87427_attributes_fan[5] }, 548 { .attrs = pc87427_attributes_fan[6] }, 549 { .attrs = pc87427_attributes_fan[7] }, 550 }; 551 552 /* 553 * Must be called with data->lock held and pc87427_readall_pwm() freshly 554 * called 555 */ 556 static void update_pwm_enable(struct pc87427_data *data, int nr, u8 mode) 557 { 558 int iobase = data->address[LD_FAN]; 559 data->pwm_enable[nr] &= ~PWM_ENABLE_MODE_MASK; 560 data->pwm_enable[nr] |= mode; 561 outb(data->pwm_enable[nr], iobase + PC87427_REG_PWM_ENABLE); 562 } 563 564 static ssize_t pwm_enable_show(struct device *dev, 565 struct device_attribute *devattr, char *buf) 566 { 567 struct pc87427_data *data = pc87427_update_device(dev); 568 int nr = to_sensor_dev_attr(devattr)->index; 569 int pwm_enable; 570 571 pwm_enable = pwm_enable_from_reg(data->pwm_enable[nr]); 572 if (pwm_enable < 0) 573 return pwm_enable; 574 return sprintf(buf, "%d\n", pwm_enable); 575 } 576 577 static ssize_t pwm_enable_store(struct device *dev, 578 struct device_attribute *devattr, 579 const char *buf, size_t count) 580 { 581 struct pc87427_data *data = dev_get_drvdata(dev); 582 int nr = to_sensor_dev_attr(devattr)->index; 583 unsigned long val; 584 585 if (kstrtoul(buf, 10, &val) < 0 || val > 2) 586 return -EINVAL; 587 /* Can't go to automatic mode if it isn't configured */ 588 if (val == 2 && !(data->pwm_auto_ok & (1 << nr))) 589 return -EINVAL; 590 591 mutex_lock(&data->lock); 592 pc87427_readall_pwm(data, nr); 593 update_pwm_enable(data, nr, pwm_enable_to_reg(val, data->pwm[nr])); 594 mutex_unlock(&data->lock); 595 596 return count; 597 } 598 599 static ssize_t pwm_show(struct device *dev, struct device_attribute *devattr, 600 char *buf) 601 { 602 struct pc87427_data *data = pc87427_update_device(dev); 603 int nr = to_sensor_dev_attr(devattr)->index; 604 605 return sprintf(buf, "%d\n", (int)data->pwm[nr]); 606 } 607 608 static ssize_t pwm_store(struct device *dev, struct device_attribute *devattr, 609 const char *buf, size_t count) 610 { 611 struct pc87427_data *data = dev_get_drvdata(dev); 612 int nr = to_sensor_dev_attr(devattr)->index; 613 unsigned long val; 614 int iobase = data->address[LD_FAN]; 615 u8 mode; 616 617 if (kstrtoul(buf, 10, &val) < 0 || val > 0xff) 618 return -EINVAL; 619 620 mutex_lock(&data->lock); 621 pc87427_readall_pwm(data, nr); 622 mode = data->pwm_enable[nr] & PWM_ENABLE_MODE_MASK; 623 if (mode != PWM_MODE_MANUAL && mode != PWM_MODE_OFF) { 624 dev_notice(dev, 625 "Can't set PWM%d duty cycle while not in manual mode\n", 626 nr + 1); 627 mutex_unlock(&data->lock); 628 return -EPERM; 629 } 630 631 /* We may have to change the mode */ 632 if (mode == PWM_MODE_MANUAL && val == 0) { 633 /* Transition from Manual to Off */ 634 update_pwm_enable(data, nr, PWM_MODE_OFF); 635 mode = PWM_MODE_OFF; 636 dev_dbg(dev, "Switching PWM%d from %s to %s\n", nr + 1, 637 "manual", "off"); 638 } else if (mode == PWM_MODE_OFF && val != 0) { 639 /* Transition from Off to Manual */ 640 update_pwm_enable(data, nr, PWM_MODE_MANUAL); 641 mode = PWM_MODE_MANUAL; 642 dev_dbg(dev, "Switching PWM%d from %s to %s\n", nr + 1, 643 "off", "manual"); 644 } 645 646 data->pwm[nr] = val; 647 if (mode == PWM_MODE_MANUAL) 648 outb(val, iobase + PC87427_REG_PWM_DUTY); 649 mutex_unlock(&data->lock); 650 651 return count; 652 } 653 654 static SENSOR_DEVICE_ATTR_RW(pwm1_enable, pwm_enable, 0); 655 static SENSOR_DEVICE_ATTR_RW(pwm2_enable, pwm_enable, 1); 656 static SENSOR_DEVICE_ATTR_RW(pwm3_enable, pwm_enable, 2); 657 static SENSOR_DEVICE_ATTR_RW(pwm4_enable, pwm_enable, 3); 658 659 static SENSOR_DEVICE_ATTR_RW(pwm1, pwm, 0); 660 static SENSOR_DEVICE_ATTR_RW(pwm2, pwm, 1); 661 static SENSOR_DEVICE_ATTR_RW(pwm3, pwm, 2); 662 static SENSOR_DEVICE_ATTR_RW(pwm4, pwm, 3); 663 664 static struct attribute *pc87427_attributes_pwm[4][3] = { 665 { 666 &sensor_dev_attr_pwm1_enable.dev_attr.attr, 667 &sensor_dev_attr_pwm1.dev_attr.attr, 668 NULL 669 }, { 670 &sensor_dev_attr_pwm2_enable.dev_attr.attr, 671 &sensor_dev_attr_pwm2.dev_attr.attr, 672 NULL 673 }, { 674 &sensor_dev_attr_pwm3_enable.dev_attr.attr, 675 &sensor_dev_attr_pwm3.dev_attr.attr, 676 NULL 677 }, { 678 &sensor_dev_attr_pwm4_enable.dev_attr.attr, 679 &sensor_dev_attr_pwm4.dev_attr.attr, 680 NULL 681 } 682 }; 683 684 static const struct attribute_group pc87427_group_pwm[4] = { 685 { .attrs = pc87427_attributes_pwm[0] }, 686 { .attrs = pc87427_attributes_pwm[1] }, 687 { .attrs = pc87427_attributes_pwm[2] }, 688 { .attrs = pc87427_attributes_pwm[3] }, 689 }; 690 691 static ssize_t temp_input_show(struct device *dev, 692 struct device_attribute *devattr, char *buf) 693 { 694 struct pc87427_data *data = pc87427_update_device(dev); 695 int nr = to_sensor_dev_attr(devattr)->index; 696 697 return sprintf(buf, "%ld\n", temp_from_reg(data->temp[nr])); 698 } 699 700 static ssize_t temp_min_show(struct device *dev, 701 struct device_attribute *devattr, char *buf) 702 { 703 struct pc87427_data *data = pc87427_update_device(dev); 704 int nr = to_sensor_dev_attr(devattr)->index; 705 706 return sprintf(buf, "%ld\n", temp_from_reg8(data->temp_min[nr])); 707 } 708 709 static ssize_t temp_max_show(struct device *dev, 710 struct device_attribute *devattr, char *buf) 711 { 712 struct pc87427_data *data = pc87427_update_device(dev); 713 int nr = to_sensor_dev_attr(devattr)->index; 714 715 return sprintf(buf, "%ld\n", temp_from_reg8(data->temp_max[nr])); 716 } 717 718 static ssize_t temp_crit_show(struct device *dev, 719 struct device_attribute *devattr, char *buf) 720 { 721 struct pc87427_data *data = pc87427_update_device(dev); 722 int nr = to_sensor_dev_attr(devattr)->index; 723 724 return sprintf(buf, "%ld\n", temp_from_reg8(data->temp_crit[nr])); 725 } 726 727 static ssize_t temp_type_show(struct device *dev, 728 struct device_attribute *devattr, char *buf) 729 { 730 struct pc87427_data *data = pc87427_update_device(dev); 731 int nr = to_sensor_dev_attr(devattr)->index; 732 733 return sprintf(buf, "%u\n", temp_type_from_reg(data->temp_type[nr])); 734 } 735 736 static ssize_t temp_min_alarm_show(struct device *dev, 737 struct device_attribute *devattr, 738 char *buf) 739 { 740 struct pc87427_data *data = pc87427_update_device(dev); 741 int nr = to_sensor_dev_attr(devattr)->index; 742 743 return sprintf(buf, "%d\n", !!(data->temp_status[nr] 744 & TEMP_STATUS_LOWFLG)); 745 } 746 747 static ssize_t temp_max_alarm_show(struct device *dev, 748 struct device_attribute *devattr, 749 char *buf) 750 { 751 struct pc87427_data *data = pc87427_update_device(dev); 752 int nr = to_sensor_dev_attr(devattr)->index; 753 754 return sprintf(buf, "%d\n", !!(data->temp_status[nr] 755 & TEMP_STATUS_HIGHFLG)); 756 } 757 758 static ssize_t temp_crit_alarm_show(struct device *dev, 759 struct device_attribute *devattr, 760 char *buf) 761 { 762 struct pc87427_data *data = pc87427_update_device(dev); 763 int nr = to_sensor_dev_attr(devattr)->index; 764 765 return sprintf(buf, "%d\n", !!(data->temp_status[nr] 766 & TEMP_STATUS_CRITFLG)); 767 } 768 769 static ssize_t temp_fault_show(struct device *dev, 770 struct device_attribute *devattr, char *buf) 771 { 772 struct pc87427_data *data = pc87427_update_device(dev); 773 int nr = to_sensor_dev_attr(devattr)->index; 774 775 return sprintf(buf, "%d\n", !!(data->temp_status[nr] 776 & TEMP_STATUS_SENSERR)); 777 } 778 779 static SENSOR_DEVICE_ATTR_RO(temp1_input, temp_input, 0); 780 static SENSOR_DEVICE_ATTR_RO(temp2_input, temp_input, 1); 781 static SENSOR_DEVICE_ATTR_RO(temp3_input, temp_input, 2); 782 static SENSOR_DEVICE_ATTR_RO(temp4_input, temp_input, 3); 783 static SENSOR_DEVICE_ATTR_RO(temp5_input, temp_input, 4); 784 static SENSOR_DEVICE_ATTR_RO(temp6_input, temp_input, 5); 785 786 static SENSOR_DEVICE_ATTR_RO(temp1_min, temp_min, 0); 787 static SENSOR_DEVICE_ATTR_RO(temp2_min, temp_min, 1); 788 static SENSOR_DEVICE_ATTR_RO(temp3_min, temp_min, 2); 789 static SENSOR_DEVICE_ATTR_RO(temp4_min, temp_min, 3); 790 static SENSOR_DEVICE_ATTR_RO(temp5_min, temp_min, 4); 791 static SENSOR_DEVICE_ATTR_RO(temp6_min, temp_min, 5); 792 793 static SENSOR_DEVICE_ATTR_RO(temp1_max, temp_max, 0); 794 static SENSOR_DEVICE_ATTR_RO(temp2_max, temp_max, 1); 795 static SENSOR_DEVICE_ATTR_RO(temp3_max, temp_max, 2); 796 static SENSOR_DEVICE_ATTR_RO(temp4_max, temp_max, 3); 797 static SENSOR_DEVICE_ATTR_RO(temp5_max, temp_max, 4); 798 static SENSOR_DEVICE_ATTR_RO(temp6_max, temp_max, 5); 799 800 static SENSOR_DEVICE_ATTR_RO(temp1_crit, temp_crit, 0); 801 static SENSOR_DEVICE_ATTR_RO(temp2_crit, temp_crit, 1); 802 static SENSOR_DEVICE_ATTR_RO(temp3_crit, temp_crit, 2); 803 static SENSOR_DEVICE_ATTR_RO(temp4_crit, temp_crit, 3); 804 static SENSOR_DEVICE_ATTR_RO(temp5_crit, temp_crit, 4); 805 static SENSOR_DEVICE_ATTR_RO(temp6_crit, temp_crit, 5); 806 807 static SENSOR_DEVICE_ATTR_RO(temp1_type, temp_type, 0); 808 static SENSOR_DEVICE_ATTR_RO(temp2_type, temp_type, 1); 809 static SENSOR_DEVICE_ATTR_RO(temp3_type, temp_type, 2); 810 static SENSOR_DEVICE_ATTR_RO(temp4_type, temp_type, 3); 811 static SENSOR_DEVICE_ATTR_RO(temp5_type, temp_type, 4); 812 static SENSOR_DEVICE_ATTR_RO(temp6_type, temp_type, 5); 813 814 static SENSOR_DEVICE_ATTR_RO(temp1_min_alarm, temp_min_alarm, 0); 815 static SENSOR_DEVICE_ATTR_RO(temp2_min_alarm, temp_min_alarm, 1); 816 static SENSOR_DEVICE_ATTR_RO(temp3_min_alarm, temp_min_alarm, 2); 817 static SENSOR_DEVICE_ATTR_RO(temp4_min_alarm, temp_min_alarm, 3); 818 static SENSOR_DEVICE_ATTR_RO(temp5_min_alarm, temp_min_alarm, 4); 819 static SENSOR_DEVICE_ATTR_RO(temp6_min_alarm, temp_min_alarm, 5); 820 821 static SENSOR_DEVICE_ATTR_RO(temp1_max_alarm, temp_max_alarm, 0); 822 static SENSOR_DEVICE_ATTR_RO(temp2_max_alarm, temp_max_alarm, 1); 823 static SENSOR_DEVICE_ATTR_RO(temp3_max_alarm, temp_max_alarm, 2); 824 static SENSOR_DEVICE_ATTR_RO(temp4_max_alarm, temp_max_alarm, 3); 825 static SENSOR_DEVICE_ATTR_RO(temp5_max_alarm, temp_max_alarm, 4); 826 static SENSOR_DEVICE_ATTR_RO(temp6_max_alarm, temp_max_alarm, 5); 827 828 static SENSOR_DEVICE_ATTR_RO(temp1_crit_alarm, temp_crit_alarm, 0); 829 static SENSOR_DEVICE_ATTR_RO(temp2_crit_alarm, temp_crit_alarm, 1); 830 static SENSOR_DEVICE_ATTR_RO(temp3_crit_alarm, temp_crit_alarm, 2); 831 static SENSOR_DEVICE_ATTR_RO(temp4_crit_alarm, temp_crit_alarm, 3); 832 static SENSOR_DEVICE_ATTR_RO(temp5_crit_alarm, temp_crit_alarm, 4); 833 static SENSOR_DEVICE_ATTR_RO(temp6_crit_alarm, temp_crit_alarm, 5); 834 835 static SENSOR_DEVICE_ATTR_RO(temp1_fault, temp_fault, 0); 836 static SENSOR_DEVICE_ATTR_RO(temp2_fault, temp_fault, 1); 837 static SENSOR_DEVICE_ATTR_RO(temp3_fault, temp_fault, 2); 838 static SENSOR_DEVICE_ATTR_RO(temp4_fault, temp_fault, 3); 839 static SENSOR_DEVICE_ATTR_RO(temp5_fault, temp_fault, 4); 840 static SENSOR_DEVICE_ATTR_RO(temp6_fault, temp_fault, 5); 841 842 static struct attribute *pc87427_attributes_temp[6][10] = { 843 { 844 &sensor_dev_attr_temp1_input.dev_attr.attr, 845 &sensor_dev_attr_temp1_min.dev_attr.attr, 846 &sensor_dev_attr_temp1_max.dev_attr.attr, 847 &sensor_dev_attr_temp1_crit.dev_attr.attr, 848 &sensor_dev_attr_temp1_type.dev_attr.attr, 849 &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, 850 &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, 851 &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, 852 &sensor_dev_attr_temp1_fault.dev_attr.attr, 853 NULL 854 }, { 855 &sensor_dev_attr_temp2_input.dev_attr.attr, 856 &sensor_dev_attr_temp2_min.dev_attr.attr, 857 &sensor_dev_attr_temp2_max.dev_attr.attr, 858 &sensor_dev_attr_temp2_crit.dev_attr.attr, 859 &sensor_dev_attr_temp2_type.dev_attr.attr, 860 &sensor_dev_attr_temp2_min_alarm.dev_attr.attr, 861 &sensor_dev_attr_temp2_max_alarm.dev_attr.attr, 862 &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr, 863 &sensor_dev_attr_temp2_fault.dev_attr.attr, 864 NULL 865 }, { 866 &sensor_dev_attr_temp3_input.dev_attr.attr, 867 &sensor_dev_attr_temp3_min.dev_attr.attr, 868 &sensor_dev_attr_temp3_max.dev_attr.attr, 869 &sensor_dev_attr_temp3_crit.dev_attr.attr, 870 &sensor_dev_attr_temp3_type.dev_attr.attr, 871 &sensor_dev_attr_temp3_min_alarm.dev_attr.attr, 872 &sensor_dev_attr_temp3_max_alarm.dev_attr.attr, 873 &sensor_dev_attr_temp3_crit_alarm.dev_attr.attr, 874 &sensor_dev_attr_temp3_fault.dev_attr.attr, 875 NULL 876 }, { 877 &sensor_dev_attr_temp4_input.dev_attr.attr, 878 &sensor_dev_attr_temp4_min.dev_attr.attr, 879 &sensor_dev_attr_temp4_max.dev_attr.attr, 880 &sensor_dev_attr_temp4_crit.dev_attr.attr, 881 &sensor_dev_attr_temp4_type.dev_attr.attr, 882 &sensor_dev_attr_temp4_min_alarm.dev_attr.attr, 883 &sensor_dev_attr_temp4_max_alarm.dev_attr.attr, 884 &sensor_dev_attr_temp4_crit_alarm.dev_attr.attr, 885 &sensor_dev_attr_temp4_fault.dev_attr.attr, 886 NULL 887 }, { 888 &sensor_dev_attr_temp5_input.dev_attr.attr, 889 &sensor_dev_attr_temp5_min.dev_attr.attr, 890 &sensor_dev_attr_temp5_max.dev_attr.attr, 891 &sensor_dev_attr_temp5_crit.dev_attr.attr, 892 &sensor_dev_attr_temp5_type.dev_attr.attr, 893 &sensor_dev_attr_temp5_min_alarm.dev_attr.attr, 894 &sensor_dev_attr_temp5_max_alarm.dev_attr.attr, 895 &sensor_dev_attr_temp5_crit_alarm.dev_attr.attr, 896 &sensor_dev_attr_temp5_fault.dev_attr.attr, 897 NULL 898 }, { 899 &sensor_dev_attr_temp6_input.dev_attr.attr, 900 &sensor_dev_attr_temp6_min.dev_attr.attr, 901 &sensor_dev_attr_temp6_max.dev_attr.attr, 902 &sensor_dev_attr_temp6_crit.dev_attr.attr, 903 &sensor_dev_attr_temp6_type.dev_attr.attr, 904 &sensor_dev_attr_temp6_min_alarm.dev_attr.attr, 905 &sensor_dev_attr_temp6_max_alarm.dev_attr.attr, 906 &sensor_dev_attr_temp6_crit_alarm.dev_attr.attr, 907 &sensor_dev_attr_temp6_fault.dev_attr.attr, 908 NULL 909 } 910 }; 911 912 static const struct attribute_group pc87427_group_temp[6] = { 913 { .attrs = pc87427_attributes_temp[0] }, 914 { .attrs = pc87427_attributes_temp[1] }, 915 { .attrs = pc87427_attributes_temp[2] }, 916 { .attrs = pc87427_attributes_temp[3] }, 917 { .attrs = pc87427_attributes_temp[4] }, 918 { .attrs = pc87427_attributes_temp[5] }, 919 }; 920 921 static ssize_t name_show(struct device *dev, struct device_attribute 922 *devattr, char *buf) 923 { 924 struct pc87427_data *data = dev_get_drvdata(dev); 925 926 return sprintf(buf, "%s\n", data->name); 927 } 928 static DEVICE_ATTR_RO(name); 929 930 931 /* 932 * Device detection, attach and detach 933 */ 934 935 static int pc87427_request_regions(struct platform_device *pdev, 936 int count) 937 { 938 struct resource *res; 939 int i; 940 941 for (i = 0; i < count; i++) { 942 res = platform_get_resource(pdev, IORESOURCE_IO, i); 943 if (!res) { 944 dev_err(&pdev->dev, "Missing resource #%d\n", i); 945 return -ENOENT; 946 } 947 if (!devm_request_region(&pdev->dev, res->start, 948 resource_size(res), DRVNAME)) { 949 dev_err(&pdev->dev, 950 "Failed to request region 0x%lx-0x%lx\n", 951 (unsigned long)res->start, 952 (unsigned long)res->end); 953 return -EBUSY; 954 } 955 } 956 return 0; 957 } 958 959 static void pc87427_init_device(struct device *dev) 960 { 961 struct pc87427_sio_data *sio_data = dev_get_platdata(dev); 962 struct pc87427_data *data = dev_get_drvdata(dev); 963 int i; 964 u8 reg; 965 966 /* The FMC module should be ready */ 967 reg = pc87427_read8(data, LD_FAN, PC87427_REG_BANK); 968 if (!(reg & 0x80)) 969 dev_warn(dev, "%s module not ready!\n", "FMC"); 970 971 /* Check which fans are enabled */ 972 for (i = 0; i < 8; i++) { 973 if (!(sio_data->has_fanin & (1 << i))) /* Not wired */ 974 continue; 975 reg = pc87427_read8_bank(data, LD_FAN, BANK_FM(i), 976 PC87427_REG_FAN_STATUS); 977 if (reg & FAN_STATUS_MONEN) 978 data->fan_enabled |= (1 << i); 979 } 980 981 if (!data->fan_enabled) { 982 dev_dbg(dev, "Enabling monitoring of all fans\n"); 983 for (i = 0; i < 8; i++) { 984 if (!(sio_data->has_fanin & (1 << i))) /* Not wired */ 985 continue; 986 pc87427_write8_bank(data, LD_FAN, BANK_FM(i), 987 PC87427_REG_FAN_STATUS, 988 FAN_STATUS_MONEN); 989 } 990 data->fan_enabled = sio_data->has_fanin; 991 } 992 993 /* Check which PWM outputs are enabled */ 994 for (i = 0; i < 4; i++) { 995 if (!(sio_data->has_fanout & (1 << i))) /* Not wired */ 996 continue; 997 reg = pc87427_read8_bank(data, LD_FAN, BANK_FC(i), 998 PC87427_REG_PWM_ENABLE); 999 if (reg & PWM_ENABLE_CTLEN) 1000 data->pwm_enabled |= (1 << i); 1001 1002 /* 1003 * We don't expose an interface to reconfigure the automatic 1004 * fan control mode, so only allow to return to this mode if 1005 * it was originally set. 1006 */ 1007 if ((reg & PWM_ENABLE_MODE_MASK) == PWM_MODE_AUTO) { 1008 dev_dbg(dev, "PWM%d is in automatic control mode\n", 1009 i + 1); 1010 data->pwm_auto_ok |= (1 << i); 1011 } 1012 } 1013 1014 /* The HMC module should be ready */ 1015 reg = pc87427_read8(data, LD_TEMP, PC87427_REG_BANK); 1016 if (!(reg & 0x80)) 1017 dev_warn(dev, "%s module not ready!\n", "HMC"); 1018 1019 /* Check which temperature channels are enabled */ 1020 for (i = 0; i < 6; i++) { 1021 reg = pc87427_read8_bank(data, LD_TEMP, BANK_TM(i), 1022 PC87427_REG_TEMP_STATUS); 1023 if (reg & TEMP_STATUS_CHANEN) 1024 data->temp_enabled |= (1 << i); 1025 } 1026 } 1027 1028 static void pc87427_remove_files(struct device *dev) 1029 { 1030 struct pc87427_data *data = dev_get_drvdata(dev); 1031 int i; 1032 1033 device_remove_file(dev, &dev_attr_name); 1034 for (i = 0; i < 8; i++) { 1035 if (!(data->fan_enabled & (1 << i))) 1036 continue; 1037 sysfs_remove_group(&dev->kobj, &pc87427_group_fan[i]); 1038 } 1039 for (i = 0; i < 4; i++) { 1040 if (!(data->pwm_enabled & (1 << i))) 1041 continue; 1042 sysfs_remove_group(&dev->kobj, &pc87427_group_pwm[i]); 1043 } 1044 for (i = 0; i < 6; i++) { 1045 if (!(data->temp_enabled & (1 << i))) 1046 continue; 1047 sysfs_remove_group(&dev->kobj, &pc87427_group_temp[i]); 1048 } 1049 } 1050 1051 static int pc87427_probe(struct platform_device *pdev) 1052 { 1053 struct pc87427_sio_data *sio_data = dev_get_platdata(&pdev->dev); 1054 struct pc87427_data *data; 1055 int i, err, res_count; 1056 1057 data = devm_kzalloc(&pdev->dev, sizeof(struct pc87427_data), 1058 GFP_KERNEL); 1059 if (!data) 1060 return -ENOMEM; 1061 1062 data->address[0] = sio_data->address[0]; 1063 data->address[1] = sio_data->address[1]; 1064 res_count = (data->address[0] != 0) + (data->address[1] != 0); 1065 1066 err = pc87427_request_regions(pdev, res_count); 1067 if (err) 1068 return err; 1069 1070 mutex_init(&data->lock); 1071 data->name = "pc87427"; 1072 platform_set_drvdata(pdev, data); 1073 pc87427_init_device(&pdev->dev); 1074 1075 /* Register sysfs hooks */ 1076 err = device_create_file(&pdev->dev, &dev_attr_name); 1077 if (err) 1078 return err; 1079 for (i = 0; i < 8; i++) { 1080 if (!(data->fan_enabled & (1 << i))) 1081 continue; 1082 err = sysfs_create_group(&pdev->dev.kobj, 1083 &pc87427_group_fan[i]); 1084 if (err) 1085 goto exit_remove_files; 1086 } 1087 for (i = 0; i < 4; i++) { 1088 if (!(data->pwm_enabled & (1 << i))) 1089 continue; 1090 err = sysfs_create_group(&pdev->dev.kobj, 1091 &pc87427_group_pwm[i]); 1092 if (err) 1093 goto exit_remove_files; 1094 } 1095 for (i = 0; i < 6; i++) { 1096 if (!(data->temp_enabled & (1 << i))) 1097 continue; 1098 err = sysfs_create_group(&pdev->dev.kobj, 1099 &pc87427_group_temp[i]); 1100 if (err) 1101 goto exit_remove_files; 1102 } 1103 1104 data->hwmon_dev = hwmon_device_register(&pdev->dev); 1105 if (IS_ERR(data->hwmon_dev)) { 1106 err = PTR_ERR(data->hwmon_dev); 1107 dev_err(&pdev->dev, "Class registration failed (%d)\n", err); 1108 goto exit_remove_files; 1109 } 1110 1111 return 0; 1112 1113 exit_remove_files: 1114 pc87427_remove_files(&pdev->dev); 1115 return err; 1116 } 1117 1118 static void pc87427_remove(struct platform_device *pdev) 1119 { 1120 struct pc87427_data *data = platform_get_drvdata(pdev); 1121 1122 hwmon_device_unregister(data->hwmon_dev); 1123 pc87427_remove_files(&pdev->dev); 1124 } 1125 1126 1127 static struct platform_driver pc87427_driver = { 1128 .driver = { 1129 .name = DRVNAME, 1130 }, 1131 .probe = pc87427_probe, 1132 .remove_new = pc87427_remove, 1133 }; 1134 1135 static int __init pc87427_device_add(const struct pc87427_sio_data *sio_data) 1136 { 1137 struct resource res[2] = { 1138 { .flags = IORESOURCE_IO }, 1139 { .flags = IORESOURCE_IO }, 1140 }; 1141 int err, i, res_count; 1142 1143 res_count = 0; 1144 for (i = 0; i < 2; i++) { 1145 if (!sio_data->address[i]) 1146 continue; 1147 res[res_count].start = sio_data->address[i]; 1148 res[res_count].end = sio_data->address[i] + REGION_LENGTH - 1; 1149 res[res_count].name = logdev_str[i]; 1150 1151 err = acpi_check_resource_conflict(&res[res_count]); 1152 if (err) 1153 goto exit; 1154 1155 res_count++; 1156 } 1157 1158 pdev = platform_device_alloc(DRVNAME, res[0].start); 1159 if (!pdev) { 1160 err = -ENOMEM; 1161 pr_err("Device allocation failed\n"); 1162 goto exit; 1163 } 1164 1165 err = platform_device_add_resources(pdev, res, res_count); 1166 if (err) { 1167 pr_err("Device resource addition failed (%d)\n", err); 1168 goto exit_device_put; 1169 } 1170 1171 err = platform_device_add_data(pdev, sio_data, 1172 sizeof(struct pc87427_sio_data)); 1173 if (err) { 1174 pr_err("Platform data allocation failed\n"); 1175 goto exit_device_put; 1176 } 1177 1178 err = platform_device_add(pdev); 1179 if (err) { 1180 pr_err("Device addition failed (%d)\n", err); 1181 goto exit_device_put; 1182 } 1183 1184 return 0; 1185 1186 exit_device_put: 1187 platform_device_put(pdev); 1188 exit: 1189 return err; 1190 } 1191 1192 static int __init pc87427_find(int sioaddr, struct pc87427_sio_data *sio_data) 1193 { 1194 u16 val; 1195 u8 cfg, cfg_b; 1196 int i, err; 1197 1198 err = superio_enter(sioaddr); 1199 if (err) 1200 return err; 1201 1202 /* Identify device */ 1203 val = force_id ? force_id : superio_inb(sioaddr, SIOREG_DEVID); 1204 if (val != 0xf2) { /* PC87427 */ 1205 err = -ENODEV; 1206 goto exit; 1207 } 1208 1209 for (i = 0; i < 2; i++) { 1210 sio_data->address[i] = 0; 1211 /* Select logical device */ 1212 superio_outb(sioaddr, SIOREG_LDSEL, logdev[i]); 1213 1214 val = superio_inb(sioaddr, SIOREG_ACT); 1215 if (!(val & 0x01)) { 1216 pr_info("Logical device 0x%02x not activated\n", 1217 logdev[i]); 1218 continue; 1219 } 1220 1221 val = superio_inb(sioaddr, SIOREG_MAP); 1222 if (val & 0x01) { 1223 pr_warn("Logical device 0x%02x is memory-mapped, can't use\n", 1224 logdev[i]); 1225 continue; 1226 } 1227 1228 val = (superio_inb(sioaddr, SIOREG_IOBASE) << 8) 1229 | superio_inb(sioaddr, SIOREG_IOBASE + 1); 1230 if (!val) { 1231 pr_info("I/O base address not set for logical device 0x%02x\n", 1232 logdev[i]); 1233 continue; 1234 } 1235 sio_data->address[i] = val; 1236 } 1237 1238 /* No point in loading the driver if everything is disabled */ 1239 if (!sio_data->address[0] && !sio_data->address[1]) { 1240 err = -ENODEV; 1241 goto exit; 1242 } 1243 1244 /* Check which fan inputs are wired */ 1245 sio_data->has_fanin = (1 << 2) | (1 << 3); /* FANIN2, FANIN3 */ 1246 1247 cfg = superio_inb(sioaddr, SIOREG_CF2); 1248 if (!(cfg & (1 << 3))) 1249 sio_data->has_fanin |= (1 << 0); /* FANIN0 */ 1250 if (!(cfg & (1 << 2))) 1251 sio_data->has_fanin |= (1 << 4); /* FANIN4 */ 1252 1253 cfg = superio_inb(sioaddr, SIOREG_CFD); 1254 if (!(cfg & (1 << 0))) 1255 sio_data->has_fanin |= (1 << 1); /* FANIN1 */ 1256 1257 cfg = superio_inb(sioaddr, SIOREG_CF4); 1258 if (!(cfg & (1 << 0))) 1259 sio_data->has_fanin |= (1 << 7); /* FANIN7 */ 1260 cfg_b = superio_inb(sioaddr, SIOREG_CFB); 1261 if (!(cfg & (1 << 1)) && (cfg_b & (1 << 3))) 1262 sio_data->has_fanin |= (1 << 5); /* FANIN5 */ 1263 cfg = superio_inb(sioaddr, SIOREG_CF3); 1264 if ((cfg & (1 << 3)) && !(cfg_b & (1 << 5))) 1265 sio_data->has_fanin |= (1 << 6); /* FANIN6 */ 1266 1267 /* Check which fan outputs are wired */ 1268 sio_data->has_fanout = (1 << 0); /* FANOUT0 */ 1269 if (cfg_b & (1 << 0)) 1270 sio_data->has_fanout |= (1 << 3); /* FANOUT3 */ 1271 1272 cfg = superio_inb(sioaddr, SIOREG_CFC); 1273 if (!(cfg & (1 << 4))) { 1274 if (cfg_b & (1 << 1)) 1275 sio_data->has_fanout |= (1 << 1); /* FANOUT1 */ 1276 if (cfg_b & (1 << 2)) 1277 sio_data->has_fanout |= (1 << 2); /* FANOUT2 */ 1278 } 1279 1280 /* FANOUT1 and FANOUT2 can each be routed to 2 different pins */ 1281 cfg = superio_inb(sioaddr, SIOREG_CF5); 1282 if (cfg & (1 << 6)) 1283 sio_data->has_fanout |= (1 << 1); /* FANOUT1 */ 1284 if (cfg & (1 << 5)) 1285 sio_data->has_fanout |= (1 << 2); /* FANOUT2 */ 1286 1287 exit: 1288 superio_exit(sioaddr); 1289 return err; 1290 } 1291 1292 static int __init pc87427_init(void) 1293 { 1294 int err; 1295 struct pc87427_sio_data sio_data; 1296 1297 if (pc87427_find(0x2e, &sio_data) 1298 && pc87427_find(0x4e, &sio_data)) 1299 return -ENODEV; 1300 1301 err = platform_driver_register(&pc87427_driver); 1302 if (err) 1303 goto exit; 1304 1305 /* Sets global pdev as a side effect */ 1306 err = pc87427_device_add(&sio_data); 1307 if (err) 1308 goto exit_driver; 1309 1310 return 0; 1311 1312 exit_driver: 1313 platform_driver_unregister(&pc87427_driver); 1314 exit: 1315 return err; 1316 } 1317 1318 static void __exit pc87427_exit(void) 1319 { 1320 platform_device_unregister(pdev); 1321 platform_driver_unregister(&pc87427_driver); 1322 } 1323 1324 MODULE_AUTHOR("Jean Delvare <jdelvare@suse.de>"); 1325 MODULE_DESCRIPTION("PC87427 hardware monitoring driver"); 1326 MODULE_LICENSE("GPL"); 1327 1328 module_init(pc87427_init); 1329 module_exit(pc87427_exit); 1330