1/* 2 * fscher.c - Part of lm_sensors, Linux kernel modules for hardware 3 * monitoring 4 * Copyright (C) 2003, 2004 Reinhard Nissl <rnissl@gmx.de> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation; either version 2 of the License, or 9 * (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 19 */ 20 21/* 22 * fujitsu siemens hermes chip, 23 * module based on fscpos.c 24 * Copyright (C) 2000 Hermann Jung <hej@odn.de> 25 * Copyright (C) 1998, 1999 Frodo Looijaard <frodol@dds.nl> 26 * and Philip Edelbrock <phil@netroedge.com> 27 */ 28 29#include <linux/module.h> 30#include <linux/init.h> 31#include <linux/slab.h> 32#include <linux/jiffies.h> 33#include <linux/i2c.h> 34#include <linux/hwmon.h> 35#include <linux/err.h> 36#include <linux/mutex.h> 37#include <linux/sysfs.h> 38 39/* 40 * Addresses to scan 41 */ 42 43static unsigned short normal_i2c[] = { 0x73, I2C_CLIENT_END }; 44 45/* 46 * Insmod parameters 47 */ 48 49I2C_CLIENT_INSMOD_1(fscher); 50 51/* 52 * The FSCHER registers 53 */ 54 55/* chip identification */ 56#define FSCHER_REG_IDENT_0 0x00 57#define FSCHER_REG_IDENT_1 0x01 58#define FSCHER_REG_IDENT_2 0x02 59#define FSCHER_REG_REVISION 0x03 60 61/* global control and status */ 62#define FSCHER_REG_EVENT_STATE 0x04 63#define FSCHER_REG_CONTROL 0x05 64 65/* watchdog */ 66#define FSCHER_REG_WDOG_PRESET 0x28 67#define FSCHER_REG_WDOG_STATE 0x23 68#define FSCHER_REG_WDOG_CONTROL 0x21 69 70/* fan 0 */ 71#define FSCHER_REG_FAN0_MIN 0x55 72#define FSCHER_REG_FAN0_ACT 0x0e 73#define FSCHER_REG_FAN0_STATE 0x0d 74#define FSCHER_REG_FAN0_RIPPLE 0x0f 75 76/* fan 1 */ 77#define FSCHER_REG_FAN1_MIN 0x65 78#define FSCHER_REG_FAN1_ACT 0x6b 79#define FSCHER_REG_FAN1_STATE 0x62 80#define FSCHER_REG_FAN1_RIPPLE 0x6f 81 82/* fan 2 */ 83#define FSCHER_REG_FAN2_MIN 0xb5 84#define FSCHER_REG_FAN2_ACT 0xbb 85#define FSCHER_REG_FAN2_STATE 0xb2 86#define FSCHER_REG_FAN2_RIPPLE 0xbf 87 88/* voltage supervision */ 89#define FSCHER_REG_VOLT_12 0x45 90#define FSCHER_REG_VOLT_5 0x42 91#define FSCHER_REG_VOLT_BATT 0x48 92 93/* temperature 0 */ 94#define FSCHER_REG_TEMP0_ACT 0x64 95#define FSCHER_REG_TEMP0_STATE 0x71 96 97/* temperature 1 */ 98#define FSCHER_REG_TEMP1_ACT 0x32 99#define FSCHER_REG_TEMP1_STATE 0x81 100 101/* temperature 2 */ 102#define FSCHER_REG_TEMP2_ACT 0x35 103#define FSCHER_REG_TEMP2_STATE 0x91 104 105/* 106 * Functions declaration 107 */ 108 109static int fscher_attach_adapter(struct i2c_adapter *adapter); 110static int fscher_detect(struct i2c_adapter *adapter, int address, int kind); 111static int fscher_detach_client(struct i2c_client *client); 112static struct fscher_data *fscher_update_device(struct device *dev); 113static void fscher_init_client(struct i2c_client *client); 114 115static int fscher_read_value(struct i2c_client *client, u8 reg); 116static int fscher_write_value(struct i2c_client *client, u8 reg, u8 value); 117 118/* 119 * Driver data (common to all clients) 120 */ 121 122static struct i2c_driver fscher_driver = { 123 .driver = { 124 .name = "fscher", 125 }, 126 .id = I2C_DRIVERID_FSCHER, 127 .attach_adapter = fscher_attach_adapter, 128 .detach_client = fscher_detach_client, 129}; 130 131/* 132 * Client data (each client gets its own) 133 */ 134 135struct fscher_data { 136 struct i2c_client client; 137 struct class_device *class_dev; 138 struct mutex update_lock; 139 char valid; /* zero until following fields are valid */ 140 unsigned long last_updated; /* in jiffies */ 141 142 /* register values */ 143 u8 revision; /* revision of chip */ 144 u8 global_event; /* global event status */ 145 u8 global_control; /* global control register */ 146 u8 watchdog[3]; /* watchdog */ 147 u8 volt[3]; /* 12, 5, battery voltage */ 148 u8 temp_act[3]; /* temperature */ 149 u8 temp_status[3]; /* status of sensor */ 150 u8 fan_act[3]; /* fans revolutions per second */ 151 u8 fan_status[3]; /* fan status */ 152 u8 fan_min[3]; /* fan min value for rps */ 153 u8 fan_ripple[3]; /* divider for rps */ 154}; 155 156/* 157 * Sysfs stuff 158 */ 159 160#define sysfs_r(kind, sub, offset, reg) \ 161static ssize_t show_##kind##sub (struct fscher_data *, char *, int); \ 162static ssize_t show_##kind##offset##sub (struct device *, struct device_attribute *attr, char *); \ 163static ssize_t show_##kind##offset##sub (struct device *dev, struct device_attribute *attr, char *buf) \ 164{ \ 165 struct fscher_data *data = fscher_update_device(dev); \ 166 return show_##kind##sub(data, buf, (offset)); \ 167} 168 169#define sysfs_w(kind, sub, offset, reg) \ 170static ssize_t set_##kind##sub (struct i2c_client *, struct fscher_data *, const char *, size_t, int, int); \ 171static ssize_t set_##kind##offset##sub (struct device *, struct device_attribute *attr, const char *, size_t); \ 172static ssize_t set_##kind##offset##sub (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ 173{ \ 174 struct i2c_client *client = to_i2c_client(dev); \ 175 struct fscher_data *data = i2c_get_clientdata(client); \ 176 return set_##kind##sub(client, data, buf, count, (offset), reg); \ 177} 178 179#define sysfs_rw_n(kind, sub, offset, reg) \ 180sysfs_r(kind, sub, offset, reg) \ 181sysfs_w(kind, sub, offset, reg) \ 182static DEVICE_ATTR(kind##offset##sub, S_IRUGO | S_IWUSR, show_##kind##offset##sub, set_##kind##offset##sub); 183 184#define sysfs_rw(kind, sub, reg) \ 185sysfs_r(kind, sub, 0, reg) \ 186sysfs_w(kind, sub, 0, reg) \ 187static DEVICE_ATTR(kind##sub, S_IRUGO | S_IWUSR, show_##kind##0##sub, set_##kind##0##sub); 188 189#define sysfs_ro_n(kind, sub, offset, reg) \ 190sysfs_r(kind, sub, offset, reg) \ 191static DEVICE_ATTR(kind##offset##sub, S_IRUGO, show_##kind##offset##sub, NULL); 192 193#define sysfs_ro(kind, sub, reg) \ 194sysfs_r(kind, sub, 0, reg) \ 195static DEVICE_ATTR(kind, S_IRUGO, show_##kind##0##sub, NULL); 196 197#define sysfs_fan(offset, reg_status, reg_min, reg_ripple, reg_act) \ 198sysfs_rw_n(pwm, , offset, reg_min) \ 199sysfs_rw_n(fan, _status, offset, reg_status) \ 200sysfs_rw_n(fan, _div , offset, reg_ripple) \ 201sysfs_ro_n(fan, _input , offset, reg_act) 202 203#define sysfs_temp(offset, reg_status, reg_act) \ 204sysfs_rw_n(temp, _status, offset, reg_status) \ 205sysfs_ro_n(temp, _input , offset, reg_act) 206 207#define sysfs_in(offset, reg_act) \ 208sysfs_ro_n(in, _input, offset, reg_act) 209 210#define sysfs_revision(reg_revision) \ 211sysfs_ro(revision, , reg_revision) 212 213#define sysfs_alarms(reg_events) \ 214sysfs_ro(alarms, , reg_events) 215 216#define sysfs_control(reg_control) \ 217sysfs_rw(control, , reg_control) 218 219#define sysfs_watchdog(reg_control, reg_status, reg_preset) \ 220sysfs_rw(watchdog, _control, reg_control) \ 221sysfs_rw(watchdog, _status , reg_status) \ 222sysfs_rw(watchdog, _preset , reg_preset) 223 224sysfs_fan(1, FSCHER_REG_FAN0_STATE, FSCHER_REG_FAN0_MIN, 225 FSCHER_REG_FAN0_RIPPLE, FSCHER_REG_FAN0_ACT) 226sysfs_fan(2, FSCHER_REG_FAN1_STATE, FSCHER_REG_FAN1_MIN, 227 FSCHER_REG_FAN1_RIPPLE, FSCHER_REG_FAN1_ACT) 228sysfs_fan(3, FSCHER_REG_FAN2_STATE, FSCHER_REG_FAN2_MIN, 229 FSCHER_REG_FAN2_RIPPLE, FSCHER_REG_FAN2_ACT) 230 231sysfs_temp(1, FSCHER_REG_TEMP0_STATE, FSCHER_REG_TEMP0_ACT) 232sysfs_temp(2, FSCHER_REG_TEMP1_STATE, FSCHER_REG_TEMP1_ACT) 233sysfs_temp(3, FSCHER_REG_TEMP2_STATE, FSCHER_REG_TEMP2_ACT) 234 235sysfs_in(0, FSCHER_REG_VOLT_12) 236sysfs_in(1, FSCHER_REG_VOLT_5) 237sysfs_in(2, FSCHER_REG_VOLT_BATT) 238 239sysfs_revision(FSCHER_REG_REVISION) 240sysfs_alarms(FSCHER_REG_EVENTS) 241sysfs_control(FSCHER_REG_CONTROL) 242sysfs_watchdog(FSCHER_REG_WDOG_CONTROL, FSCHER_REG_WDOG_STATE, FSCHER_REG_WDOG_PRESET) 243 244static struct attribute *fscher_attributes[] = { 245 &dev_attr_revision.attr, 246 &dev_attr_alarms.attr, 247 &dev_attr_control.attr, 248 249 &dev_attr_watchdog_status.attr, 250 &dev_attr_watchdog_control.attr, 251 &dev_attr_watchdog_preset.attr, 252 253 &dev_attr_in0_input.attr, 254 &dev_attr_in1_input.attr, 255 &dev_attr_in2_input.attr, 256 257 &dev_attr_fan1_status.attr, 258 &dev_attr_fan1_div.attr, 259 &dev_attr_fan1_input.attr, 260 &dev_attr_pwm1.attr, 261 &dev_attr_fan2_status.attr, 262 &dev_attr_fan2_div.attr, 263 &dev_attr_fan2_input.attr, 264 &dev_attr_pwm2.attr, 265 &dev_attr_fan3_status.attr, 266 &dev_attr_fan3_div.attr, 267 &dev_attr_fan3_input.attr, 268 &dev_attr_pwm3.attr, 269 270 &dev_attr_temp1_status.attr, 271 &dev_attr_temp1_input.attr, 272 &dev_attr_temp2_status.attr, 273 &dev_attr_temp2_input.attr, 274 &dev_attr_temp3_status.attr, 275 &dev_attr_temp3_input.attr, 276 NULL 277}; 278 279static const struct attribute_group fscher_group = { 280 .attrs = fscher_attributes, 281}; 282 283/* 284 * Real code 285 */ 286 287static int fscher_attach_adapter(struct i2c_adapter *adapter) 288{ 289 if (!(adapter->class & I2C_CLASS_HWMON)) 290 return 0; 291 return i2c_probe(adapter, &addr_data, fscher_detect); 292} 293 294static int fscher_detect(struct i2c_adapter *adapter, int address, int kind) 295{ 296 struct i2c_client *new_client; 297 struct fscher_data *data; 298 int err = 0; 299 300 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 301 goto exit; 302 303 /* OK. For now, we presume we have a valid client. We now create the 304 * client structure, even though we cannot fill it completely yet. 305 * But it allows us to access i2c_smbus_read_byte_data. */ 306 if (!(data = kzalloc(sizeof(struct fscher_data), GFP_KERNEL))) { 307 err = -ENOMEM; 308 goto exit; 309 } 310 311 /* The common I2C client data is placed right before the 312 * Hermes-specific data. */ 313 new_client = &data->client; 314 i2c_set_clientdata(new_client, data); 315 new_client->addr = address; 316 new_client->adapter = adapter; 317 new_client->driver = &fscher_driver; 318 new_client->flags = 0; 319 320 /* Do the remaining detection unless force or force_fscher parameter */ 321 if (kind < 0) { 322 if ((i2c_smbus_read_byte_data(new_client, 323 FSCHER_REG_IDENT_0) != 0x48) /* 'H' */ 324 || (i2c_smbus_read_byte_data(new_client, 325 FSCHER_REG_IDENT_1) != 0x45) /* 'E' */ 326 || (i2c_smbus_read_byte_data(new_client, 327 FSCHER_REG_IDENT_2) != 0x52)) /* 'R' */ 328 goto exit_free; 329 } 330 331 /* Fill in the remaining client fields and put it into the 332 * global list */ 333 strlcpy(new_client->name, "fscher", I2C_NAME_SIZE); 334 data->valid = 0; 335 mutex_init(&data->update_lock); 336 337 /* Tell the I2C layer a new client has arrived */ 338 if ((err = i2c_attach_client(new_client))) 339 goto exit_free; 340 341 fscher_init_client(new_client); 342 343 /* Register sysfs hooks */ 344 if ((err = sysfs_create_group(&new_client->dev.kobj, &fscher_group))) 345 goto exit_detach; 346 347 data->class_dev = hwmon_device_register(&new_client->dev); 348 if (IS_ERR(data->class_dev)) { 349 err = PTR_ERR(data->class_dev); 350 goto exit_remove_files; 351 } 352 353 return 0; 354 355exit_remove_files: 356 sysfs_remove_group(&new_client->dev.kobj, &fscher_group); 357exit_detach: 358 i2c_detach_client(new_client); 359exit_free: 360 kfree(data); 361exit: 362 return err; 363} 364 365static int fscher_detach_client(struct i2c_client *client) 366{ 367 struct fscher_data *data = i2c_get_clientdata(client); 368 int err; 369 370 hwmon_device_unregister(data->class_dev); 371 sysfs_remove_group(&client->dev.kobj, &fscher_group); 372 373 if ((err = i2c_detach_client(client))) 374 return err; 375 376 kfree(data); 377 return 0; 378} 379 380static int fscher_read_value(struct i2c_client *client, u8 reg) 381{ 382 dev_dbg(&client->dev, "read reg 0x%02x\n", reg); 383 384 return i2c_smbus_read_byte_data(client, reg); 385} 386 387static int fscher_write_value(struct i2c_client *client, u8 reg, u8 value) 388{ 389 dev_dbg(&client->dev, "write reg 0x%02x, val 0x%02x\n", 390 reg, value); 391 392 return i2c_smbus_write_byte_data(client, reg, value); 393} 394 395/* Called when we have found a new FSC Hermes. */ 396static void fscher_init_client(struct i2c_client *client) 397{ 398 struct fscher_data *data = i2c_get_clientdata(client); 399 400 /* Read revision from chip */ 401 data->revision = fscher_read_value(client, FSCHER_REG_REVISION); 402} 403 404static struct fscher_data *fscher_update_device(struct device *dev) 405{ 406 struct i2c_client *client = to_i2c_client(dev); 407 struct fscher_data *data = i2c_get_clientdata(client); 408 409 mutex_lock(&data->update_lock); 410 411 if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) { 412 413 dev_dbg(&client->dev, "Starting fscher update\n"); 414 415 data->temp_act[0] = fscher_read_value(client, FSCHER_REG_TEMP0_ACT); 416 data->temp_act[1] = fscher_read_value(client, FSCHER_REG_TEMP1_ACT); 417 data->temp_act[2] = fscher_read_value(client, FSCHER_REG_TEMP2_ACT); 418 data->temp_status[0] = fscher_read_value(client, FSCHER_REG_TEMP0_STATE); 419 data->temp_status[1] = fscher_read_value(client, FSCHER_REG_TEMP1_STATE); 420 data->temp_status[2] = fscher_read_value(client, FSCHER_REG_TEMP2_STATE); 421 422 data->volt[0] = fscher_read_value(client, FSCHER_REG_VOLT_12); 423 data->volt[1] = fscher_read_value(client, FSCHER_REG_VOLT_5); 424 data->volt[2] = fscher_read_value(client, FSCHER_REG_VOLT_BATT); 425 426 data->fan_act[0] = fscher_read_value(client, FSCHER_REG_FAN0_ACT); 427 data->fan_act[1] = fscher_read_value(client, FSCHER_REG_FAN1_ACT); 428 data->fan_act[2] = fscher_read_value(client, FSCHER_REG_FAN2_ACT); 429 data->fan_status[0] = fscher_read_value(client, FSCHER_REG_FAN0_STATE); 430 data->fan_status[1] = fscher_read_value(client, FSCHER_REG_FAN1_STATE); 431 data->fan_status[2] = fscher_read_value(client, FSCHER_REG_FAN2_STATE); 432 data->fan_min[0] = fscher_read_value(client, FSCHER_REG_FAN0_MIN); 433 data->fan_min[1] = fscher_read_value(client, FSCHER_REG_FAN1_MIN); 434 data->fan_min[2] = fscher_read_value(client, FSCHER_REG_FAN2_MIN); 435 data->fan_ripple[0] = fscher_read_value(client, FSCHER_REG_FAN0_RIPPLE); 436 data->fan_ripple[1] = fscher_read_value(client, FSCHER_REG_FAN1_RIPPLE); 437 data->fan_ripple[2] = fscher_read_value(client, FSCHER_REG_FAN2_RIPPLE); 438 439 data->watchdog[0] = fscher_read_value(client, FSCHER_REG_WDOG_PRESET); 440 data->watchdog[1] = fscher_read_value(client, FSCHER_REG_WDOG_STATE); 441 data->watchdog[2] = fscher_read_value(client, FSCHER_REG_WDOG_CONTROL); 442 443 data->global_event = fscher_read_value(client, FSCHER_REG_EVENT_STATE); 444 445 data->last_updated = jiffies; 446 data->valid = 1; 447 } 448 449 mutex_unlock(&data->update_lock); 450 451 return data; 452} 453 454 455 456#define FAN_INDEX_FROM_NUM(nr) ((nr) - 1) 457 458static ssize_t set_fan_status(struct i2c_client *client, struct fscher_data *data, 459 const char *buf, size_t count, int nr, int reg) 460{ 461 /* bits 0..1, 3..7 reserved => mask with 0x04 */ 462 unsigned long v = simple_strtoul(buf, NULL, 10) & 0x04; 463 464 mutex_lock(&data->update_lock); 465 data->fan_status[FAN_INDEX_FROM_NUM(nr)] &= ~v; 466 fscher_write_value(client, reg, v); 467 mutex_unlock(&data->update_lock); 468 return count; 469} 470 471static ssize_t show_fan_status(struct fscher_data *data, char *buf, int nr) 472{ 473 /* bits 0..1, 3..7 reserved => mask with 0x04 */ 474 return sprintf(buf, "%u\n", data->fan_status[FAN_INDEX_FROM_NUM(nr)] & 0x04); 475} 476 477static ssize_t set_pwm(struct i2c_client *client, struct fscher_data *data, 478 const char *buf, size_t count, int nr, int reg) 479{ 480 unsigned long v = simple_strtoul(buf, NULL, 10); 481 482 mutex_lock(&data->update_lock); 483 data->fan_min[FAN_INDEX_FROM_NUM(nr)] = v > 0xff ? 0xff : v; 484 fscher_write_value(client, reg, data->fan_min[FAN_INDEX_FROM_NUM(nr)]); 485 mutex_unlock(&data->update_lock); 486 return count; 487} 488 489static ssize_t show_pwm(struct fscher_data *data, char *buf, int nr) 490{ 491 return sprintf(buf, "%u\n", data->fan_min[FAN_INDEX_FROM_NUM(nr)]); 492} 493 494static ssize_t set_fan_div(struct i2c_client *client, struct fscher_data *data, 495 const char *buf, size_t count, int nr, int reg) 496{ 497 /* supported values: 2, 4, 8 */ 498 unsigned long v = simple_strtoul(buf, NULL, 10); 499 500 switch (v) { 501 case 2: v = 1; break; 502 case 4: v = 2; break; 503 case 8: v = 3; break; 504 default: 505 dev_err(&client->dev, "fan_div value %ld not " 506 "supported. Choose one of 2, 4 or 8!\n", v); 507 return -EINVAL; 508 } 509 510 mutex_lock(&data->update_lock); 511 512 /* bits 2..7 reserved => mask with 0x03 */ 513 data->fan_ripple[FAN_INDEX_FROM_NUM(nr)] &= ~0x03; 514 data->fan_ripple[FAN_INDEX_FROM_NUM(nr)] |= v; 515 516 fscher_write_value(client, reg, data->fan_ripple[FAN_INDEX_FROM_NUM(nr)]); 517 mutex_unlock(&data->update_lock); 518 return count; 519} 520 521static ssize_t show_fan_div(struct fscher_data *data, char *buf, int nr) 522{ 523 /* bits 2..7 reserved => mask with 0x03 */ 524 return sprintf(buf, "%u\n", 1 << (data->fan_ripple[FAN_INDEX_FROM_NUM(nr)] & 0x03)); 525} 526 527#define RPM_FROM_REG(val) (val*60) 528 529static ssize_t show_fan_input (struct fscher_data *data, char *buf, int nr) 530{ 531 return sprintf(buf, "%u\n", RPM_FROM_REG(data->fan_act[FAN_INDEX_FROM_NUM(nr)])); 532} 533 534 535 536#define TEMP_INDEX_FROM_NUM(nr) ((nr) - 1) 537 538static ssize_t set_temp_status(struct i2c_client *client, struct fscher_data *data, 539 const char *buf, size_t count, int nr, int reg) 540{ 541 /* bits 2..7 reserved, 0 read only => mask with 0x02 */ 542 unsigned long v = simple_strtoul(buf, NULL, 10) & 0x02; 543 544 mutex_lock(&data->update_lock); 545 data->temp_status[TEMP_INDEX_FROM_NUM(nr)] &= ~v; 546 fscher_write_value(client, reg, v); 547 mutex_unlock(&data->update_lock); 548 return count; 549} 550 551static ssize_t show_temp_status(struct fscher_data *data, char *buf, int nr) 552{ 553 /* bits 2..7 reserved => mask with 0x03 */ 554 return sprintf(buf, "%u\n", data->temp_status[TEMP_INDEX_FROM_NUM(nr)] & 0x03); 555} 556 557#define TEMP_FROM_REG(val) (((val) - 128) * 1000) 558 559static ssize_t show_temp_input(struct fscher_data *data, char *buf, int nr) 560{ 561 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_act[TEMP_INDEX_FROM_NUM(nr)])); 562} 563 564/* 565 * The final conversion is specified in sensors.conf, as it depends on 566 * mainboard specific values. We export the registers contents as 567 * pseudo-hundredths-of-Volts (range 0V - 2.55V). Not that it makes much 568 * sense per se, but it minimizes the conversions count and keeps the 569 * values within a usual range. 570 */ 571#define VOLT_FROM_REG(val) ((val) * 10) 572 573static ssize_t show_in_input(struct fscher_data *data, char *buf, int nr) 574{ 575 return sprintf(buf, "%u\n", VOLT_FROM_REG(data->volt[nr])); 576} 577 578 579 580static ssize_t show_revision(struct fscher_data *data, char *buf, int nr) 581{ 582 return sprintf(buf, "%u\n", data->revision); 583} 584 585 586 587static ssize_t show_alarms(struct fscher_data *data, char *buf, int nr) 588{ 589 /* bits 2, 5..6 reserved => mask with 0x9b */ 590 return sprintf(buf, "%u\n", data->global_event & 0x9b); 591} 592 593 594 595static ssize_t set_control(struct i2c_client *client, struct fscher_data *data, 596 const char *buf, size_t count, int nr, int reg) 597{ 598 /* bits 1..7 reserved => mask with 0x01 */ 599 unsigned long v = simple_strtoul(buf, NULL, 10) & 0x01; 600 601 mutex_lock(&data->update_lock); 602 data->global_control &= ~v; 603 fscher_write_value(client, reg, v); 604 mutex_unlock(&data->update_lock); 605 return count; 606} 607 608static ssize_t show_control(struct fscher_data *data, char *buf, int nr) 609{ 610 /* bits 1..7 reserved => mask with 0x01 */ 611 return sprintf(buf, "%u\n", data->global_control & 0x01); 612} 613 614 615 616static ssize_t set_watchdog_control(struct i2c_client *client, struct 617 fscher_data *data, const char *buf, size_t count, 618 int nr, int reg) 619{ 620 /* bits 0..3 reserved => mask with 0xf0 */ 621 unsigned long v = simple_strtoul(buf, NULL, 10) & 0xf0; 622 623 mutex_lock(&data->update_lock); 624 data->watchdog[2] &= ~0xf0; 625 data->watchdog[2] |= v; 626 fscher_write_value(client, reg, data->watchdog[2]); 627 mutex_unlock(&data->update_lock); 628 return count; 629} 630 631static ssize_t show_watchdog_control(struct fscher_data *data, char *buf, int nr) 632{ 633 /* bits 0..3 reserved, bit 5 write only => mask with 0xd0 */ 634 return sprintf(buf, "%u\n", data->watchdog[2] & 0xd0); 635} 636 637static ssize_t set_watchdog_status(struct i2c_client *client, struct fscher_data *data, 638 const char *buf, size_t count, int nr, int reg) 639{ 640 /* bits 0, 2..7 reserved => mask with 0x02 */ 641 unsigned long v = simple_strtoul(buf, NULL, 10) & 0x02; 642 643 mutex_lock(&data->update_lock); 644 data->watchdog[1] &= ~v; 645 fscher_write_value(client, reg, v); 646 mutex_unlock(&data->update_lock); 647 return count; 648} 649 650static ssize_t show_watchdog_status(struct fscher_data *data, char *buf, int nr) 651{ 652 /* bits 0, 2..7 reserved => mask with 0x02 */ 653 return sprintf(buf, "%u\n", data->watchdog[1] & 0x02); 654} 655 656static ssize_t set_watchdog_preset(struct i2c_client *client, struct fscher_data *data, 657 const char *buf, size_t count, int nr, int reg) 658{ 659 unsigned long v = simple_strtoul(buf, NULL, 10) & 0xff; 660 661 mutex_lock(&data->update_lock); 662 data->watchdog[0] = v; 663 fscher_write_value(client, reg, data->watchdog[0]); 664 mutex_unlock(&data->update_lock); 665 return count; 666} 667 668static ssize_t show_watchdog_preset(struct fscher_data *data, char *buf, int nr) 669{ 670 return sprintf(buf, "%u\n", data->watchdog[0]); 671} 672 673static int __init sensors_fscher_init(void) 674{ 675 return i2c_add_driver(&fscher_driver); 676} 677 678static void __exit sensors_fscher_exit(void) 679{ 680 i2c_del_driver(&fscher_driver); 681} 682 683MODULE_AUTHOR("Reinhard Nissl <rnissl@gmx.de>"); 684MODULE_DESCRIPTION("FSC Hermes driver"); 685MODULE_LICENSE("GPL"); 686 687module_init(sensors_fscher_init); 688module_exit(sensors_fscher_exit); 689