1 /* 2 w83781d.c - Part of lm_sensors, Linux kernel modules for hardware 3 monitoring 4 Copyright (c) 1998 - 2001 Frodo Looijaard <frodol@dds.nl>, 5 Philip Edelbrock <phil@netroedge.com>, 6 and Mark Studebaker <mdsxyz123@yahoo.com> 7 8 This program is free software; you can redistribute it and/or modify 9 it under the terms of the GNU General Public License as published by 10 the Free Software Foundation; either version 2 of the License, or 11 (at your option) any later version. 12 13 This program is distributed in the hope that it will be useful, 14 but WITHOUT ANY WARRANTY; without even the implied warranty of 15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 GNU General Public License for more details. 17 18 You should have received a copy of the GNU General Public License 19 along with this program; if not, write to the Free Software 20 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 21 */ 22 23 /* 24 Supports following chips: 25 26 Chip #vin #fanin #pwm #temp wchipid vendid i2c ISA 27 as99127f 7 3 0 3 0x31 0x12c3 yes no 28 as99127f rev.2 (type_name = as99127f) 0x31 0x5ca3 yes no 29 w83781d 7 3 0 3 0x10-1 0x5ca3 yes yes 30 w83627hf 9 3 2 3 0x21 0x5ca3 yes yes(LPC) 31 w83782d 9 3 2-4 3 0x30 0x5ca3 yes yes 32 w83783s 5-6 3 2 1-2 0x40 0x5ca3 yes no 33 34 */ 35 36 #include <linux/module.h> 37 #include <linux/init.h> 38 #include <linux/slab.h> 39 #include <linux/jiffies.h> 40 #include <linux/i2c.h> 41 #include <linux/i2c-isa.h> 42 #include <linux/hwmon.h> 43 #include <linux/hwmon-vid.h> 44 #include <linux/err.h> 45 #include <asm/io.h> 46 #include "lm75.h" 47 48 /* Addresses to scan */ 49 static unsigned short normal_i2c[] = { 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 50 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, 51 0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END }; 52 static unsigned short isa_address = 0x290; 53 54 /* Insmod parameters */ 55 I2C_CLIENT_INSMOD_5(w83781d, w83782d, w83783s, w83627hf, as99127f); 56 I2C_CLIENT_MODULE_PARM(force_subclients, "List of subclient addresses: " 57 "{bus, clientaddr, subclientaddr1, subclientaddr2}"); 58 59 static int init = 1; 60 module_param(init, bool, 0); 61 MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization"); 62 63 /* Constants specified below */ 64 65 /* Length of ISA address segment */ 66 #define W83781D_EXTENT 8 67 68 /* Where are the ISA address/data registers relative to the base address */ 69 #define W83781D_ADDR_REG_OFFSET 5 70 #define W83781D_DATA_REG_OFFSET 6 71 72 /* The W83781D registers */ 73 /* The W83782D registers for nr=7,8 are in bank 5 */ 74 #define W83781D_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \ 75 (0x554 + (((nr) - 7) * 2))) 76 #define W83781D_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \ 77 (0x555 + (((nr) - 7) * 2))) 78 #define W83781D_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \ 79 (0x550 + (nr) - 7)) 80 81 #define W83781D_REG_FAN_MIN(nr) (0x3a + (nr)) 82 #define W83781D_REG_FAN(nr) (0x27 + (nr)) 83 84 #define W83781D_REG_BANK 0x4E 85 #define W83781D_REG_TEMP2_CONFIG 0x152 86 #define W83781D_REG_TEMP3_CONFIG 0x252 87 #define W83781D_REG_TEMP(nr) ((nr == 3) ? (0x0250) : \ 88 ((nr == 2) ? (0x0150) : \ 89 (0x27))) 90 #define W83781D_REG_TEMP_HYST(nr) ((nr == 3) ? (0x253) : \ 91 ((nr == 2) ? (0x153) : \ 92 (0x3A))) 93 #define W83781D_REG_TEMP_OVER(nr) ((nr == 3) ? (0x255) : \ 94 ((nr == 2) ? (0x155) : \ 95 (0x39))) 96 97 #define W83781D_REG_CONFIG 0x40 98 #define W83781D_REG_ALARM1 0x41 99 #define W83781D_REG_ALARM2 0x42 100 #define W83781D_REG_ALARM3 0x450 /* not on W83781D */ 101 102 #define W83781D_REG_IRQ 0x4C 103 #define W83781D_REG_BEEP_CONFIG 0x4D 104 #define W83781D_REG_BEEP_INTS1 0x56 105 #define W83781D_REG_BEEP_INTS2 0x57 106 #define W83781D_REG_BEEP_INTS3 0x453 /* not on W83781D */ 107 108 #define W83781D_REG_VID_FANDIV 0x47 109 110 #define W83781D_REG_CHIPID 0x49 111 #define W83781D_REG_WCHIPID 0x58 112 #define W83781D_REG_CHIPMAN 0x4F 113 #define W83781D_REG_PIN 0x4B 114 115 /* 782D/783S only */ 116 #define W83781D_REG_VBAT 0x5D 117 118 /* PWM 782D (1-4) and 783S (1-2) only */ 119 #define W83781D_REG_PWM1 0x5B /* 782d and 783s/627hf datasheets disagree */ 120 /* on which is which; */ 121 #define W83781D_REG_PWM2 0x5A /* We follow the 782d convention here, */ 122 /* However 782d is probably wrong. */ 123 #define W83781D_REG_PWM3 0x5E 124 #define W83781D_REG_PWM4 0x5F 125 #define W83781D_REG_PWMCLK12 0x5C 126 #define W83781D_REG_PWMCLK34 0x45C 127 static const u8 regpwm[] = { W83781D_REG_PWM1, W83781D_REG_PWM2, 128 W83781D_REG_PWM3, W83781D_REG_PWM4 129 }; 130 131 #define W83781D_REG_PWM(nr) (regpwm[(nr) - 1]) 132 133 #define W83781D_REG_I2C_ADDR 0x48 134 #define W83781D_REG_I2C_SUBADDR 0x4A 135 136 /* The following are undocumented in the data sheets however we 137 received the information in an email from Winbond tech support */ 138 /* Sensor selection - not on 781d */ 139 #define W83781D_REG_SCFG1 0x5D 140 static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 }; 141 142 #define W83781D_REG_SCFG2 0x59 143 static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 }; 144 145 #define W83781D_DEFAULT_BETA 3435 146 147 /* RT Table registers */ 148 #define W83781D_REG_RT_IDX 0x50 149 #define W83781D_REG_RT_VAL 0x51 150 151 /* Conversions. Rounding and limit checking is only done on the TO_REG 152 variants. Note that you should be a bit careful with which arguments 153 these macros are called: arguments may be evaluated more than once. 154 Fixing this is just not worth it. */ 155 #define IN_TO_REG(val) (SENSORS_LIMIT((((val) * 10 + 8)/16),0,255)) 156 #define IN_FROM_REG(val) (((val) * 16) / 10) 157 158 static inline u8 159 FAN_TO_REG(long rpm, int div) 160 { 161 if (rpm == 0) 162 return 255; 163 rpm = SENSORS_LIMIT(rpm, 1, 1000000); 164 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254); 165 } 166 167 #define FAN_FROM_REG(val,div) ((val) == 0 ? -1 : \ 168 ((val) == 255 ? 0 : \ 169 1350000 / ((val) * (div)))) 170 171 #define TEMP_TO_REG(val) (SENSORS_LIMIT(((val) < 0 ? (val)+0x100*1000 \ 172 : (val)) / 1000, 0, 0xff)) 173 #define TEMP_FROM_REG(val) (((val) & 0x80 ? (val)-0x100 : (val)) * 1000) 174 175 #define PWM_FROM_REG(val) (val) 176 #define PWM_TO_REG(val) (SENSORS_LIMIT((val),0,255)) 177 #define BEEP_MASK_FROM_REG(val,type) ((type) == as99127f ? \ 178 (val) ^ 0x7fff : (val)) 179 #define BEEP_MASK_TO_REG(val,type) ((type) == as99127f ? \ 180 (~(val)) & 0x7fff : (val) & 0xffffff) 181 182 #define BEEP_ENABLE_TO_REG(val) ((val) ? 1 : 0) 183 #define BEEP_ENABLE_FROM_REG(val) ((val) ? 1 : 0) 184 185 #define DIV_FROM_REG(val) (1 << (val)) 186 187 static inline u8 188 DIV_TO_REG(long val, enum chips type) 189 { 190 int i; 191 val = SENSORS_LIMIT(val, 1, 192 ((type == w83781d 193 || type == as99127f) ? 8 : 128)) >> 1; 194 for (i = 0; i < 7; i++) { 195 if (val == 0) 196 break; 197 val >>= 1; 198 } 199 return ((u8) i); 200 } 201 202 /* There are some complications in a module like this. First off, W83781D chips 203 may be both present on the SMBus and the ISA bus, and we have to handle 204 those cases separately at some places. Second, there might be several 205 W83781D chips available (well, actually, that is probably never done; but 206 it is a clean illustration of how to handle a case like that). Finally, 207 a specific chip may be attached to *both* ISA and SMBus, and we would 208 not like to detect it double. Fortunately, in the case of the W83781D at 209 least, a register tells us what SMBus address we are on, so that helps 210 a bit - except if there could be more than one SMBus. Groan. No solution 211 for this yet. */ 212 213 /* This module may seem overly long and complicated. In fact, it is not so 214 bad. Quite a lot of bookkeeping is done. A real driver can often cut 215 some corners. */ 216 217 /* For each registered W83781D, we need to keep some data in memory. That 218 data is pointed to by w83781d_list[NR]->data. The structure itself is 219 dynamically allocated, at the same time when a new w83781d client is 220 allocated. */ 221 struct w83781d_data { 222 struct i2c_client client; 223 struct class_device *class_dev; 224 struct semaphore lock; 225 enum chips type; 226 227 struct semaphore update_lock; 228 char valid; /* !=0 if following fields are valid */ 229 unsigned long last_updated; /* In jiffies */ 230 231 struct i2c_client *lm75[2]; /* for secondary I2C addresses */ 232 /* array of 2 pointers to subclients */ 233 234 u8 in[9]; /* Register value - 8 & 9 for 782D only */ 235 u8 in_max[9]; /* Register value - 8 & 9 for 782D only */ 236 u8 in_min[9]; /* Register value - 8 & 9 for 782D only */ 237 u8 fan[3]; /* Register value */ 238 u8 fan_min[3]; /* Register value */ 239 u8 temp; 240 u8 temp_max; /* Register value */ 241 u8 temp_max_hyst; /* Register value */ 242 u16 temp_add[2]; /* Register value */ 243 u16 temp_max_add[2]; /* Register value */ 244 u16 temp_max_hyst_add[2]; /* Register value */ 245 u8 fan_div[3]; /* Register encoding, shifted right */ 246 u8 vid; /* Register encoding, combined */ 247 u32 alarms; /* Register encoding, combined */ 248 u32 beep_mask; /* Register encoding, combined */ 249 u8 beep_enable; /* Boolean */ 250 u8 pwm[4]; /* Register value */ 251 u8 pwmenable[4]; /* Boolean */ 252 u16 sens[3]; /* 782D/783S only. 253 1 = pentium diode; 2 = 3904 diode; 254 3000-5000 = thermistor beta. 255 Default = 3435. 256 Other Betas unimplemented */ 257 u8 vrm; 258 }; 259 260 static int w83781d_attach_adapter(struct i2c_adapter *adapter); 261 static int w83781d_isa_attach_adapter(struct i2c_adapter *adapter); 262 static int w83781d_detect(struct i2c_adapter *adapter, int address, int kind); 263 static int w83781d_detach_client(struct i2c_client *client); 264 265 static int w83781d_read_value(struct i2c_client *client, u16 register); 266 static int w83781d_write_value(struct i2c_client *client, u16 register, 267 u16 value); 268 static struct w83781d_data *w83781d_update_device(struct device *dev); 269 static void w83781d_init_client(struct i2c_client *client); 270 271 static struct i2c_driver w83781d_driver = { 272 .owner = THIS_MODULE, 273 .name = "w83781d", 274 .id = I2C_DRIVERID_W83781D, 275 .flags = I2C_DF_NOTIFY, 276 .attach_adapter = w83781d_attach_adapter, 277 .detach_client = w83781d_detach_client, 278 }; 279 280 static struct i2c_driver w83781d_isa_driver = { 281 .owner = THIS_MODULE, 282 .name = "w83781d-isa", 283 .attach_adapter = w83781d_isa_attach_adapter, 284 .detach_client = w83781d_detach_client, 285 }; 286 287 288 /* following are the sysfs callback functions */ 289 #define show_in_reg(reg) \ 290 static ssize_t show_##reg (struct device *dev, char *buf, int nr) \ 291 { \ 292 struct w83781d_data *data = w83781d_update_device(dev); \ 293 return sprintf(buf,"%ld\n", (long)IN_FROM_REG(data->reg[nr] * 10)); \ 294 } 295 show_in_reg(in); 296 show_in_reg(in_min); 297 show_in_reg(in_max); 298 299 #define store_in_reg(REG, reg) \ 300 static ssize_t store_in_##reg (struct device *dev, const char *buf, size_t count, int nr) \ 301 { \ 302 struct i2c_client *client = to_i2c_client(dev); \ 303 struct w83781d_data *data = i2c_get_clientdata(client); \ 304 u32 val; \ 305 \ 306 val = simple_strtoul(buf, NULL, 10) / 10; \ 307 \ 308 down(&data->update_lock); \ 309 data->in_##reg[nr] = IN_TO_REG(val); \ 310 w83781d_write_value(client, W83781D_REG_IN_##REG(nr), data->in_##reg[nr]); \ 311 \ 312 up(&data->update_lock); \ 313 return count; \ 314 } 315 store_in_reg(MIN, min); 316 store_in_reg(MAX, max); 317 318 #define sysfs_in_offset(offset) \ 319 static ssize_t \ 320 show_regs_in_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 321 { \ 322 return show_in(dev, buf, offset); \ 323 } \ 324 static DEVICE_ATTR(in##offset##_input, S_IRUGO, show_regs_in_##offset, NULL); 325 326 #define sysfs_in_reg_offset(reg, offset) \ 327 static ssize_t show_regs_in_##reg##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 328 { \ 329 return show_in_##reg (dev, buf, offset); \ 330 } \ 331 static ssize_t store_regs_in_##reg##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 332 { \ 333 return store_in_##reg (dev, buf, count, offset); \ 334 } \ 335 static DEVICE_ATTR(in##offset##_##reg, S_IRUGO| S_IWUSR, show_regs_in_##reg##offset, store_regs_in_##reg##offset); 336 337 #define sysfs_in_offsets(offset) \ 338 sysfs_in_offset(offset); \ 339 sysfs_in_reg_offset(min, offset); \ 340 sysfs_in_reg_offset(max, offset); 341 342 sysfs_in_offsets(0); 343 sysfs_in_offsets(1); 344 sysfs_in_offsets(2); 345 sysfs_in_offsets(3); 346 sysfs_in_offsets(4); 347 sysfs_in_offsets(5); 348 sysfs_in_offsets(6); 349 sysfs_in_offsets(7); 350 sysfs_in_offsets(8); 351 352 #define device_create_file_in(client, offset) \ 353 do { \ 354 device_create_file(&client->dev, &dev_attr_in##offset##_input); \ 355 device_create_file(&client->dev, &dev_attr_in##offset##_min); \ 356 device_create_file(&client->dev, &dev_attr_in##offset##_max); \ 357 } while (0) 358 359 #define show_fan_reg(reg) \ 360 static ssize_t show_##reg (struct device *dev, char *buf, int nr) \ 361 { \ 362 struct w83781d_data *data = w83781d_update_device(dev); \ 363 return sprintf(buf,"%ld\n", \ 364 FAN_FROM_REG(data->reg[nr-1], (long)DIV_FROM_REG(data->fan_div[nr-1]))); \ 365 } 366 show_fan_reg(fan); 367 show_fan_reg(fan_min); 368 369 static ssize_t 370 store_fan_min(struct device *dev, const char *buf, size_t count, int nr) 371 { 372 struct i2c_client *client = to_i2c_client(dev); 373 struct w83781d_data *data = i2c_get_clientdata(client); 374 u32 val; 375 376 val = simple_strtoul(buf, NULL, 10); 377 378 down(&data->update_lock); 379 data->fan_min[nr - 1] = 380 FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr - 1])); 381 w83781d_write_value(client, W83781D_REG_FAN_MIN(nr), 382 data->fan_min[nr - 1]); 383 384 up(&data->update_lock); 385 return count; 386 } 387 388 #define sysfs_fan_offset(offset) \ 389 static ssize_t show_regs_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 390 { \ 391 return show_fan(dev, buf, offset); \ 392 } \ 393 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_regs_fan_##offset, NULL); 394 395 #define sysfs_fan_min_offset(offset) \ 396 static ssize_t show_regs_fan_min##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 397 { \ 398 return show_fan_min(dev, buf, offset); \ 399 } \ 400 static ssize_t store_regs_fan_min##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 401 { \ 402 return store_fan_min(dev, buf, count, offset); \ 403 } \ 404 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, show_regs_fan_min##offset, store_regs_fan_min##offset); 405 406 sysfs_fan_offset(1); 407 sysfs_fan_min_offset(1); 408 sysfs_fan_offset(2); 409 sysfs_fan_min_offset(2); 410 sysfs_fan_offset(3); 411 sysfs_fan_min_offset(3); 412 413 #define device_create_file_fan(client, offset) \ 414 do { \ 415 device_create_file(&client->dev, &dev_attr_fan##offset##_input); \ 416 device_create_file(&client->dev, &dev_attr_fan##offset##_min); \ 417 } while (0) 418 419 #define show_temp_reg(reg) \ 420 static ssize_t show_##reg (struct device *dev, char *buf, int nr) \ 421 { \ 422 struct w83781d_data *data = w83781d_update_device(dev); \ 423 if (nr >= 2) { /* TEMP2 and TEMP3 */ \ 424 return sprintf(buf,"%d\n", \ 425 LM75_TEMP_FROM_REG(data->reg##_add[nr-2])); \ 426 } else { /* TEMP1 */ \ 427 return sprintf(buf,"%ld\n", (long)TEMP_FROM_REG(data->reg)); \ 428 } \ 429 } 430 show_temp_reg(temp); 431 show_temp_reg(temp_max); 432 show_temp_reg(temp_max_hyst); 433 434 #define store_temp_reg(REG, reg) \ 435 static ssize_t store_temp_##reg (struct device *dev, const char *buf, size_t count, int nr) \ 436 { \ 437 struct i2c_client *client = to_i2c_client(dev); \ 438 struct w83781d_data *data = i2c_get_clientdata(client); \ 439 s32 val; \ 440 \ 441 val = simple_strtol(buf, NULL, 10); \ 442 \ 443 down(&data->update_lock); \ 444 \ 445 if (nr >= 2) { /* TEMP2 and TEMP3 */ \ 446 data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \ 447 w83781d_write_value(client, W83781D_REG_TEMP_##REG(nr), \ 448 data->temp_##reg##_add[nr-2]); \ 449 } else { /* TEMP1 */ \ 450 data->temp_##reg = TEMP_TO_REG(val); \ 451 w83781d_write_value(client, W83781D_REG_TEMP_##REG(nr), \ 452 data->temp_##reg); \ 453 } \ 454 \ 455 up(&data->update_lock); \ 456 return count; \ 457 } 458 store_temp_reg(OVER, max); 459 store_temp_reg(HYST, max_hyst); 460 461 #define sysfs_temp_offset(offset) \ 462 static ssize_t \ 463 show_regs_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 464 { \ 465 return show_temp(dev, buf, offset); \ 466 } \ 467 static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_regs_temp_##offset, NULL); 468 469 #define sysfs_temp_reg_offset(reg, offset) \ 470 static ssize_t show_regs_temp_##reg##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 471 { \ 472 return show_temp_##reg (dev, buf, offset); \ 473 } \ 474 static ssize_t store_regs_temp_##reg##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 475 { \ 476 return store_temp_##reg (dev, buf, count, offset); \ 477 } \ 478 static DEVICE_ATTR(temp##offset##_##reg, S_IRUGO| S_IWUSR, show_regs_temp_##reg##offset, store_regs_temp_##reg##offset); 479 480 #define sysfs_temp_offsets(offset) \ 481 sysfs_temp_offset(offset); \ 482 sysfs_temp_reg_offset(max, offset); \ 483 sysfs_temp_reg_offset(max_hyst, offset); 484 485 sysfs_temp_offsets(1); 486 sysfs_temp_offsets(2); 487 sysfs_temp_offsets(3); 488 489 #define device_create_file_temp(client, offset) \ 490 do { \ 491 device_create_file(&client->dev, &dev_attr_temp##offset##_input); \ 492 device_create_file(&client->dev, &dev_attr_temp##offset##_max); \ 493 device_create_file(&client->dev, &dev_attr_temp##offset##_max_hyst); \ 494 } while (0) 495 496 static ssize_t 497 show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf) 498 { 499 struct w83781d_data *data = w83781d_update_device(dev); 500 return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm)); 501 } 502 503 static 504 DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL); 505 #define device_create_file_vid(client) \ 506 device_create_file(&client->dev, &dev_attr_cpu0_vid); 507 static ssize_t 508 show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf) 509 { 510 struct w83781d_data *data = w83781d_update_device(dev); 511 return sprintf(buf, "%ld\n", (long) data->vrm); 512 } 513 514 static ssize_t 515 store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 516 { 517 struct i2c_client *client = to_i2c_client(dev); 518 struct w83781d_data *data = i2c_get_clientdata(client); 519 u32 val; 520 521 val = simple_strtoul(buf, NULL, 10); 522 data->vrm = val; 523 524 return count; 525 } 526 527 static 528 DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg); 529 #define device_create_file_vrm(client) \ 530 device_create_file(&client->dev, &dev_attr_vrm); 531 static ssize_t 532 show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf) 533 { 534 struct w83781d_data *data = w83781d_update_device(dev); 535 return sprintf(buf, "%u\n", data->alarms); 536 } 537 538 static 539 DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL); 540 #define device_create_file_alarms(client) \ 541 device_create_file(&client->dev, &dev_attr_alarms); 542 static ssize_t show_beep_mask (struct device *dev, struct device_attribute *attr, char *buf) 543 { 544 struct w83781d_data *data = w83781d_update_device(dev); 545 return sprintf(buf, "%ld\n", 546 (long)BEEP_MASK_FROM_REG(data->beep_mask, data->type)); 547 } 548 static ssize_t show_beep_enable (struct device *dev, struct device_attribute *attr, char *buf) 549 { 550 struct w83781d_data *data = w83781d_update_device(dev); 551 return sprintf(buf, "%ld\n", 552 (long)BEEP_ENABLE_FROM_REG(data->beep_enable)); 553 } 554 555 #define BEEP_ENABLE 0 /* Store beep_enable */ 556 #define BEEP_MASK 1 /* Store beep_mask */ 557 558 static ssize_t 559 store_beep_reg(struct device *dev, const char *buf, size_t count, 560 int update_mask) 561 { 562 struct i2c_client *client = to_i2c_client(dev); 563 struct w83781d_data *data = i2c_get_clientdata(client); 564 u32 val, val2; 565 566 val = simple_strtoul(buf, NULL, 10); 567 568 down(&data->update_lock); 569 570 if (update_mask == BEEP_MASK) { /* We are storing beep_mask */ 571 data->beep_mask = BEEP_MASK_TO_REG(val, data->type); 572 w83781d_write_value(client, W83781D_REG_BEEP_INTS1, 573 data->beep_mask & 0xff); 574 575 if ((data->type != w83781d) && (data->type != as99127f)) { 576 w83781d_write_value(client, W83781D_REG_BEEP_INTS3, 577 ((data->beep_mask) >> 16) & 0xff); 578 } 579 580 val2 = (data->beep_mask >> 8) & 0x7f; 581 } else { /* We are storing beep_enable */ 582 val2 = w83781d_read_value(client, W83781D_REG_BEEP_INTS2) & 0x7f; 583 data->beep_enable = BEEP_ENABLE_TO_REG(val); 584 } 585 586 w83781d_write_value(client, W83781D_REG_BEEP_INTS2, 587 val2 | data->beep_enable << 7); 588 589 up(&data->update_lock); 590 return count; 591 } 592 593 #define sysfs_beep(REG, reg) \ 594 static ssize_t show_regs_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \ 595 { \ 596 return show_beep_##reg(dev, attr, buf); \ 597 } \ 598 static ssize_t store_regs_beep_##reg (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 599 { \ 600 return store_beep_reg(dev, buf, count, BEEP_##REG); \ 601 } \ 602 static DEVICE_ATTR(beep_##reg, S_IRUGO | S_IWUSR, show_regs_beep_##reg, store_regs_beep_##reg); 603 604 sysfs_beep(ENABLE, enable); 605 sysfs_beep(MASK, mask); 606 607 #define device_create_file_beep(client) \ 608 do { \ 609 device_create_file(&client->dev, &dev_attr_beep_enable); \ 610 device_create_file(&client->dev, &dev_attr_beep_mask); \ 611 } while (0) 612 613 static ssize_t 614 show_fan_div_reg(struct device *dev, char *buf, int nr) 615 { 616 struct w83781d_data *data = w83781d_update_device(dev); 617 return sprintf(buf, "%ld\n", 618 (long) DIV_FROM_REG(data->fan_div[nr - 1])); 619 } 620 621 /* Note: we save and restore the fan minimum here, because its value is 622 determined in part by the fan divisor. This follows the principle of 623 least suprise; the user doesn't expect the fan minimum to change just 624 because the divisor changed. */ 625 static ssize_t 626 store_fan_div_reg(struct device *dev, const char *buf, size_t count, int nr) 627 { 628 struct i2c_client *client = to_i2c_client(dev); 629 struct w83781d_data *data = i2c_get_clientdata(client); 630 unsigned long min; 631 u8 reg; 632 unsigned long val = simple_strtoul(buf, NULL, 10); 633 634 down(&data->update_lock); 635 636 /* Save fan_min */ 637 min = FAN_FROM_REG(data->fan_min[nr], 638 DIV_FROM_REG(data->fan_div[nr])); 639 640 data->fan_div[nr] = DIV_TO_REG(val, data->type); 641 642 reg = (w83781d_read_value(client, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV) 643 & (nr==0 ? 0xcf : 0x3f)) 644 | ((data->fan_div[nr] & 0x03) << (nr==0 ? 4 : 6)); 645 w83781d_write_value(client, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg); 646 647 /* w83781d and as99127f don't have extended divisor bits */ 648 if (data->type != w83781d && data->type != as99127f) { 649 reg = (w83781d_read_value(client, W83781D_REG_VBAT) 650 & ~(1 << (5 + nr))) 651 | ((data->fan_div[nr] & 0x04) << (3 + nr)); 652 w83781d_write_value(client, W83781D_REG_VBAT, reg); 653 } 654 655 /* Restore fan_min */ 656 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr])); 657 w83781d_write_value(client, W83781D_REG_FAN_MIN(nr+1), data->fan_min[nr]); 658 659 up(&data->update_lock); 660 return count; 661 } 662 663 #define sysfs_fan_div(offset) \ 664 static ssize_t show_regs_fan_div_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 665 { \ 666 return show_fan_div_reg(dev, buf, offset); \ 667 } \ 668 static ssize_t store_regs_fan_div_##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 669 { \ 670 return store_fan_div_reg(dev, buf, count, offset - 1); \ 671 } \ 672 static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, show_regs_fan_div_##offset, store_regs_fan_div_##offset); 673 674 sysfs_fan_div(1); 675 sysfs_fan_div(2); 676 sysfs_fan_div(3); 677 678 #define device_create_file_fan_div(client, offset) \ 679 do { \ 680 device_create_file(&client->dev, &dev_attr_fan##offset##_div); \ 681 } while (0) 682 683 static ssize_t 684 show_pwm_reg(struct device *dev, char *buf, int nr) 685 { 686 struct w83781d_data *data = w83781d_update_device(dev); 687 return sprintf(buf, "%ld\n", (long) PWM_FROM_REG(data->pwm[nr - 1])); 688 } 689 690 static ssize_t 691 show_pwmenable_reg(struct device *dev, char *buf, int nr) 692 { 693 struct w83781d_data *data = w83781d_update_device(dev); 694 return sprintf(buf, "%ld\n", (long) data->pwmenable[nr - 1]); 695 } 696 697 static ssize_t 698 store_pwm_reg(struct device *dev, const char *buf, size_t count, int nr) 699 { 700 struct i2c_client *client = to_i2c_client(dev); 701 struct w83781d_data *data = i2c_get_clientdata(client); 702 u32 val; 703 704 val = simple_strtoul(buf, NULL, 10); 705 706 down(&data->update_lock); 707 data->pwm[nr - 1] = PWM_TO_REG(val); 708 w83781d_write_value(client, W83781D_REG_PWM(nr), data->pwm[nr - 1]); 709 up(&data->update_lock); 710 return count; 711 } 712 713 static ssize_t 714 store_pwmenable_reg(struct device *dev, const char *buf, size_t count, int nr) 715 { 716 struct i2c_client *client = to_i2c_client(dev); 717 struct w83781d_data *data = i2c_get_clientdata(client); 718 u32 val, reg; 719 720 val = simple_strtoul(buf, NULL, 10); 721 722 down(&data->update_lock); 723 724 switch (val) { 725 case 0: 726 case 1: 727 reg = w83781d_read_value(client, W83781D_REG_PWMCLK12); 728 w83781d_write_value(client, W83781D_REG_PWMCLK12, 729 (reg & 0xf7) | (val << 3)); 730 731 reg = w83781d_read_value(client, W83781D_REG_BEEP_CONFIG); 732 w83781d_write_value(client, W83781D_REG_BEEP_CONFIG, 733 (reg & 0xef) | (!val << 4)); 734 735 data->pwmenable[nr - 1] = val; 736 break; 737 738 default: 739 up(&data->update_lock); 740 return -EINVAL; 741 } 742 743 up(&data->update_lock); 744 return count; 745 } 746 747 #define sysfs_pwm(offset) \ 748 static ssize_t show_regs_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 749 { \ 750 return show_pwm_reg(dev, buf, offset); \ 751 } \ 752 static ssize_t store_regs_pwm_##offset (struct device *dev, struct device_attribute *attr, \ 753 const char *buf, size_t count) \ 754 { \ 755 return store_pwm_reg(dev, buf, count, offset); \ 756 } \ 757 static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ 758 show_regs_pwm_##offset, store_regs_pwm_##offset); 759 760 #define sysfs_pwmenable(offset) \ 761 static ssize_t show_regs_pwmenable_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 762 { \ 763 return show_pwmenable_reg(dev, buf, offset); \ 764 } \ 765 static ssize_t store_regs_pwmenable_##offset (struct device *dev, struct device_attribute *attr, \ 766 const char *buf, size_t count) \ 767 { \ 768 return store_pwmenable_reg(dev, buf, count, offset); \ 769 } \ 770 static DEVICE_ATTR(pwm##offset##_enable, S_IRUGO | S_IWUSR, \ 771 show_regs_pwmenable_##offset, store_regs_pwmenable_##offset); 772 773 sysfs_pwm(1); 774 sysfs_pwm(2); 775 sysfs_pwmenable(2); /* only PWM2 can be enabled/disabled */ 776 sysfs_pwm(3); 777 sysfs_pwm(4); 778 779 #define device_create_file_pwm(client, offset) \ 780 do { \ 781 device_create_file(&client->dev, &dev_attr_pwm##offset); \ 782 } while (0) 783 784 #define device_create_file_pwmenable(client, offset) \ 785 do { \ 786 device_create_file(&client->dev, &dev_attr_pwm##offset##_enable); \ 787 } while (0) 788 789 static ssize_t 790 show_sensor_reg(struct device *dev, char *buf, int nr) 791 { 792 struct w83781d_data *data = w83781d_update_device(dev); 793 return sprintf(buf, "%ld\n", (long) data->sens[nr - 1]); 794 } 795 796 static ssize_t 797 store_sensor_reg(struct device *dev, const char *buf, size_t count, int nr) 798 { 799 struct i2c_client *client = to_i2c_client(dev); 800 struct w83781d_data *data = i2c_get_clientdata(client); 801 u32 val, tmp; 802 803 val = simple_strtoul(buf, NULL, 10); 804 805 down(&data->update_lock); 806 807 switch (val) { 808 case 1: /* PII/Celeron diode */ 809 tmp = w83781d_read_value(client, W83781D_REG_SCFG1); 810 w83781d_write_value(client, W83781D_REG_SCFG1, 811 tmp | BIT_SCFG1[nr - 1]); 812 tmp = w83781d_read_value(client, W83781D_REG_SCFG2); 813 w83781d_write_value(client, W83781D_REG_SCFG2, 814 tmp | BIT_SCFG2[nr - 1]); 815 data->sens[nr - 1] = val; 816 break; 817 case 2: /* 3904 */ 818 tmp = w83781d_read_value(client, W83781D_REG_SCFG1); 819 w83781d_write_value(client, W83781D_REG_SCFG1, 820 tmp | BIT_SCFG1[nr - 1]); 821 tmp = w83781d_read_value(client, W83781D_REG_SCFG2); 822 w83781d_write_value(client, W83781D_REG_SCFG2, 823 tmp & ~BIT_SCFG2[nr - 1]); 824 data->sens[nr - 1] = val; 825 break; 826 case W83781D_DEFAULT_BETA: /* thermistor */ 827 tmp = w83781d_read_value(client, W83781D_REG_SCFG1); 828 w83781d_write_value(client, W83781D_REG_SCFG1, 829 tmp & ~BIT_SCFG1[nr - 1]); 830 data->sens[nr - 1] = val; 831 break; 832 default: 833 dev_err(dev, "Invalid sensor type %ld; must be 1, 2, or %d\n", 834 (long) val, W83781D_DEFAULT_BETA); 835 break; 836 } 837 838 up(&data->update_lock); 839 return count; 840 } 841 842 #define sysfs_sensor(offset) \ 843 static ssize_t show_regs_sensor_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ 844 { \ 845 return show_sensor_reg(dev, buf, offset); \ 846 } \ 847 static ssize_t store_regs_sensor_##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 848 { \ 849 return store_sensor_reg(dev, buf, count, offset); \ 850 } \ 851 static DEVICE_ATTR(temp##offset##_type, S_IRUGO | S_IWUSR, show_regs_sensor_##offset, store_regs_sensor_##offset); 852 853 sysfs_sensor(1); 854 sysfs_sensor(2); 855 sysfs_sensor(3); 856 857 #define device_create_file_sensor(client, offset) \ 858 do { \ 859 device_create_file(&client->dev, &dev_attr_temp##offset##_type); \ 860 } while (0) 861 862 /* This function is called when: 863 * w83781d_driver is inserted (when this module is loaded), for each 864 available adapter 865 * when a new adapter is inserted (and w83781d_driver is still present) */ 866 static int 867 w83781d_attach_adapter(struct i2c_adapter *adapter) 868 { 869 if (!(adapter->class & I2C_CLASS_HWMON)) 870 return 0; 871 return i2c_probe(adapter, &addr_data, w83781d_detect); 872 } 873 874 static int 875 w83781d_isa_attach_adapter(struct i2c_adapter *adapter) 876 { 877 return w83781d_detect(adapter, isa_address, -1); 878 } 879 880 /* Assumes that adapter is of I2C, not ISA variety. 881 * OTHERWISE DON'T CALL THIS 882 */ 883 static int 884 w83781d_detect_subclients(struct i2c_adapter *adapter, int address, int kind, 885 struct i2c_client *new_client) 886 { 887 int i, val1 = 0, id; 888 int err; 889 const char *client_name = ""; 890 struct w83781d_data *data = i2c_get_clientdata(new_client); 891 892 data->lm75[0] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL); 893 if (!(data->lm75[0])) { 894 err = -ENOMEM; 895 goto ERROR_SC_0; 896 } 897 898 id = i2c_adapter_id(adapter); 899 900 if (force_subclients[0] == id && force_subclients[1] == address) { 901 for (i = 2; i <= 3; i++) { 902 if (force_subclients[i] < 0x48 || 903 force_subclients[i] > 0x4f) { 904 dev_err(&new_client->dev, "Invalid subclient " 905 "address %d; must be 0x48-0x4f\n", 906 force_subclients[i]); 907 err = -EINVAL; 908 goto ERROR_SC_1; 909 } 910 } 911 w83781d_write_value(new_client, W83781D_REG_I2C_SUBADDR, 912 (force_subclients[2] & 0x07) | 913 ((force_subclients[3] & 0x07) << 4)); 914 data->lm75[0]->addr = force_subclients[2]; 915 } else { 916 val1 = w83781d_read_value(new_client, W83781D_REG_I2C_SUBADDR); 917 data->lm75[0]->addr = 0x48 + (val1 & 0x07); 918 } 919 920 if (kind != w83783s) { 921 data->lm75[1] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL); 922 if (!(data->lm75[1])) { 923 err = -ENOMEM; 924 goto ERROR_SC_1; 925 } 926 927 if (force_subclients[0] == id && 928 force_subclients[1] == address) { 929 data->lm75[1]->addr = force_subclients[3]; 930 } else { 931 data->lm75[1]->addr = 0x48 + ((val1 >> 4) & 0x07); 932 } 933 if (data->lm75[0]->addr == data->lm75[1]->addr) { 934 dev_err(&new_client->dev, 935 "Duplicate addresses 0x%x for subclients.\n", 936 data->lm75[0]->addr); 937 err = -EBUSY; 938 goto ERROR_SC_2; 939 } 940 } 941 942 if (kind == w83781d) 943 client_name = "w83781d subclient"; 944 else if (kind == w83782d) 945 client_name = "w83782d subclient"; 946 else if (kind == w83783s) 947 client_name = "w83783s subclient"; 948 else if (kind == w83627hf) 949 client_name = "w83627hf subclient"; 950 else if (kind == as99127f) 951 client_name = "as99127f subclient"; 952 953 for (i = 0; i <= 1; i++) { 954 /* store all data in w83781d */ 955 i2c_set_clientdata(data->lm75[i], NULL); 956 data->lm75[i]->adapter = adapter; 957 data->lm75[i]->driver = &w83781d_driver; 958 data->lm75[i]->flags = 0; 959 strlcpy(data->lm75[i]->name, client_name, 960 I2C_NAME_SIZE); 961 if ((err = i2c_attach_client(data->lm75[i]))) { 962 dev_err(&new_client->dev, "Subclient %d " 963 "registration at address 0x%x " 964 "failed.\n", i, data->lm75[i]->addr); 965 if (i == 1) 966 goto ERROR_SC_3; 967 goto ERROR_SC_2; 968 } 969 if (kind == w83783s) 970 break; 971 } 972 973 return 0; 974 975 /* Undo inits in case of errors */ 976 ERROR_SC_3: 977 i2c_detach_client(data->lm75[0]); 978 ERROR_SC_2: 979 if (data->lm75[1]) 980 kfree(data->lm75[1]); 981 ERROR_SC_1: 982 if (data->lm75[0]) 983 kfree(data->lm75[0]); 984 ERROR_SC_0: 985 return err; 986 } 987 988 static int 989 w83781d_detect(struct i2c_adapter *adapter, int address, int kind) 990 { 991 int i = 0, val1 = 0, val2; 992 struct i2c_client *new_client; 993 struct w83781d_data *data; 994 int err; 995 const char *client_name = ""; 996 int is_isa = i2c_is_isa_adapter(adapter); 997 enum vendor { winbond, asus } vendid; 998 999 if (!is_isa 1000 && !i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) { 1001 err = -EINVAL; 1002 goto ERROR0; 1003 } 1004 1005 /* Prevent users from forcing a kind for a bus it isn't supposed 1006 to possibly be on */ 1007 if (is_isa && (kind == as99127f || kind == w83783s)) { 1008 dev_err(&adapter->dev, 1009 "Cannot force I2C-only chip for ISA address 0x%02x.\n", 1010 address); 1011 err = -EINVAL; 1012 goto ERROR0; 1013 } 1014 1015 if (is_isa) 1016 if (!request_region(address, W83781D_EXTENT, 1017 w83781d_isa_driver.name)) { 1018 dev_dbg(&adapter->dev, "Request of region " 1019 "0x%x-0x%x for w83781d failed\n", address, 1020 address + W83781D_EXTENT - 1); 1021 err = -EBUSY; 1022 goto ERROR0; 1023 } 1024 1025 /* Probe whether there is anything available on this address. Already 1026 done for SMBus clients */ 1027 if (kind < 0) { 1028 if (is_isa) { 1029 1030 #define REALLY_SLOW_IO 1031 /* We need the timeouts for at least some LM78-like 1032 chips. But only if we read 'undefined' registers. */ 1033 i = inb_p(address + 1); 1034 if (inb_p(address + 2) != i 1035 || inb_p(address + 3) != i 1036 || inb_p(address + 7) != i) { 1037 dev_dbg(&adapter->dev, "Detection of w83781d " 1038 "chip failed at step 1\n"); 1039 err = -ENODEV; 1040 goto ERROR1; 1041 } 1042 #undef REALLY_SLOW_IO 1043 1044 /* Let's just hope nothing breaks here */ 1045 i = inb_p(address + 5) & 0x7f; 1046 outb_p(~i & 0x7f, address + 5); 1047 val2 = inb_p(address + 5) & 0x7f; 1048 if (val2 != (~i & 0x7f)) { 1049 outb_p(i, address + 5); 1050 dev_dbg(&adapter->dev, "Detection of w83781d " 1051 "chip failed at step 2 (0x%x != " 1052 "0x%x at 0x%x)\n", val2, ~i & 0x7f, 1053 address + 5); 1054 err = -ENODEV; 1055 goto ERROR1; 1056 } 1057 } 1058 } 1059 1060 /* OK. For now, we presume we have a valid client. We now create the 1061 client structure, even though we cannot fill it completely yet. 1062 But it allows us to access w83781d_{read,write}_value. */ 1063 1064 if (!(data = kzalloc(sizeof(struct w83781d_data), GFP_KERNEL))) { 1065 err = -ENOMEM; 1066 goto ERROR1; 1067 } 1068 1069 new_client = &data->client; 1070 i2c_set_clientdata(new_client, data); 1071 new_client->addr = address; 1072 init_MUTEX(&data->lock); 1073 new_client->adapter = adapter; 1074 new_client->driver = is_isa ? &w83781d_isa_driver : &w83781d_driver; 1075 new_client->flags = 0; 1076 1077 /* Now, we do the remaining detection. */ 1078 1079 /* The w8378?d may be stuck in some other bank than bank 0. This may 1080 make reading other information impossible. Specify a force=... or 1081 force_*=... parameter, and the Winbond will be reset to the right 1082 bank. */ 1083 if (kind < 0) { 1084 if (w83781d_read_value(new_client, W83781D_REG_CONFIG) & 0x80) { 1085 dev_dbg(&new_client->dev, "Detection failed at step " 1086 "3\n"); 1087 err = -ENODEV; 1088 goto ERROR2; 1089 } 1090 val1 = w83781d_read_value(new_client, W83781D_REG_BANK); 1091 val2 = w83781d_read_value(new_client, W83781D_REG_CHIPMAN); 1092 /* Check for Winbond or Asus ID if in bank 0 */ 1093 if ((!(val1 & 0x07)) && 1094 (((!(val1 & 0x80)) && (val2 != 0xa3) && (val2 != 0xc3)) 1095 || ((val1 & 0x80) && (val2 != 0x5c) && (val2 != 0x12)))) { 1096 dev_dbg(&new_client->dev, "Detection failed at step " 1097 "4\n"); 1098 err = -ENODEV; 1099 goto ERROR2; 1100 } 1101 /* If Winbond SMBus, check address at 0x48. 1102 Asus doesn't support, except for as99127f rev.2 */ 1103 if ((!is_isa) && (((!(val1 & 0x80)) && (val2 == 0xa3)) || 1104 ((val1 & 0x80) && (val2 == 0x5c)))) { 1105 if (w83781d_read_value 1106 (new_client, W83781D_REG_I2C_ADDR) != address) { 1107 dev_dbg(&new_client->dev, "Detection failed " 1108 "at step 5\n"); 1109 err = -ENODEV; 1110 goto ERROR2; 1111 } 1112 } 1113 } 1114 1115 /* We have either had a force parameter, or we have already detected the 1116 Winbond. Put it now into bank 0 and Vendor ID High Byte */ 1117 w83781d_write_value(new_client, W83781D_REG_BANK, 1118 (w83781d_read_value(new_client, 1119 W83781D_REG_BANK) & 0x78) | 1120 0x80); 1121 1122 /* Determine the chip type. */ 1123 if (kind <= 0) { 1124 /* get vendor ID */ 1125 val2 = w83781d_read_value(new_client, W83781D_REG_CHIPMAN); 1126 if (val2 == 0x5c) 1127 vendid = winbond; 1128 else if (val2 == 0x12) 1129 vendid = asus; 1130 else { 1131 dev_dbg(&new_client->dev, "Chip was made by neither " 1132 "Winbond nor Asus?\n"); 1133 err = -ENODEV; 1134 goto ERROR2; 1135 } 1136 1137 val1 = w83781d_read_value(new_client, W83781D_REG_WCHIPID); 1138 if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond) 1139 kind = w83781d; 1140 else if (val1 == 0x30 && vendid == winbond) 1141 kind = w83782d; 1142 else if (val1 == 0x40 && vendid == winbond && !is_isa 1143 && address == 0x2d) 1144 kind = w83783s; 1145 else if (val1 == 0x21 && vendid == winbond) 1146 kind = w83627hf; 1147 else if (val1 == 0x31 && !is_isa && address >= 0x28) 1148 kind = as99127f; 1149 else { 1150 if (kind == 0) 1151 dev_warn(&new_client->dev, "Ignoring 'force' " 1152 "parameter for unknown chip at " 1153 "adapter %d, address 0x%02x\n", 1154 i2c_adapter_id(adapter), address); 1155 err = -EINVAL; 1156 goto ERROR2; 1157 } 1158 } 1159 1160 if (kind == w83781d) { 1161 client_name = "w83781d"; 1162 } else if (kind == w83782d) { 1163 client_name = "w83782d"; 1164 } else if (kind == w83783s) { 1165 client_name = "w83783s"; 1166 } else if (kind == w83627hf) { 1167 client_name = "w83627hf"; 1168 } else if (kind == as99127f) { 1169 client_name = "as99127f"; 1170 } 1171 1172 /* Fill in the remaining client fields and put into the global list */ 1173 strlcpy(new_client->name, client_name, I2C_NAME_SIZE); 1174 data->type = kind; 1175 1176 data->valid = 0; 1177 init_MUTEX(&data->update_lock); 1178 1179 /* Tell the I2C layer a new client has arrived */ 1180 if ((err = i2c_attach_client(new_client))) 1181 goto ERROR2; 1182 1183 /* attach secondary i2c lm75-like clients */ 1184 if (!is_isa) { 1185 if ((err = w83781d_detect_subclients(adapter, address, 1186 kind, new_client))) 1187 goto ERROR3; 1188 } else { 1189 data->lm75[0] = NULL; 1190 data->lm75[1] = NULL; 1191 } 1192 1193 /* Initialize the chip */ 1194 w83781d_init_client(new_client); 1195 1196 /* A few vars need to be filled upon startup */ 1197 for (i = 1; i <= 3; i++) { 1198 data->fan_min[i - 1] = w83781d_read_value(new_client, 1199 W83781D_REG_FAN_MIN(i)); 1200 } 1201 if (kind != w83781d && kind != as99127f) 1202 for (i = 0; i < 4; i++) 1203 data->pwmenable[i] = 1; 1204 1205 /* Register sysfs hooks */ 1206 data->class_dev = hwmon_device_register(&new_client->dev); 1207 if (IS_ERR(data->class_dev)) { 1208 err = PTR_ERR(data->class_dev); 1209 goto ERROR4; 1210 } 1211 1212 device_create_file_in(new_client, 0); 1213 if (kind != w83783s) 1214 device_create_file_in(new_client, 1); 1215 device_create_file_in(new_client, 2); 1216 device_create_file_in(new_client, 3); 1217 device_create_file_in(new_client, 4); 1218 device_create_file_in(new_client, 5); 1219 device_create_file_in(new_client, 6); 1220 if (kind != as99127f && kind != w83781d && kind != w83783s) { 1221 device_create_file_in(new_client, 7); 1222 device_create_file_in(new_client, 8); 1223 } 1224 1225 device_create_file_fan(new_client, 1); 1226 device_create_file_fan(new_client, 2); 1227 device_create_file_fan(new_client, 3); 1228 1229 device_create_file_temp(new_client, 1); 1230 device_create_file_temp(new_client, 2); 1231 if (kind != w83783s) 1232 device_create_file_temp(new_client, 3); 1233 1234 device_create_file_vid(new_client); 1235 device_create_file_vrm(new_client); 1236 1237 device_create_file_fan_div(new_client, 1); 1238 device_create_file_fan_div(new_client, 2); 1239 device_create_file_fan_div(new_client, 3); 1240 1241 device_create_file_alarms(new_client); 1242 1243 device_create_file_beep(new_client); 1244 1245 if (kind != w83781d && kind != as99127f) { 1246 device_create_file_pwm(new_client, 1); 1247 device_create_file_pwm(new_client, 2); 1248 device_create_file_pwmenable(new_client, 2); 1249 } 1250 if (kind == w83782d && !is_isa) { 1251 device_create_file_pwm(new_client, 3); 1252 device_create_file_pwm(new_client, 4); 1253 } 1254 1255 if (kind != as99127f && kind != w83781d) { 1256 device_create_file_sensor(new_client, 1); 1257 device_create_file_sensor(new_client, 2); 1258 if (kind != w83783s) 1259 device_create_file_sensor(new_client, 3); 1260 } 1261 1262 return 0; 1263 1264 ERROR4: 1265 if (data->lm75[1]) { 1266 i2c_detach_client(data->lm75[1]); 1267 kfree(data->lm75[1]); 1268 } 1269 if (data->lm75[0]) { 1270 i2c_detach_client(data->lm75[0]); 1271 kfree(data->lm75[0]); 1272 } 1273 ERROR3: 1274 i2c_detach_client(new_client); 1275 ERROR2: 1276 kfree(data); 1277 ERROR1: 1278 if (is_isa) 1279 release_region(address, W83781D_EXTENT); 1280 ERROR0: 1281 return err; 1282 } 1283 1284 static int 1285 w83781d_detach_client(struct i2c_client *client) 1286 { 1287 struct w83781d_data *data = i2c_get_clientdata(client); 1288 int err; 1289 1290 /* main client */ 1291 if (data) 1292 hwmon_device_unregister(data->class_dev); 1293 1294 if (i2c_is_isa_client(client)) 1295 release_region(client->addr, W83781D_EXTENT); 1296 1297 if ((err = i2c_detach_client(client))) 1298 return err; 1299 1300 /* main client */ 1301 if (data) 1302 kfree(data); 1303 1304 /* subclient */ 1305 else 1306 kfree(client); 1307 1308 return 0; 1309 } 1310 1311 /* The SMBus locks itself, usually, but nothing may access the Winbond between 1312 bank switches. ISA access must always be locked explicitly! 1313 We ignore the W83781D BUSY flag at this moment - it could lead to deadlocks, 1314 would slow down the W83781D access and should not be necessary. 1315 There are some ugly typecasts here, but the good news is - they should 1316 nowhere else be necessary! */ 1317 static int 1318 w83781d_read_value(struct i2c_client *client, u16 reg) 1319 { 1320 struct w83781d_data *data = i2c_get_clientdata(client); 1321 int res, word_sized, bank; 1322 struct i2c_client *cl; 1323 1324 down(&data->lock); 1325 if (i2c_is_isa_client(client)) { 1326 word_sized = (((reg & 0xff00) == 0x100) 1327 || ((reg & 0xff00) == 0x200)) 1328 && (((reg & 0x00ff) == 0x50) 1329 || ((reg & 0x00ff) == 0x53) 1330 || ((reg & 0x00ff) == 0x55)); 1331 if (reg & 0xff00) { 1332 outb_p(W83781D_REG_BANK, 1333 client->addr + W83781D_ADDR_REG_OFFSET); 1334 outb_p(reg >> 8, 1335 client->addr + W83781D_DATA_REG_OFFSET); 1336 } 1337 outb_p(reg & 0xff, client->addr + W83781D_ADDR_REG_OFFSET); 1338 res = inb_p(client->addr + W83781D_DATA_REG_OFFSET); 1339 if (word_sized) { 1340 outb_p((reg & 0xff) + 1, 1341 client->addr + W83781D_ADDR_REG_OFFSET); 1342 res = 1343 (res << 8) + inb_p(client->addr + 1344 W83781D_DATA_REG_OFFSET); 1345 } 1346 if (reg & 0xff00) { 1347 outb_p(W83781D_REG_BANK, 1348 client->addr + W83781D_ADDR_REG_OFFSET); 1349 outb_p(0, client->addr + W83781D_DATA_REG_OFFSET); 1350 } 1351 } else { 1352 bank = (reg >> 8) & 0x0f; 1353 if (bank > 2) 1354 /* switch banks */ 1355 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 1356 bank); 1357 if (bank == 0 || bank > 2) { 1358 res = i2c_smbus_read_byte_data(client, reg & 0xff); 1359 } else { 1360 /* switch to subclient */ 1361 cl = data->lm75[bank - 1]; 1362 /* convert from ISA to LM75 I2C addresses */ 1363 switch (reg & 0xff) { 1364 case 0x50: /* TEMP */ 1365 res = swab16(i2c_smbus_read_word_data(cl, 0)); 1366 break; 1367 case 0x52: /* CONFIG */ 1368 res = i2c_smbus_read_byte_data(cl, 1); 1369 break; 1370 case 0x53: /* HYST */ 1371 res = swab16(i2c_smbus_read_word_data(cl, 2)); 1372 break; 1373 case 0x55: /* OVER */ 1374 default: 1375 res = swab16(i2c_smbus_read_word_data(cl, 3)); 1376 break; 1377 } 1378 } 1379 if (bank > 2) 1380 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0); 1381 } 1382 up(&data->lock); 1383 return res; 1384 } 1385 1386 static int 1387 w83781d_write_value(struct i2c_client *client, u16 reg, u16 value) 1388 { 1389 struct w83781d_data *data = i2c_get_clientdata(client); 1390 int word_sized, bank; 1391 struct i2c_client *cl; 1392 1393 down(&data->lock); 1394 if (i2c_is_isa_client(client)) { 1395 word_sized = (((reg & 0xff00) == 0x100) 1396 || ((reg & 0xff00) == 0x200)) 1397 && (((reg & 0x00ff) == 0x53) 1398 || ((reg & 0x00ff) == 0x55)); 1399 if (reg & 0xff00) { 1400 outb_p(W83781D_REG_BANK, 1401 client->addr + W83781D_ADDR_REG_OFFSET); 1402 outb_p(reg >> 8, 1403 client->addr + W83781D_DATA_REG_OFFSET); 1404 } 1405 outb_p(reg & 0xff, client->addr + W83781D_ADDR_REG_OFFSET); 1406 if (word_sized) { 1407 outb_p(value >> 8, 1408 client->addr + W83781D_DATA_REG_OFFSET); 1409 outb_p((reg & 0xff) + 1, 1410 client->addr + W83781D_ADDR_REG_OFFSET); 1411 } 1412 outb_p(value & 0xff, client->addr + W83781D_DATA_REG_OFFSET); 1413 if (reg & 0xff00) { 1414 outb_p(W83781D_REG_BANK, 1415 client->addr + W83781D_ADDR_REG_OFFSET); 1416 outb_p(0, client->addr + W83781D_DATA_REG_OFFSET); 1417 } 1418 } else { 1419 bank = (reg >> 8) & 0x0f; 1420 if (bank > 2) 1421 /* switch banks */ 1422 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 1423 bank); 1424 if (bank == 0 || bank > 2) { 1425 i2c_smbus_write_byte_data(client, reg & 0xff, 1426 value & 0xff); 1427 } else { 1428 /* switch to subclient */ 1429 cl = data->lm75[bank - 1]; 1430 /* convert from ISA to LM75 I2C addresses */ 1431 switch (reg & 0xff) { 1432 case 0x52: /* CONFIG */ 1433 i2c_smbus_write_byte_data(cl, 1, value & 0xff); 1434 break; 1435 case 0x53: /* HYST */ 1436 i2c_smbus_write_word_data(cl, 2, swab16(value)); 1437 break; 1438 case 0x55: /* OVER */ 1439 i2c_smbus_write_word_data(cl, 3, swab16(value)); 1440 break; 1441 } 1442 } 1443 if (bank > 2) 1444 i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0); 1445 } 1446 up(&data->lock); 1447 return 0; 1448 } 1449 1450 static void 1451 w83781d_init_client(struct i2c_client *client) 1452 { 1453 struct w83781d_data *data = i2c_get_clientdata(client); 1454 int i, p; 1455 int type = data->type; 1456 u8 tmp; 1457 1458 if (init && type != as99127f) { /* this resets registers we don't have 1459 documentation for on the as99127f */ 1460 /* save these registers */ 1461 i = w83781d_read_value(client, W83781D_REG_BEEP_CONFIG); 1462 p = w83781d_read_value(client, W83781D_REG_PWMCLK12); 1463 /* Reset all except Watchdog values and last conversion values 1464 This sets fan-divs to 2, among others */ 1465 w83781d_write_value(client, W83781D_REG_CONFIG, 0x80); 1466 /* Restore the registers and disable power-on abnormal beep. 1467 This saves FAN 1/2/3 input/output values set by BIOS. */ 1468 w83781d_write_value(client, W83781D_REG_BEEP_CONFIG, i | 0x80); 1469 w83781d_write_value(client, W83781D_REG_PWMCLK12, p); 1470 /* Disable master beep-enable (reset turns it on). 1471 Individual beep_mask should be reset to off but for some reason 1472 disabling this bit helps some people not get beeped */ 1473 w83781d_write_value(client, W83781D_REG_BEEP_INTS2, 0); 1474 } 1475 1476 data->vrm = vid_which_vrm(); 1477 1478 if ((type != w83781d) && (type != as99127f)) { 1479 tmp = w83781d_read_value(client, W83781D_REG_SCFG1); 1480 for (i = 1; i <= 3; i++) { 1481 if (!(tmp & BIT_SCFG1[i - 1])) { 1482 data->sens[i - 1] = W83781D_DEFAULT_BETA; 1483 } else { 1484 if (w83781d_read_value 1485 (client, 1486 W83781D_REG_SCFG2) & BIT_SCFG2[i - 1]) 1487 data->sens[i - 1] = 1; 1488 else 1489 data->sens[i - 1] = 2; 1490 } 1491 if (type == w83783s && i == 2) 1492 break; 1493 } 1494 } 1495 1496 if (init && type != as99127f) { 1497 /* Enable temp2 */ 1498 tmp = w83781d_read_value(client, W83781D_REG_TEMP2_CONFIG); 1499 if (tmp & 0x01) { 1500 dev_warn(&client->dev, "Enabling temp2, readings " 1501 "might not make sense\n"); 1502 w83781d_write_value(client, W83781D_REG_TEMP2_CONFIG, 1503 tmp & 0xfe); 1504 } 1505 1506 /* Enable temp3 */ 1507 if (type != w83783s) { 1508 tmp = w83781d_read_value(client, 1509 W83781D_REG_TEMP3_CONFIG); 1510 if (tmp & 0x01) { 1511 dev_warn(&client->dev, "Enabling temp3, " 1512 "readings might not make sense\n"); 1513 w83781d_write_value(client, 1514 W83781D_REG_TEMP3_CONFIG, tmp & 0xfe); 1515 } 1516 } 1517 1518 if (type != w83781d) { 1519 /* enable comparator mode for temp2 and temp3 so 1520 alarm indication will work correctly */ 1521 i = w83781d_read_value(client, W83781D_REG_IRQ); 1522 if (!(i & 0x40)) 1523 w83781d_write_value(client, W83781D_REG_IRQ, 1524 i | 0x40); 1525 } 1526 } 1527 1528 /* Start monitoring */ 1529 w83781d_write_value(client, W83781D_REG_CONFIG, 1530 (w83781d_read_value(client, 1531 W83781D_REG_CONFIG) & 0xf7) 1532 | 0x01); 1533 } 1534 1535 static struct w83781d_data *w83781d_update_device(struct device *dev) 1536 { 1537 struct i2c_client *client = to_i2c_client(dev); 1538 struct w83781d_data *data = i2c_get_clientdata(client); 1539 int i; 1540 1541 down(&data->update_lock); 1542 1543 if (time_after(jiffies, data->last_updated + HZ + HZ / 2) 1544 || !data->valid) { 1545 dev_dbg(dev, "Starting device update\n"); 1546 1547 for (i = 0; i <= 8; i++) { 1548 if (data->type == w83783s && i == 1) 1549 continue; /* 783S has no in1 */ 1550 data->in[i] = 1551 w83781d_read_value(client, W83781D_REG_IN(i)); 1552 data->in_min[i] = 1553 w83781d_read_value(client, W83781D_REG_IN_MIN(i)); 1554 data->in_max[i] = 1555 w83781d_read_value(client, W83781D_REG_IN_MAX(i)); 1556 if ((data->type != w83782d) 1557 && (data->type != w83627hf) && (i == 6)) 1558 break; 1559 } 1560 for (i = 1; i <= 3; i++) { 1561 data->fan[i - 1] = 1562 w83781d_read_value(client, W83781D_REG_FAN(i)); 1563 data->fan_min[i - 1] = 1564 w83781d_read_value(client, W83781D_REG_FAN_MIN(i)); 1565 } 1566 if (data->type != w83781d && data->type != as99127f) { 1567 for (i = 1; i <= 4; i++) { 1568 data->pwm[i - 1] = 1569 w83781d_read_value(client, 1570 W83781D_REG_PWM(i)); 1571 if ((data->type != w83782d 1572 || i2c_is_isa_client(client)) 1573 && i == 2) 1574 break; 1575 } 1576 /* Only PWM2 can be disabled */ 1577 data->pwmenable[1] = (w83781d_read_value(client, 1578 W83781D_REG_PWMCLK12) & 0x08) >> 3; 1579 } 1580 1581 data->temp = w83781d_read_value(client, W83781D_REG_TEMP(1)); 1582 data->temp_max = 1583 w83781d_read_value(client, W83781D_REG_TEMP_OVER(1)); 1584 data->temp_max_hyst = 1585 w83781d_read_value(client, W83781D_REG_TEMP_HYST(1)); 1586 data->temp_add[0] = 1587 w83781d_read_value(client, W83781D_REG_TEMP(2)); 1588 data->temp_max_add[0] = 1589 w83781d_read_value(client, W83781D_REG_TEMP_OVER(2)); 1590 data->temp_max_hyst_add[0] = 1591 w83781d_read_value(client, W83781D_REG_TEMP_HYST(2)); 1592 if (data->type != w83783s) { 1593 data->temp_add[1] = 1594 w83781d_read_value(client, W83781D_REG_TEMP(3)); 1595 data->temp_max_add[1] = 1596 w83781d_read_value(client, 1597 W83781D_REG_TEMP_OVER(3)); 1598 data->temp_max_hyst_add[1] = 1599 w83781d_read_value(client, 1600 W83781D_REG_TEMP_HYST(3)); 1601 } 1602 i = w83781d_read_value(client, W83781D_REG_VID_FANDIV); 1603 data->vid = i & 0x0f; 1604 data->vid |= (w83781d_read_value(client, 1605 W83781D_REG_CHIPID) & 0x01) << 4; 1606 data->fan_div[0] = (i >> 4) & 0x03; 1607 data->fan_div[1] = (i >> 6) & 0x03; 1608 data->fan_div[2] = (w83781d_read_value(client, 1609 W83781D_REG_PIN) >> 6) & 0x03; 1610 if ((data->type != w83781d) && (data->type != as99127f)) { 1611 i = w83781d_read_value(client, W83781D_REG_VBAT); 1612 data->fan_div[0] |= (i >> 3) & 0x04; 1613 data->fan_div[1] |= (i >> 4) & 0x04; 1614 data->fan_div[2] |= (i >> 5) & 0x04; 1615 } 1616 data->alarms = 1617 w83781d_read_value(client, 1618 W83781D_REG_ALARM1) + 1619 (w83781d_read_value(client, W83781D_REG_ALARM2) << 8); 1620 if ((data->type == w83782d) || (data->type == w83627hf)) { 1621 data->alarms |= 1622 w83781d_read_value(client, 1623 W83781D_REG_ALARM3) << 16; 1624 } 1625 i = w83781d_read_value(client, W83781D_REG_BEEP_INTS2); 1626 data->beep_enable = i >> 7; 1627 data->beep_mask = ((i & 0x7f) << 8) + 1628 w83781d_read_value(client, W83781D_REG_BEEP_INTS1); 1629 if ((data->type != w83781d) && (data->type != as99127f)) { 1630 data->beep_mask |= 1631 w83781d_read_value(client, 1632 W83781D_REG_BEEP_INTS3) << 16; 1633 } 1634 data->last_updated = jiffies; 1635 data->valid = 1; 1636 } 1637 1638 up(&data->update_lock); 1639 1640 return data; 1641 } 1642 1643 static int __init 1644 sensors_w83781d_init(void) 1645 { 1646 int res; 1647 1648 res = i2c_add_driver(&w83781d_driver); 1649 if (res) 1650 return res; 1651 1652 res = i2c_isa_add_driver(&w83781d_isa_driver); 1653 if (res) { 1654 i2c_del_driver(&w83781d_driver); 1655 return res; 1656 } 1657 1658 return 0; 1659 } 1660 1661 static void __exit 1662 sensors_w83781d_exit(void) 1663 { 1664 i2c_isa_del_driver(&w83781d_isa_driver); 1665 i2c_del_driver(&w83781d_driver); 1666 } 1667 1668 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, " 1669 "Philip Edelbrock <phil@netroedge.com>, " 1670 "and Mark Studebaker <mdsxyz123@yahoo.com>"); 1671 MODULE_DESCRIPTION("W83781D driver"); 1672 MODULE_LICENSE("GPL"); 1673 1674 module_init(sensors_w83781d_init); 1675 module_exit(sensors_w83781d_exit); 1676