1 /* 2 * f75375s.c - driver for the Fintek F75375/SP and F75373 3 * hardware monitoring features 4 * Copyright (C) 2006-2007 Riku Voipio <riku.voipio@movial.fi> 5 * 6 * Datasheets available at: 7 * 8 * f75375: 9 * http://www.fintek.com.tw/files/productfiles/2005111152950.pdf 10 * 11 * f75373: 12 * http://www.fintek.com.tw/files/productfiles/2005111153128.pdf 13 * 14 * This program is free software; you can redistribute it and/or modify 15 * it under the terms of the GNU General Public License as published by 16 * the Free Software Foundation; either version 2 of the License, or 17 * (at your option) any later version. 18 * 19 * This program is distributed in the hope that it will be useful, 20 * but WITHOUT ANY WARRANTY; without even the implied warranty of 21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 22 * GNU General Public License for more details. 23 * 24 * You should have received a copy of the GNU General Public License 25 * along with this program; if not, write to the Free Software 26 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 27 * 28 */ 29 30 #include <linux/module.h> 31 #include <linux/jiffies.h> 32 #include <linux/hwmon.h> 33 #include <linux/hwmon-sysfs.h> 34 #include <linux/i2c.h> 35 #include <linux/err.h> 36 #include <linux/mutex.h> 37 #include <linux/f75375s.h> 38 39 /* Addresses to scan */ 40 static unsigned short normal_i2c[] = { 0x2d, 0x2e, I2C_CLIENT_END }; 41 42 /* Insmod parameters */ 43 I2C_CLIENT_INSMOD_2(f75373, f75375); 44 45 /* Fintek F75375 registers */ 46 #define F75375_REG_CONFIG0 0x0 47 #define F75375_REG_CONFIG1 0x1 48 #define F75375_REG_CONFIG2 0x2 49 #define F75375_REG_CONFIG3 0x3 50 #define F75375_REG_ADDR 0x4 51 #define F75375_REG_INTR 0x31 52 #define F75375_CHIP_ID 0x5A 53 #define F75375_REG_VERSION 0x5C 54 #define F75375_REG_VENDOR 0x5D 55 #define F75375_REG_FAN_TIMER 0x60 56 57 #define F75375_REG_VOLT(nr) (0x10 + (nr)) 58 #define F75375_REG_VOLT_HIGH(nr) (0x20 + (nr) * 2) 59 #define F75375_REG_VOLT_LOW(nr) (0x21 + (nr) * 2) 60 61 #define F75375_REG_TEMP(nr) (0x14 + (nr)) 62 #define F75375_REG_TEMP_HIGH(nr) (0x28 + (nr) * 2) 63 #define F75375_REG_TEMP_HYST(nr) (0x29 + (nr) * 2) 64 65 #define F75375_REG_FAN(nr) (0x16 + (nr) * 2) 66 #define F75375_REG_FAN_MIN(nr) (0x2C + (nr) * 2) 67 #define F75375_REG_FAN_FULL(nr) (0x70 + (nr) * 0x10) 68 #define F75375_REG_FAN_PWM_DUTY(nr) (0x76 + (nr) * 0x10) 69 #define F75375_REG_FAN_PWM_CLOCK(nr) (0x7D + (nr) * 0x10) 70 71 #define F75375_REG_FAN_EXP(nr) (0x74 + (nr) * 0x10) 72 #define F75375_REG_FAN_B_TEMP(nr, step) ((0xA0 + (nr) * 0x10) + (step)) 73 #define F75375_REG_FAN_B_SPEED(nr, step) \ 74 ((0xA5 + (nr) * 0x10) + (step) * 2) 75 76 #define F75375_REG_PWM1_RAISE_DUTY 0x69 77 #define F75375_REG_PWM2_RAISE_DUTY 0x6A 78 #define F75375_REG_PWM1_DROP_DUTY 0x6B 79 #define F75375_REG_PWM2_DROP_DUTY 0x6C 80 81 #define FAN_CTRL_LINEAR(nr) (4 + nr) 82 #define FAN_CTRL_MODE(nr) (5 + ((nr) * 2)) 83 84 /* 85 * Data structures and manipulation thereof 86 */ 87 88 struct f75375_data { 89 unsigned short addr; 90 struct i2c_client *client; 91 struct device *hwmon_dev; 92 93 const char *name; 94 int kind; 95 struct mutex update_lock; /* protect register access */ 96 char valid; 97 unsigned long last_updated; /* In jiffies */ 98 unsigned long last_limits; /* In jiffies */ 99 100 /* Register values */ 101 u8 in[4]; 102 u8 in_max[4]; 103 u8 in_min[4]; 104 u16 fan[2]; 105 u16 fan_min[2]; 106 u16 fan_full[2]; 107 u16 fan_exp[2]; 108 u8 fan_timer; 109 u8 pwm[2]; 110 u8 pwm_mode[2]; 111 u8 pwm_enable[2]; 112 s8 temp[2]; 113 s8 temp_high[2]; 114 s8 temp_max_hyst[2]; 115 }; 116 117 static int f75375_attach_adapter(struct i2c_adapter *adapter); 118 static int f75375_detect(struct i2c_adapter *adapter, int address, int kind); 119 static int f75375_detach_client(struct i2c_client *client); 120 static int f75375_probe(struct i2c_client *client); 121 static int f75375_remove(struct i2c_client *client); 122 123 static struct i2c_driver f75375_legacy_driver = { 124 .driver = { 125 .name = "f75375_legacy", 126 }, 127 .attach_adapter = f75375_attach_adapter, 128 .detach_client = f75375_detach_client, 129 }; 130 131 static struct i2c_driver f75375_driver = { 132 .driver = { 133 .name = "f75375", 134 }, 135 .probe = f75375_probe, 136 .remove = f75375_remove, 137 }; 138 139 static inline int f75375_read8(struct i2c_client *client, u8 reg) 140 { 141 return i2c_smbus_read_byte_data(client, reg); 142 } 143 144 /* in most cases, should be called while holding update_lock */ 145 static inline u16 f75375_read16(struct i2c_client *client, u8 reg) 146 { 147 return ((i2c_smbus_read_byte_data(client, reg) << 8) 148 | i2c_smbus_read_byte_data(client, reg + 1)); 149 } 150 151 static inline void f75375_write8(struct i2c_client *client, u8 reg, 152 u8 value) 153 { 154 i2c_smbus_write_byte_data(client, reg, value); 155 } 156 157 static inline void f75375_write16(struct i2c_client *client, u8 reg, 158 u16 value) 159 { 160 int err = i2c_smbus_write_byte_data(client, reg, (value << 8)); 161 if (err) 162 return; 163 i2c_smbus_write_byte_data(client, reg + 1, (value & 0xFF)); 164 } 165 166 static struct f75375_data *f75375_update_device(struct device *dev) 167 { 168 struct i2c_client *client = to_i2c_client(dev); 169 struct f75375_data *data = i2c_get_clientdata(client); 170 int nr; 171 172 mutex_lock(&data->update_lock); 173 174 /* Limit registers cache is refreshed after 60 seconds */ 175 if (time_after(jiffies, data->last_limits + 60 * HZ) 176 || !data->valid) { 177 for (nr = 0; nr < 2; nr++) { 178 data->temp_high[nr] = 179 f75375_read8(client, F75375_REG_TEMP_HIGH(nr)); 180 data->temp_max_hyst[nr] = 181 f75375_read8(client, F75375_REG_TEMP_HYST(nr)); 182 data->fan_full[nr] = 183 f75375_read16(client, F75375_REG_FAN_FULL(nr)); 184 data->fan_min[nr] = 185 f75375_read16(client, F75375_REG_FAN_MIN(nr)); 186 data->fan_exp[nr] = 187 f75375_read16(client, F75375_REG_FAN_EXP(nr)); 188 data->pwm[nr] = f75375_read8(client, 189 F75375_REG_FAN_PWM_DUTY(nr)); 190 191 } 192 for (nr = 0; nr < 4; nr++) { 193 data->in_max[nr] = 194 f75375_read8(client, F75375_REG_VOLT_HIGH(nr)); 195 data->in_min[nr] = 196 f75375_read8(client, F75375_REG_VOLT_LOW(nr)); 197 } 198 data->fan_timer = f75375_read8(client, F75375_REG_FAN_TIMER); 199 data->last_limits = jiffies; 200 } 201 202 /* Measurement registers cache is refreshed after 2 second */ 203 if (time_after(jiffies, data->last_updated + 2 * HZ) 204 || !data->valid) { 205 for (nr = 0; nr < 2; nr++) { 206 data->temp[nr] = 207 f75375_read8(client, F75375_REG_TEMP(nr)); 208 data->fan[nr] = 209 f75375_read16(client, F75375_REG_FAN(nr)); 210 } 211 for (nr = 0; nr < 4; nr++) 212 data->in[nr] = 213 f75375_read8(client, F75375_REG_VOLT(nr)); 214 215 data->last_updated = jiffies; 216 data->valid = 1; 217 } 218 219 mutex_unlock(&data->update_lock); 220 return data; 221 } 222 223 static inline u16 rpm_from_reg(u16 reg) 224 { 225 if (reg == 0 || reg == 0xffff) 226 return 0; 227 return (1500000 / reg); 228 } 229 230 static inline u16 rpm_to_reg(int rpm) 231 { 232 if (rpm < 367 || rpm > 0xffff) 233 return 0xffff; 234 return (1500000 / rpm); 235 } 236 237 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, 238 const char *buf, size_t count) 239 { 240 int nr = to_sensor_dev_attr(attr)->index; 241 struct i2c_client *client = to_i2c_client(dev); 242 struct f75375_data *data = i2c_get_clientdata(client); 243 int val = simple_strtoul(buf, NULL, 10); 244 245 mutex_lock(&data->update_lock); 246 data->fan_min[nr] = rpm_to_reg(val); 247 f75375_write16(client, F75375_REG_FAN_MIN(nr), data->fan_min[nr]); 248 mutex_unlock(&data->update_lock); 249 return count; 250 } 251 252 static ssize_t set_fan_exp(struct device *dev, struct device_attribute *attr, 253 const char *buf, size_t count) 254 { 255 int nr = to_sensor_dev_attr(attr)->index; 256 struct i2c_client *client = to_i2c_client(dev); 257 struct f75375_data *data = i2c_get_clientdata(client); 258 int val = simple_strtoul(buf, NULL, 10); 259 260 mutex_lock(&data->update_lock); 261 data->fan_exp[nr] = rpm_to_reg(val); 262 f75375_write16(client, F75375_REG_FAN_EXP(nr), data->fan_exp[nr]); 263 mutex_unlock(&data->update_lock); 264 return count; 265 } 266 267 static ssize_t set_pwm(struct device *dev, struct device_attribute *attr, 268 const char *buf, size_t count) 269 { 270 int nr = to_sensor_dev_attr(attr)->index; 271 struct i2c_client *client = to_i2c_client(dev); 272 struct f75375_data *data = i2c_get_clientdata(client); 273 int val = simple_strtoul(buf, NULL, 10); 274 275 mutex_lock(&data->update_lock); 276 data->pwm[nr] = SENSORS_LIMIT(val, 0, 255); 277 f75375_write8(client, F75375_REG_FAN_PWM_DUTY(nr), data->pwm[nr]); 278 mutex_unlock(&data->update_lock); 279 return count; 280 } 281 282 static ssize_t show_pwm_enable(struct device *dev, struct device_attribute 283 *attr, char *buf) 284 { 285 int nr = to_sensor_dev_attr(attr)->index; 286 struct f75375_data *data = f75375_update_device(dev); 287 return sprintf(buf, "%d\n", data->pwm_enable[nr]); 288 } 289 290 static int set_pwm_enable_direct(struct i2c_client *client, int nr, int val) 291 { 292 struct f75375_data *data = i2c_get_clientdata(client); 293 u8 fanmode; 294 295 if (val < 0 || val > 4) 296 return -EINVAL; 297 298 fanmode = f75375_read8(client, F75375_REG_FAN_TIMER); 299 fanmode = ~(3 << FAN_CTRL_MODE(nr)); 300 301 switch (val) { 302 case 0: /* Full speed */ 303 fanmode |= (3 << FAN_CTRL_MODE(nr)); 304 data->pwm[nr] = 255; 305 f75375_write8(client, F75375_REG_FAN_PWM_DUTY(nr), 306 data->pwm[nr]); 307 break; 308 case 1: /* PWM */ 309 fanmode |= (3 << FAN_CTRL_MODE(nr)); 310 break; 311 case 2: /* AUTOMATIC*/ 312 fanmode |= (2 << FAN_CTRL_MODE(nr)); 313 break; 314 case 3: /* fan speed */ 315 break; 316 } 317 f75375_write8(client, F75375_REG_FAN_TIMER, fanmode); 318 data->pwm_enable[nr] = val; 319 return 0; 320 } 321 322 static ssize_t set_pwm_enable(struct device *dev, struct device_attribute *attr, 323 const char *buf, size_t count) 324 { 325 int nr = to_sensor_dev_attr(attr)->index; 326 struct i2c_client *client = to_i2c_client(dev); 327 struct f75375_data *data = i2c_get_clientdata(client); 328 int val = simple_strtoul(buf, NULL, 10); 329 int err = 0; 330 331 mutex_lock(&data->update_lock); 332 err = set_pwm_enable_direct(client, nr, val); 333 mutex_unlock(&data->update_lock); 334 return err ? err : count; 335 } 336 337 static ssize_t set_pwm_mode(struct device *dev, struct device_attribute *attr, 338 const char *buf, size_t count) 339 { 340 int nr = to_sensor_dev_attr(attr)->index; 341 struct i2c_client *client = to_i2c_client(dev); 342 struct f75375_data *data = i2c_get_clientdata(client); 343 int val = simple_strtoul(buf, NULL, 10); 344 u8 conf = 0; 345 346 if (!(val == 0 || val == 1)) 347 return -EINVAL; 348 349 mutex_lock(&data->update_lock); 350 conf = f75375_read8(client, F75375_REG_CONFIG1); 351 conf = ~(1 << FAN_CTRL_LINEAR(nr)); 352 353 if (val == 0) 354 conf |= (1 << FAN_CTRL_LINEAR(nr)) ; 355 356 f75375_write8(client, F75375_REG_CONFIG1, conf); 357 data->pwm_mode[nr] = val; 358 mutex_unlock(&data->update_lock); 359 return count; 360 } 361 362 static ssize_t show_pwm(struct device *dev, struct device_attribute 363 *attr, char *buf) 364 { 365 int nr = to_sensor_dev_attr(attr)->index; 366 struct f75375_data *data = f75375_update_device(dev); 367 return sprintf(buf, "%d\n", data->pwm[nr]); 368 } 369 370 static ssize_t show_pwm_mode(struct device *dev, struct device_attribute 371 *attr, char *buf) 372 { 373 int nr = to_sensor_dev_attr(attr)->index; 374 struct f75375_data *data = f75375_update_device(dev); 375 return sprintf(buf, "%d\n", data->pwm_mode[nr]); 376 } 377 378 #define VOLT_FROM_REG(val) ((val) * 8) 379 #define VOLT_TO_REG(val) ((val) / 8) 380 381 static ssize_t show_in(struct device *dev, struct device_attribute *attr, 382 char *buf) 383 { 384 int nr = to_sensor_dev_attr(attr)->index; 385 struct f75375_data *data = f75375_update_device(dev); 386 return sprintf(buf, "%d\n", VOLT_FROM_REG(data->in[nr])); 387 } 388 389 static ssize_t show_in_max(struct device *dev, struct device_attribute *attr, 390 char *buf) 391 { 392 int nr = to_sensor_dev_attr(attr)->index; 393 struct f75375_data *data = f75375_update_device(dev); 394 return sprintf(buf, "%d\n", VOLT_FROM_REG(data->in_max[nr])); 395 } 396 397 static ssize_t show_in_min(struct device *dev, struct device_attribute *attr, 398 char *buf) 399 { 400 int nr = to_sensor_dev_attr(attr)->index; 401 struct f75375_data *data = f75375_update_device(dev); 402 return sprintf(buf, "%d\n", VOLT_FROM_REG(data->in_min[nr])); 403 } 404 405 static ssize_t set_in_max(struct device *dev, struct device_attribute *attr, 406 const char *buf, size_t count) 407 { 408 int nr = to_sensor_dev_attr(attr)->index; 409 struct i2c_client *client = to_i2c_client(dev); 410 struct f75375_data *data = i2c_get_clientdata(client); 411 int val = simple_strtoul(buf, NULL, 10); 412 val = SENSORS_LIMIT(VOLT_TO_REG(val), 0, 0xff); 413 mutex_lock(&data->update_lock); 414 data->in_max[nr] = val; 415 f75375_write8(client, F75375_REG_VOLT_HIGH(nr), data->in_max[nr]); 416 mutex_unlock(&data->update_lock); 417 return count; 418 } 419 420 static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, 421 const char *buf, size_t count) 422 { 423 int nr = to_sensor_dev_attr(attr)->index; 424 struct i2c_client *client = to_i2c_client(dev); 425 struct f75375_data *data = i2c_get_clientdata(client); 426 int val = simple_strtoul(buf, NULL, 10); 427 val = SENSORS_LIMIT(VOLT_TO_REG(val), 0, 0xff); 428 mutex_lock(&data->update_lock); 429 data->in_min[nr] = val; 430 f75375_write8(client, F75375_REG_VOLT_LOW(nr), data->in_min[nr]); 431 mutex_unlock(&data->update_lock); 432 return count; 433 } 434 #define TEMP_FROM_REG(val) ((val) * 1000) 435 #define TEMP_TO_REG(val) ((val) / 1000) 436 437 static ssize_t show_temp(struct device *dev, struct device_attribute *attr, 438 char *buf) 439 { 440 int nr = to_sensor_dev_attr(attr)->index; 441 struct f75375_data *data = f75375_update_device(dev); 442 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr])); 443 } 444 445 static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr, 446 char *buf) 447 { 448 int nr = to_sensor_dev_attr(attr)->index; 449 struct f75375_data *data = f75375_update_device(dev); 450 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_high[nr])); 451 } 452 453 static ssize_t show_temp_max_hyst(struct device *dev, 454 struct device_attribute *attr, char *buf) 455 { 456 int nr = to_sensor_dev_attr(attr)->index; 457 struct f75375_data *data = f75375_update_device(dev); 458 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max_hyst[nr])); 459 } 460 461 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, 462 const char *buf, size_t count) 463 { 464 int nr = to_sensor_dev_attr(attr)->index; 465 struct i2c_client *client = to_i2c_client(dev); 466 struct f75375_data *data = i2c_get_clientdata(client); 467 int val = simple_strtol(buf, NULL, 10); 468 val = SENSORS_LIMIT(TEMP_TO_REG(val), 0, 127); 469 mutex_lock(&data->update_lock); 470 data->temp_high[nr] = val; 471 f75375_write8(client, F75375_REG_TEMP_HIGH(nr), data->temp_high[nr]); 472 mutex_unlock(&data->update_lock); 473 return count; 474 } 475 476 static ssize_t set_temp_max_hyst(struct device *dev, 477 struct device_attribute *attr, const char *buf, size_t count) 478 { 479 int nr = to_sensor_dev_attr(attr)->index; 480 struct i2c_client *client = to_i2c_client(dev); 481 struct f75375_data *data = i2c_get_clientdata(client); 482 int val = simple_strtol(buf, NULL, 10); 483 val = SENSORS_LIMIT(TEMP_TO_REG(val), 0, 127); 484 mutex_lock(&data->update_lock); 485 data->temp_max_hyst[nr] = val; 486 f75375_write8(client, F75375_REG_TEMP_HYST(nr), 487 data->temp_max_hyst[nr]); 488 mutex_unlock(&data->update_lock); 489 return count; 490 } 491 492 #define show_fan(thing) \ 493 static ssize_t show_##thing(struct device *dev, struct device_attribute *attr, \ 494 char *buf)\ 495 {\ 496 int nr = to_sensor_dev_attr(attr)->index;\ 497 struct f75375_data *data = f75375_update_device(dev); \ 498 return sprintf(buf, "%d\n", rpm_from_reg(data->thing[nr])); \ 499 } 500 501 show_fan(fan); 502 show_fan(fan_min); 503 show_fan(fan_full); 504 show_fan(fan_exp); 505 506 static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, show_in, NULL, 0); 507 static SENSOR_DEVICE_ATTR(in0_max, S_IRUGO|S_IWUSR, 508 show_in_max, set_in_max, 0); 509 static SENSOR_DEVICE_ATTR(in0_min, S_IRUGO|S_IWUSR, 510 show_in_min, set_in_min, 0); 511 static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, show_in, NULL, 1); 512 static SENSOR_DEVICE_ATTR(in1_max, S_IRUGO|S_IWUSR, 513 show_in_max, set_in_max, 1); 514 static SENSOR_DEVICE_ATTR(in1_min, S_IRUGO|S_IWUSR, 515 show_in_min, set_in_min, 1); 516 static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, show_in, NULL, 2); 517 static SENSOR_DEVICE_ATTR(in2_max, S_IRUGO|S_IWUSR, 518 show_in_max, set_in_max, 2); 519 static SENSOR_DEVICE_ATTR(in2_min, S_IRUGO|S_IWUSR, 520 show_in_min, set_in_min, 2); 521 static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, show_in, NULL, 3); 522 static SENSOR_DEVICE_ATTR(in3_max, S_IRUGO|S_IWUSR, 523 show_in_max, set_in_max, 3); 524 static SENSOR_DEVICE_ATTR(in3_min, S_IRUGO|S_IWUSR, 525 show_in_min, set_in_min, 3); 526 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0); 527 static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IRUGO|S_IWUSR, 528 show_temp_max_hyst, set_temp_max_hyst, 0); 529 static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO|S_IWUSR, 530 show_temp_max, set_temp_max, 0); 531 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1); 532 static SENSOR_DEVICE_ATTR(temp2_max_hyst, S_IRUGO|S_IWUSR, 533 show_temp_max_hyst, set_temp_max_hyst, 1); 534 static SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO|S_IWUSR, 535 show_temp_max, set_temp_max, 1); 536 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0); 537 static SENSOR_DEVICE_ATTR(fan1_full, S_IRUGO, show_fan_full, NULL, 0); 538 static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO|S_IWUSR, 539 show_fan_min, set_fan_min, 0); 540 static SENSOR_DEVICE_ATTR(fan1_exp, S_IRUGO|S_IWUSR, 541 show_fan_exp, set_fan_exp, 0); 542 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1); 543 static SENSOR_DEVICE_ATTR(fan2_full, S_IRUGO, show_fan_full, NULL, 1); 544 static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO|S_IWUSR, 545 show_fan_min, set_fan_min, 1); 546 static SENSOR_DEVICE_ATTR(fan2_exp, S_IRUGO|S_IWUSR, 547 show_fan_exp, set_fan_exp, 1); 548 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO|S_IWUSR, 549 show_pwm, set_pwm, 0); 550 static SENSOR_DEVICE_ATTR(pwm1_enable, S_IRUGO|S_IWUSR, 551 show_pwm_enable, set_pwm_enable, 0); 552 static SENSOR_DEVICE_ATTR(pwm1_mode, S_IRUGO, 553 show_pwm_mode, set_pwm_mode, 0); 554 static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, 555 show_pwm, set_pwm, 1); 556 static SENSOR_DEVICE_ATTR(pwm2_enable, S_IRUGO|S_IWUSR, 557 show_pwm_enable, set_pwm_enable, 1); 558 static SENSOR_DEVICE_ATTR(pwm2_mode, S_IRUGO, 559 show_pwm_mode, set_pwm_mode, 1); 560 561 static struct attribute *f75375_attributes[] = { 562 &sensor_dev_attr_temp1_input.dev_attr.attr, 563 &sensor_dev_attr_temp1_max.dev_attr.attr, 564 &sensor_dev_attr_temp1_max_hyst.dev_attr.attr, 565 &sensor_dev_attr_temp2_input.dev_attr.attr, 566 &sensor_dev_attr_temp2_max.dev_attr.attr, 567 &sensor_dev_attr_temp2_max_hyst.dev_attr.attr, 568 &sensor_dev_attr_fan1_input.dev_attr.attr, 569 &sensor_dev_attr_fan1_full.dev_attr.attr, 570 &sensor_dev_attr_fan1_min.dev_attr.attr, 571 &sensor_dev_attr_fan1_exp.dev_attr.attr, 572 &sensor_dev_attr_fan2_input.dev_attr.attr, 573 &sensor_dev_attr_fan2_full.dev_attr.attr, 574 &sensor_dev_attr_fan2_min.dev_attr.attr, 575 &sensor_dev_attr_fan2_exp.dev_attr.attr, 576 &sensor_dev_attr_pwm1.dev_attr.attr, 577 &sensor_dev_attr_pwm1_enable.dev_attr.attr, 578 &sensor_dev_attr_pwm1_mode.dev_attr.attr, 579 &sensor_dev_attr_pwm2.dev_attr.attr, 580 &sensor_dev_attr_pwm2_enable.dev_attr.attr, 581 &sensor_dev_attr_pwm2_mode.dev_attr.attr, 582 &sensor_dev_attr_in0_input.dev_attr.attr, 583 &sensor_dev_attr_in0_max.dev_attr.attr, 584 &sensor_dev_attr_in0_min.dev_attr.attr, 585 &sensor_dev_attr_in1_input.dev_attr.attr, 586 &sensor_dev_attr_in1_max.dev_attr.attr, 587 &sensor_dev_attr_in1_min.dev_attr.attr, 588 &sensor_dev_attr_in2_input.dev_attr.attr, 589 &sensor_dev_attr_in2_max.dev_attr.attr, 590 &sensor_dev_attr_in2_min.dev_attr.attr, 591 &sensor_dev_attr_in3_input.dev_attr.attr, 592 &sensor_dev_attr_in3_max.dev_attr.attr, 593 &sensor_dev_attr_in3_min.dev_attr.attr, 594 NULL 595 }; 596 597 static const struct attribute_group f75375_group = { 598 .attrs = f75375_attributes, 599 }; 600 601 static int f75375_detach_client(struct i2c_client *client) 602 { 603 int err; 604 605 f75375_remove(client); 606 err = i2c_detach_client(client); 607 if (err) { 608 dev_err(&client->dev, 609 "Client deregistration failed, " 610 "client not detached.\n"); 611 return err; 612 } 613 kfree(client); 614 return 0; 615 } 616 617 static void f75375_init(struct i2c_client *client, struct f75375_data *data, 618 struct f75375s_platform_data *f75375s_pdata) 619 { 620 int nr; 621 set_pwm_enable_direct(client, 0, f75375s_pdata->pwm_enable[0]); 622 set_pwm_enable_direct(client, 1, f75375s_pdata->pwm_enable[1]); 623 for (nr = 0; nr < 2; nr++) { 624 data->pwm[nr] = SENSORS_LIMIT(f75375s_pdata->pwm[nr], 0, 255); 625 f75375_write8(client, F75375_REG_FAN_PWM_DUTY(nr), 626 data->pwm[nr]); 627 } 628 629 } 630 631 static int f75375_probe(struct i2c_client *client) 632 { 633 struct f75375_data *data = i2c_get_clientdata(client); 634 struct f75375s_platform_data *f75375s_pdata = client->dev.platform_data; 635 int err; 636 637 if (!i2c_check_functionality(client->adapter, 638 I2C_FUNC_SMBUS_BYTE_DATA)) 639 return -EIO; 640 if (!(data = kzalloc(sizeof(struct f75375_data), GFP_KERNEL))) 641 return -ENOMEM; 642 643 i2c_set_clientdata(client, data); 644 data->client = client; 645 mutex_init(&data->update_lock); 646 647 if (strcmp(client->name, "f75375") == 0) 648 data->kind = f75375; 649 else if (strcmp(client->name, "f75373") == 0) 650 data->kind = f75373; 651 else { 652 dev_err(&client->dev, "Unsupported device: %s\n", client->name); 653 return -ENODEV; 654 } 655 656 if ((err = sysfs_create_group(&client->dev.kobj, &f75375_group))) 657 goto exit_free; 658 659 if (data->kind == f75375) { 660 err = sysfs_chmod_file(&client->dev.kobj, 661 &sensor_dev_attr_pwm1_mode.dev_attr.attr, 662 S_IRUGO | S_IWUSR); 663 if (err) 664 goto exit_remove; 665 err = sysfs_chmod_file(&client->dev.kobj, 666 &sensor_dev_attr_pwm2_mode.dev_attr.attr, 667 S_IRUGO | S_IWUSR); 668 if (err) 669 goto exit_remove; 670 } 671 672 data->hwmon_dev = hwmon_device_register(&client->dev); 673 if (IS_ERR(data->hwmon_dev)) { 674 err = PTR_ERR(data->hwmon_dev); 675 goto exit_remove; 676 } 677 678 if (f75375s_pdata != NULL) 679 f75375_init(client, data, f75375s_pdata); 680 681 return 0; 682 683 exit_remove: 684 sysfs_remove_group(&client->dev.kobj, &f75375_group); 685 exit_free: 686 kfree(data); 687 i2c_set_clientdata(client, NULL); 688 return err; 689 } 690 691 static int f75375_remove(struct i2c_client *client) 692 { 693 struct f75375_data *data = i2c_get_clientdata(client); 694 hwmon_device_unregister(data->hwmon_dev); 695 sysfs_remove_group(&client->dev.kobj, &f75375_group); 696 kfree(data); 697 i2c_set_clientdata(client, NULL); 698 return 0; 699 } 700 701 static int f75375_attach_adapter(struct i2c_adapter *adapter) 702 { 703 if (!(adapter->class & I2C_CLASS_HWMON)) 704 return 0; 705 return i2c_probe(adapter, &addr_data, f75375_detect); 706 } 707 708 /* This function is called by i2c_probe */ 709 static int f75375_detect(struct i2c_adapter *adapter, int address, int kind) 710 { 711 struct i2c_client *client; 712 u8 version = 0; 713 int err = 0; 714 const char *name = ""; 715 716 if (!(client = kzalloc(sizeof(*client), GFP_KERNEL))) { 717 err = -ENOMEM; 718 goto exit; 719 } 720 client->addr = address; 721 client->adapter = adapter; 722 client->driver = &f75375_legacy_driver; 723 724 if (kind < 0) { 725 u16 vendid = f75375_read16(client, F75375_REG_VENDOR); 726 u16 chipid = f75375_read16(client, F75375_CHIP_ID); 727 version = f75375_read8(client, F75375_REG_VERSION); 728 if (chipid == 0x0306 && vendid == 0x1934) { 729 kind = f75375; 730 } else if (chipid == 0x0204 && vendid == 0x1934) { 731 kind = f75373; 732 } else { 733 dev_err(&adapter->dev, 734 "failed,%02X,%02X,%02X\n", 735 chipid, version, vendid); 736 goto exit_free; 737 } 738 } 739 740 if (kind == f75375) { 741 name = "f75375"; 742 } else if (kind == f75373) { 743 name = "f75373"; 744 } 745 dev_info(&adapter->dev, "found %s version: %02X\n", name, version); 746 strlcpy(client->name, name, I2C_NAME_SIZE); 747 748 if ((err = i2c_attach_client(client))) 749 goto exit_free; 750 751 if ((err = f75375_probe(client)) < 0) 752 goto exit_detach; 753 754 return 0; 755 756 exit_detach: 757 i2c_detach_client(client); 758 exit_free: 759 kfree(client); 760 exit: 761 return err; 762 } 763 764 static int __init sensors_f75375_init(void) 765 { 766 int status; 767 status = i2c_add_driver(&f75375_driver); 768 if (status) 769 return status; 770 771 status = i2c_add_driver(&f75375_legacy_driver); 772 if (status) 773 i2c_del_driver(&f75375_driver); 774 775 return status; 776 } 777 778 static void __exit sensors_f75375_exit(void) 779 { 780 i2c_del_driver(&f75375_legacy_driver); 781 i2c_del_driver(&f75375_driver); 782 } 783 784 MODULE_AUTHOR("Riku Voipio <riku.voipio@movial.fi>"); 785 MODULE_LICENSE("GPL"); 786 MODULE_DESCRIPTION("F75373/F75375 hardware monitoring driver"); 787 788 module_init(sensors_f75375_init); 789 module_exit(sensors_f75375_exit); 790