drivers/hwmon/fschmd.c

   1 /* fschmd.c
   2  *
   3  * Copyright (C) 2007 - 2009 Hans de Goede <hdegoede@redhat.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18  */
  19
  20 /*
  21  *  Merged Fujitsu Siemens hwmon driver, supporting the Poseidon, Hermes,
  22  *  Scylla, Heracles, Heimdall, Hades and Syleus chips
  23  *
  24  *  Based on the original 2.4 fscscy, 2.6 fscpos, 2.6 fscher and 2.6
  25  *  (candidate) fschmd drivers:
  26  *  Copyright (C) 2006 Thilo Cestonaro
  27  *                      <thilo.cestonaro.external@fujitsu-siemens.com>
  28  *  Copyright (C) 2004, 2005 Stefan Ott <stefan@desire.ch>
  29  *  Copyright (C) 2003, 2004 Reinhard Nissl <rnissl@gmx.de>
  30  *  Copyright (c) 2001 Martin Knoblauch <mkn@teraport.de, knobi@knobisoft.de>
  31  *  Copyright (C) 2000 Hermann Jung <hej@odn.de>
  32  */
  33
  34 #include <linux/module.h>
  35 #include <linux/init.h>
  36 #include <linux/slab.h>
  37 #include <linux/jiffies.h>
  38 #include <linux/i2c.h>
  39 #include <linux/hwmon.h>
  40 #include <linux/hwmon-sysfs.h>
  41 #include <linux/smp_lock.h>
  42 #include <linux/err.h>
  43 #include <linux/mutex.h>
  44 #include <linux/sysfs.h>
  45 #include <linux/dmi.h>
  46 #include <linux/fs.h>
  47 #include <linux/watchdog.h>
  48 #include <linux/miscdevice.h>
  49 #include <linux/uaccess.h>
  50 #include <linux/kref.h>
  51
  52 /* Addresses to scan */
  53 static const unsigned short normal_i2c[] = { 0x73, I2C_CLIENT_END };
  54
  55 /* Insmod parameters */
  56 static int nowayout = WATCHDOG_NOWAYOUT;
  57 module_param(nowayout, int, 0);
  58 MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default="
  59         __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
  60
  61 enum chips { fscpos, fscher, fscscy, fschrc, fschmd, fschds, fscsyl };
  62
  63 /*
  64  * The FSCHMD registers and other defines
  65  */
  66
  67 /* chip identification */
  68 #define FSCHMD_REG_IDENT_0              0x00
  69 #define FSCHMD_REG_IDENT_1              0x01
  70 #define FSCHMD_REG_IDENT_2              0x02
  71 #define FSCHMD_REG_REVISION             0x03
  72
  73 /* global control and status */
  74 #define FSCHMD_REG_EVENT_STATE          0x04
  75 #define FSCHMD_REG_CONTROL              0x05
  76
  77 #define FSCHMD_CONTROL_ALERT_LED        0x01
  78
  79 /* watchdog */
  80 static const u8 FSCHMD_REG_WDOG_CONTROL[7] =
  81         { 0x21, 0x21, 0x21, 0x21, 0x21, 0x28, 0x28 };
  82 static const u8 FSCHMD_REG_WDOG_STATE[7] =
  83         { 0x23, 0x23, 0x23, 0x23, 0x23, 0x29, 0x29 };
  84 static const u8 FSCHMD_REG_WDOG_PRESET[7] =
  85         { 0x28, 0x28, 0x28, 0x28, 0x28, 0x2a, 0x2a };
  86
  87 #define FSCHMD_WDOG_CONTROL_TRIGGER     0x10
  88 #define FSCHMD_WDOG_CONTROL_STARTED     0x10 /* the same as trigger */
  89 #define FSCHMD_WDOG_CONTROL_STOP        0x20
  90 #define FSCHMD_WDOG_CONTROL_RESOLUTION  0x40
  91
  92 #define FSCHMD_WDOG_STATE_CARDRESET     0x02
  93
  94 /* voltages, weird order is to keep the same order as the old drivers */
  95 static const u8 FSCHMD_REG_VOLT[7][6] = {
  96         { 0x45, 0x42, 0x48 },                           /* pos */
  97         { 0x45, 0x42, 0x48 },                           /* her */
  98         { 0x45, 0x42, 0x48 },                           /* scy */
  99         { 0x45, 0x42, 0x48 },                           /* hrc */
 100         { 0x45, 0x42, 0x48 },                           /* hmd */
 101         { 0x21, 0x20, 0x22 },                           /* hds */
 102         { 0x21, 0x20, 0x22, 0x23, 0x24, 0x25 },         /* syl */
 103 };
 104
 105 static const int FSCHMD_NO_VOLT_SENSORS[7] = { 3, 3, 3, 3, 3, 3, 6 };
 106
 107 /* minimum pwm at which the fan is driven (pwm can by increased depending on
 108    the temp. Notice that for the scy some fans share there minimum speed.
 109    Also notice that with the scy the sensor order is different than with the
 110    other chips, this order was in the 2.4 driver and kept for consistency. */
 111 static const u8 FSCHMD_REG_FAN_MIN[7][7] = {
 112         { 0x55, 0x65 },                                 /* pos */
 113         { 0x55, 0x65, 0xb5 },                           /* her */
 114         { 0x65, 0x65, 0x55, 0xa5, 0x55, 0xa5 },         /* scy */
 115         { 0x55, 0x65, 0xa5, 0xb5 },                     /* hrc */
 116         { 0x55, 0x65, 0xa5, 0xb5, 0xc5 },               /* hmd */
 117         { 0x55, 0x65, 0xa5, 0xb5, 0xc5 },               /* hds */
 118         { 0x54, 0x64, 0x74, 0x84, 0x94, 0xa4, 0xb4 },   /* syl */
 119 };
 120
 121 /* actual fan speed */
 122 static const u8 FSCHMD_REG_FAN_ACT[7][7] = {
 123         { 0x0e, 0x6b, 0xab },                           /* pos */
 124         { 0x0e, 0x6b, 0xbb },                           /* her */
 125         { 0x6b, 0x6c, 0x0e, 0xab, 0x5c, 0xbb },         /* scy */
 126         { 0x0e, 0x6b, 0xab, 0xbb },                     /* hrc */
 127         { 0x5b, 0x6b, 0xab, 0xbb, 0xcb },               /* hmd */
 128         { 0x5b, 0x6b, 0xab, 0xbb, 0xcb },               /* hds */
 129         { 0x57, 0x67, 0x77, 0x87, 0x97, 0xa7, 0xb7 },   /* syl */
 130 };
 131
 132 /* fan status registers */
 133 static const u8 FSCHMD_REG_FAN_STATE[7][7] = {
 134         { 0x0d, 0x62, 0xa2 },                           /* pos */
 135         { 0x0d, 0x62, 0xb2 },                           /* her */
 136         { 0x62, 0x61, 0x0d, 0xa2, 0x52, 0xb2 },         /* scy */
 137         { 0x0d, 0x62, 0xa2, 0xb2 },                     /* hrc */
 138         { 0x52, 0x62, 0xa2, 0xb2, 0xc2 },               /* hmd */
 139         { 0x52, 0x62, 0xa2, 0xb2, 0xc2 },               /* hds */
 140         { 0x50, 0x60, 0x70, 0x80, 0x90, 0xa0, 0xb0 },   /* syl */
 141 };
 142
 143 /* fan ripple / divider registers */
 144 static const u8 FSCHMD_REG_FAN_RIPPLE[7][7] = {
 145         { 0x0f, 0x6f, 0xaf },                           /* pos */
 146         { 0x0f, 0x6f, 0xbf },                           /* her */
 147         { 0x6f, 0x6f, 0x0f, 0xaf, 0x0f, 0xbf },         /* scy */
 148         { 0x0f, 0x6f, 0xaf, 0xbf },                     /* hrc */
 149         { 0x5f, 0x6f, 0xaf, 0xbf, 0xcf },               /* hmd */
 150         { 0x5f, 0x6f, 0xaf, 0xbf, 0xcf },               /* hds */
 151         { 0x56, 0x66, 0x76, 0x86, 0x96, 0xa6, 0xb6 },   /* syl */
 152 };
 153
 154 static const int FSCHMD_NO_FAN_SENSORS[7] = { 3, 3, 6, 4, 5, 5, 7 };
 155
 156 /* Fan status register bitmasks */
 157 #define FSCHMD_FAN_ALARM        0x04 /* called fault by FSC! */
 158 #define FSCHMD_FAN_NOT_PRESENT  0x08
 159 #define FSCHMD_FAN_DISABLED     0x80
 160
 161
 162 /* actual temperature registers */
 163 static const u8 FSCHMD_REG_TEMP_ACT[7][11] = {
 164         { 0x64, 0x32, 0x35 },                           /* pos */
 165         { 0x64, 0x32, 0x35 },                           /* her */
 166         { 0x64, 0xD0, 0x32, 0x35 },                     /* scy */
 167         { 0x64, 0x32, 0x35 },                           /* hrc */
 168         { 0x70, 0x80, 0x90, 0xd0, 0xe0 },               /* hmd */
 169         { 0x70, 0x80, 0x90, 0xd0, 0xe0 },               /* hds */
 170         { 0x58, 0x68, 0x78, 0x88, 0x98, 0xa8,           /* syl */
 171           0xb8, 0xc8, 0xd8, 0xe8, 0xf8 },
 172 };
 173
 174 /* temperature state registers */
 175 static const u8 FSCHMD_REG_TEMP_STATE[7][11] = {
 176         { 0x71, 0x81, 0x91 },                           /* pos */
 177         { 0x71, 0x81, 0x91 },                           /* her */
 178         { 0x71, 0xd1, 0x81, 0x91 },                     /* scy */
 179         { 0x71, 0x81, 0x91 },                           /* hrc */
 180         { 0x71, 0x81, 0x91, 0xd1, 0xe1 },               /* hmd */
 181         { 0x71, 0x81, 0x91, 0xd1, 0xe1 },               /* hds */
 182         { 0x59, 0x69, 0x79, 0x89, 0x99, 0xa9,           /* syl */
 183           0xb9, 0xc9, 0xd9, 0xe9, 0xf9 },
 184 };
 185
 186 /* temperature high limit registers, FSC does not document these. Proven to be
 187    there with field testing on the fscher and fschrc, already supported / used
 188    in the fscscy 2.4 driver. FSC has confirmed that the fschmd has registers
 189    at these addresses, but doesn't want to confirm they are the same as with
 190    the fscher?? */
 191 static const u8 FSCHMD_REG_TEMP_LIMIT[7][11] = {
 192         { 0, 0, 0 },                                    /* pos */
 193         { 0x76, 0x86, 0x96 },                           /* her */
 194         { 0x76, 0xd6, 0x86, 0x96 },                     /* scy */
 195         { 0x76, 0x86, 0x96 },                           /* hrc */
 196         { 0x76, 0x86, 0x96, 0xd6, 0xe6 },               /* hmd */
 197         { 0x76, 0x86, 0x96, 0xd6, 0xe6 },               /* hds */
 198         { 0x5a, 0x6a, 0x7a, 0x8a, 0x9a, 0xaa,           /* syl */
 199           0xba, 0xca, 0xda, 0xea, 0xfa },
 200 };
 201
 202 /* These were found through experimenting with an fscher, currently they are
 203    not used, but we keep them around for future reference.
 204    On the fscsyl AUTOP1 lives at 0x#c (so 0x5c for fan1, 0x6c for fan2, etc),
 205    AUTOP2 lives at 0x#e, and 0x#1 is a bitmask defining which temps influence
 206    the fan speed.
 207 static const u8 FSCHER_REG_TEMP_AUTOP1[] =      { 0x73, 0x83, 0x93 };
 208 static const u8 FSCHER_REG_TEMP_AUTOP2[] =      { 0x75, 0x85, 0x95 }; */
 209
 210 static const int FSCHMD_NO_TEMP_SENSORS[7] = { 3, 3, 4, 3, 5, 5, 11 };
 211
 212 /* temp status register bitmasks */
 213 #define FSCHMD_TEMP_WORKING     0x01
 214 #define FSCHMD_TEMP_ALERT       0x02
 215 #define FSCHMD_TEMP_DISABLED    0x80
 216 /* there only really is an alarm if the sensor is working and alert == 1 */
 217 #define FSCHMD_TEMP_ALARM_MASK \
 218         (FSCHMD_TEMP_WORKING | FSCHMD_TEMP_ALERT)
 219
 220 /*
 221  * Functions declarations
 222  */
 223
 224 static int fschmd_probe(struct i2c_client *client,
 225                         const struct i2c_device_id *id);
 226 static int fschmd_detect(struct i2c_client *client,
 227                          struct i2c_board_info *info);
 228 static int fschmd_remove(struct i2c_client *client);
 229 static struct fschmd_data *fschmd_update_device(struct device *dev);
 230
 231 /*
 232  * Driver data (common to all clients)
 233  */
 234
 235 static const struct i2c_device_id fschmd_id[] = {
 236         { "fscpos", fscpos },
 237         { "fscher", fscher },
 238         { "fscscy", fscscy },
 239         { "fschrc", fschrc },
 240         { "fschmd", fschmd },
 241         { "fschds", fschds },
 242         { "fscsyl", fscsyl },
 243         { }
 244 };
 245 MODULE_DEVICE_TABLE(i2c, fschmd_id);
 246
 247 static struct i2c_driver fschmd_driver = {
 248         .class          = I2C_CLASS_HWMON,
 249         .driver = {
 250                 .name   = "fschmd",
 251         },
 252         .probe          = fschmd_probe,
 253         .remove         = fschmd_remove,
 254         .id_table       = fschmd_id,
 255         .detect         = fschmd_detect,
 256         .address_list   = normal_i2c,
 257 };
 258
 259 /*
 260  * Client data (each client gets its own)
 261  */
 262
 263 struct fschmd_data {
 264         struct i2c_client *client;
 265         struct device *hwmon_dev;
 266         struct mutex update_lock;
 267         struct mutex watchdog_lock;
 268         struct list_head list; /* member of the watchdog_data_list */
 269         struct kref kref;
 270         struct miscdevice watchdog_miscdev;
 271         enum chips kind;
 272         unsigned long watchdog_is_open;
 273         char watchdog_expect_close;
 274         char watchdog_name[10]; /* must be unique to avoid sysfs conflict */
 275         char valid; /* zero until following fields are valid */
 276         unsigned long last_updated; /* in jiffies */
 277
 278         /* register values */
 279         u8 revision;            /* chip revision */
 280         u8 global_control;      /* global control register */
 281         u8 watchdog_control;    /* watchdog control register */
 282         u8 watchdog_state;      /* watchdog status register */
 283         u8 watchdog_preset;     /* watchdog counter preset on trigger val */
 284         u8 volt[6];             /* voltage */
 285         u8 temp_act[11];        /* temperature */
 286         u8 temp_status[11];     /* status of sensor */
 287         u8 temp_max[11];        /* high temp limit, notice: undocumented! */
 288         u8 fan_act[7];          /* fans revolutions per second */
 289         u8 fan_status[7];       /* fan status */
 290         u8 fan_min[7];          /* fan min value for rps */
 291         u8 fan_ripple[7];       /* divider for rps */
 292 };
 293
 294 /* Global variables to hold information read from special DMI tables, which are
 295    available on FSC machines with an fscher or later chip. There is no need to
 296    protect these with a lock as they are only modified from our attach function
 297    which always gets called with the i2c-core lock held and never accessed
 298    before the attach function is done with them. */
 299 static int dmi_mult[6] = { 490, 200, 100, 100, 200, 100 };
 300 static int dmi_offset[6] = { 0, 0, 0, 0, 0, 0 };
 301 static int dmi_vref = -1;
 302
 303 /* Somewhat ugly :( global data pointer list with all fschmd devices, so that
 304    we can find our device data as when using misc_register there is no other
 305    method to get to ones device data from the open fop. */
 306 static LIST_HEAD(watchdog_data_list);
 307 /* Note this lock not only protect list access, but also data.kref access */
 308 static DEFINE_MUTEX(watchdog_data_mutex);
 309
 310 /* Release our data struct when we're detached from the i2c client *and* all
 311    references to our watchdog device are released */
 312 static void fschmd_release_resources(struct kref *ref)
 313 {
 314         struct fschmd_data *data = container_of(ref, struct fschmd_data, kref);
 315         kfree(data);
 316 }
 317
 318 /*
 319  * Sysfs attr show / store functions
 320  */
 321
 322 static ssize_t show_in_value(struct device *dev,
 323         struct device_attribute *devattr, char *buf)
 324 {
 325         const int max_reading[3] = { 14200, 6600, 3300 };
 326         int index = to_sensor_dev_attr(devattr)->index;
 327         struct fschmd_data *data = fschmd_update_device(dev);
 328
 329         if (data->kind == fscher || data->kind >= fschrc)
 330                 return sprintf(buf, "%d\n", (data->volt[index] * dmi_vref *
 331                         dmi_mult[index]) / 255 + dmi_offset[index]);
 332         else
 333                 return sprintf(buf, "%d\n", (data->volt[index] *
 334                         max_reading[index] + 128) / 255);
 335 }
 336
 337
 338 #define TEMP_FROM_REG(val)      (((val) - 128) * 1000)
 339
 340 static ssize_t show_temp_value(struct device *dev,
 341         struct device_attribute *devattr, char *buf)
 342 {
 343         int index = to_sensor_dev_attr(devattr)->index;
 344         struct fschmd_data *data = fschmd_update_device(dev);
 345
 346         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_act[index]));
 347 }
 348
 349 static ssize_t show_temp_max(struct device *dev,
 350         struct device_attribute *devattr, char *buf)
 351 {
 352         int index = to_sensor_dev_attr(devattr)->index;
 353         struct fschmd_data *data = fschmd_update_device(dev);
 354
 355         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[index]));
 356 }
 357
 358 static ssize_t store_temp_max(struct device *dev, struct device_attribute
 359         *devattr, const char *buf, size_t count)
 360 {
 361         int index = to_sensor_dev_attr(devattr)->index;
 362         struct fschmd_data *data = dev_get_drvdata(dev);
 363         long v = simple_strtol(buf, NULL, 10) / 1000;
 364
 365         v = SENSORS_LIMIT(v, -128, 127) + 128;
 366
 367         mutex_lock(&data->update_lock);
 368         i2c_smbus_write_byte_data(to_i2c_client(dev),
 369                 FSCHMD_REG_TEMP_LIMIT[data->kind][index], v);
 370         data->temp_max[index] = v;
 371         mutex_unlock(&data->update_lock);
 372
 373         return count;
 374 }
 375
 376 static ssize_t show_temp_fault(struct device *dev,
 377         struct device_attribute *devattr, char *buf)
 378 {
 379         int index = to_sensor_dev_attr(devattr)->index;
 380         struct fschmd_data *data = fschmd_update_device(dev);
 381
 382         /* bit 0 set means sensor working ok, so no fault! */
 383         if (data->temp_status[index] & FSCHMD_TEMP_WORKING)
 384                 return sprintf(buf, "0\n");
 385         else
 386                 return sprintf(buf, "1\n");
 387 }
 388
 389 static ssize_t show_temp_alarm(struct device *dev,
 390         struct device_attribute *devattr, char *buf)
 391 {
 392         int index = to_sensor_dev_attr(devattr)->index;
 393         struct fschmd_data *data = fschmd_update_device(dev);
 394
 395         if ((data->temp_status[index] & FSCHMD_TEMP_ALARM_MASK) ==
 396                         FSCHMD_TEMP_ALARM_MASK)
 397                 return sprintf(buf, "1\n");
 398         else
 399                 return sprintf(buf, "0\n");
 400 }
 401
 402
 403 #define RPM_FROM_REG(val)       ((val) * 60)
 404
 405 static ssize_t show_fan_value(struct device *dev,
 406         struct device_attribute *devattr, char *buf)
 407 {
 408         int index = to_sensor_dev_attr(devattr)->index;
 409         struct fschmd_data *data = fschmd_update_device(dev);
 410
 411         return sprintf(buf, "%u\n", RPM_FROM_REG(data->fan_act[index]));
 412 }
 413
 414 static ssize_t show_fan_div(struct device *dev,
 415         struct device_attribute *devattr, char *buf)
 416 {
 417         int index = to_sensor_dev_attr(devattr)->index;
 418         struct fschmd_data *data = fschmd_update_device(dev);
 419
 420         /* bits 2..7 reserved => mask with 3 */
 421         return sprintf(buf, "%d\n", 1 << (data->fan_ripple[index] & 3));
 422 }
 423
 424 static ssize_t store_fan_div(struct device *dev, struct device_attribute
 425         *devattr, const char *buf, size_t count)
 426 {
 427         u8 reg;
 428         int index = to_sensor_dev_attr(devattr)->index;
 429         struct fschmd_data *data = dev_get_drvdata(dev);
 430         /* supported values: 2, 4, 8 */
 431         unsigned long v = simple_strtoul(buf, NULL, 10);
 432
 433         switch (v) {
 434         case 2: v = 1; break;
 435         case 4: v = 2; break;
 436         case 8: v = 3; break;
 437         default:
 438                 dev_err(dev, "fan_div value %lu not supported. "
 439                         "Choose one of 2, 4 or 8!\n", v);
 440                 return -EINVAL;
 441         }
 442
 443         mutex_lock(&data->update_lock);
 444
 445         reg = i2c_smbus_read_byte_data(to_i2c_client(dev),
 446                 FSCHMD_REG_FAN_RIPPLE[data->kind][index]);
 447
 448         /* bits 2..7 reserved => mask with 0x03 */
 449         reg &= ~0x03;
 450         reg |= v;
 451
 452         i2c_smbus_write_byte_data(to_i2c_client(dev),
 453                 FSCHMD_REG_FAN_RIPPLE[data->kind][index], reg);
 454
 455         data->fan_ripple[index] = reg;
 456
 457         mutex_unlock(&data->update_lock);
 458
 459         return count;
 460 }
 461
 462 static ssize_t show_fan_alarm(struct device *dev,
 463         struct device_attribute *devattr, char *buf)
 464 {
 465         int index = to_sensor_dev_attr(devattr)->index;
 466         struct fschmd_data *data = fschmd_update_device(dev);
 467
 468         if (data->fan_status[index] & FSCHMD_FAN_ALARM)
 469                 return sprintf(buf, "1\n");
 470         else
 471                 return sprintf(buf, "0\n");
 472 }
 473
 474 static ssize_t show_fan_fault(struct device *dev,
 475         struct device_attribute *devattr, char *buf)
 476 {
 477         int index = to_sensor_dev_attr(devattr)->index;
 478         struct fschmd_data *data = fschmd_update_device(dev);
 479
 480         if (data->fan_status[index] & FSCHMD_FAN_NOT_PRESENT)
 481                 return sprintf(buf, "1\n");
 482         else
 483                 return sprintf(buf, "0\n");
 484 }
 485
 486
 487 static ssize_t show_pwm_auto_point1_pwm(struct device *dev,
 488         struct device_attribute *devattr, char *buf)
 489 {
 490         int index = to_sensor_dev_attr(devattr)->index;
 491         struct fschmd_data *data = fschmd_update_device(dev);
 492         int val = data->fan_min[index];
 493
 494         /* 0 = allow turning off (except on the syl), 1-255 = 50-100% */
 495         if (val || data->kind == fscsyl)
 496                 val = val / 2 + 128;
 497
 498         return sprintf(buf, "%d\n", val);
 499 }
 500
 501 static ssize_t store_pwm_auto_point1_pwm(struct device *dev,
 502         struct device_attribute *devattr, const char *buf, size_t count)
 503 {
 504         int index = to_sensor_dev_attr(devattr)->index;
 505         struct fschmd_data *data = dev_get_drvdata(dev);
 506         unsigned long v = simple_strtoul(buf, NULL, 10);
 507
 508         /* reg: 0 = allow turning off (except on the syl), 1-255 = 50-100% */
 509         if (v || data->kind == fscsyl) {
 510                 v = SENSORS_LIMIT(v, 128, 255);
 511                 v = (v - 128) * 2 + 1;
 512         }
 513
 514         mutex_lock(&data->update_lock);
 515
 516         i2c_smbus_write_byte_data(to_i2c_client(dev),
 517                 FSCHMD_REG_FAN_MIN[data->kind][index], v);
 518         data->fan_min[index] = v;
 519
 520         mutex_unlock(&data->update_lock);
 521
 522         return count;
 523 }
 524
 525
 526 /* The FSC hwmon family has the ability to force an attached alert led to flash
 527    from software, we export this as an alert_led sysfs attr */
 528 static ssize_t show_alert_led(struct device *dev,
 529         struct device_attribute *devattr, char *buf)
 530 {
 531         struct fschmd_data *data = fschmd_update_device(dev);
 532
 533         if (data->global_control & FSCHMD_CONTROL_ALERT_LED)
 534                 return sprintf(buf, "1\n");
 535         else
 536                 return sprintf(buf, "0\n");
 537 }
 538
 539 static ssize_t store_alert_led(struct device *dev,
 540         struct device_attribute *devattr, const char *buf, size_t count)
 541 {
 542         u8 reg;
 543         struct fschmd_data *data = dev_get_drvdata(dev);
 544         unsigned long v = simple_strtoul(buf, NULL, 10);
 545
 546         mutex_lock(&data->update_lock);
 547
 548         reg = i2c_smbus_read_byte_data(to_i2c_client(dev), FSCHMD_REG_CONTROL);
 549
 550         if (v)
 551                 reg |= FSCHMD_CONTROL_ALERT_LED;
 552         else
 553                 reg &= ~FSCHMD_CONTROL_ALERT_LED;
 554
 555         i2c_smbus_write_byte_data(to_i2c_client(dev), FSCHMD_REG_CONTROL, reg);
 556
 557         data->global_control = reg;
 558
 559         mutex_unlock(&data->update_lock);
 560
 561         return count;
 562 }
 563
 564 static DEVICE_ATTR(alert_led, 0644, show_alert_led, store_alert_led);
 565
 566 static struct sensor_device_attribute fschmd_attr[] = {
 567         SENSOR_ATTR(in0_input, 0444, show_in_value, NULL, 0),
 568         SENSOR_ATTR(in1_input, 0444, show_in_value, NULL, 1),
 569         SENSOR_ATTR(in2_input, 0444, show_in_value, NULL, 2),
 570         SENSOR_ATTR(in3_input, 0444, show_in_value, NULL, 3),
 571         SENSOR_ATTR(in4_input, 0444, show_in_value, NULL, 4),
 572         SENSOR_ATTR(in5_input, 0444, show_in_value, NULL, 5),
 573 };
 574
 575 static struct sensor_device_attribute fschmd_temp_attr[] = {
 576         SENSOR_ATTR(temp1_input, 0444, show_temp_value, NULL, 0),
 577         SENSOR_ATTR(temp1_max,   0644, show_temp_max, store_temp_max, 0),
 578         SENSOR_ATTR(temp1_fault, 0444, show_temp_fault, NULL, 0),
 579         SENSOR_ATTR(temp1_alarm, 0444, show_temp_alarm, NULL, 0),
 580         SENSOR_ATTR(temp2_input, 0444, show_temp_value, NULL, 1),
 581         SENSOR_ATTR(temp2_max,   0644, show_temp_max, store_temp_max, 1),
 582         SENSOR_ATTR(temp2_fault, 0444, show_temp_fault, NULL, 1),
 583         SENSOR_ATTR(temp2_alarm, 0444, show_temp_alarm, NULL, 1),
 584         SENSOR_ATTR(temp3_input, 0444, show_temp_value, NULL, 2),
 585         SENSOR_ATTR(temp3_max,   0644, show_temp_max, store_temp_max, 2),
 586         SENSOR_ATTR(temp3_fault, 0444, show_temp_fault, NULL, 2),
 587         SENSOR_ATTR(temp3_alarm, 0444, show_temp_alarm, NULL, 2),
 588         SENSOR_ATTR(temp4_input, 0444, show_temp_value, NULL, 3),
 589         SENSOR_ATTR(temp4_max,   0644, show_temp_max, store_temp_max, 3),
 590         SENSOR_ATTR(temp4_fault, 0444, show_temp_fault, NULL, 3),
 591         SENSOR_ATTR(temp4_alarm, 0444, show_temp_alarm, NULL, 3),
 592         SENSOR_ATTR(temp5_input, 0444, show_temp_value, NULL, 4),
 593         SENSOR_ATTR(temp5_max,   0644, show_temp_max, store_temp_max, 4),
 594         SENSOR_ATTR(temp5_fault, 0444, show_temp_fault, NULL, 4),
 595         SENSOR_ATTR(temp5_alarm, 0444, show_temp_alarm, NULL, 4),
 596         SENSOR_ATTR(temp6_input, 0444, show_temp_value, NULL, 5),
 597         SENSOR_ATTR(temp6_max,   0644, show_temp_max, store_temp_max, 5),
 598         SENSOR_ATTR(temp6_fault, 0444, show_temp_fault, NULL, 5),
 599         SENSOR_ATTR(temp6_alarm, 0444, show_temp_alarm, NULL, 5),
 600         SENSOR_ATTR(temp7_input, 0444, show_temp_value, NULL, 6),
 601         SENSOR_ATTR(temp7_max,   0644, show_temp_max, store_temp_max, 6),
 602         SENSOR_ATTR(temp7_fault, 0444, show_temp_fault, NULL, 6),
 603         SENSOR_ATTR(temp7_alarm, 0444, show_temp_alarm, NULL, 6),
 604         SENSOR_ATTR(temp8_input, 0444, show_temp_value, NULL, 7),
 605         SENSOR_ATTR(temp8_max,   0644, show_temp_max, store_temp_max, 7),
 606         SENSOR_ATTR(temp8_fault, 0444, show_temp_fault, NULL, 7),
 607         SENSOR_ATTR(temp8_alarm, 0444, show_temp_alarm, NULL, 7),
 608         SENSOR_ATTR(temp9_input, 0444, show_temp_value, NULL, 8),
 609         SENSOR_ATTR(temp9_max,   0644, show_temp_max, store_temp_max, 8),
 610         SENSOR_ATTR(temp9_fault, 0444, show_temp_fault, NULL, 8),
 611         SENSOR_ATTR(temp9_alarm, 0444, show_temp_alarm, NULL, 8),
 612         SENSOR_ATTR(temp10_input, 0444, show_temp_value, NULL, 9),
 613         SENSOR_ATTR(temp10_max,   0644, show_temp_max, store_temp_max, 9),
 614         SENSOR_ATTR(temp10_fault, 0444, show_temp_fault, NULL, 9),
 615         SENSOR_ATTR(temp10_alarm, 0444, show_temp_alarm, NULL, 9),
 616         SENSOR_ATTR(temp11_input, 0444, show_temp_value, NULL, 10),
 617         SENSOR_ATTR(temp11_max,   0644, show_temp_max, store_temp_max, 10),
 618         SENSOR_ATTR(temp11_fault, 0444, show_temp_fault, NULL, 10),
 619         SENSOR_ATTR(temp11_alarm, 0444, show_temp_alarm, NULL, 10),
 620 };
 621
 622 static struct sensor_device_attribute fschmd_fan_attr[] = {
 623         SENSOR_ATTR(fan1_input, 0444, show_fan_value, NULL, 0),
 624         SENSOR_ATTR(fan1_div,   0644, show_fan_div, store_fan_div, 0),
 625         SENSOR_ATTR(fan1_alarm, 0444, show_fan_alarm, NULL, 0),
 626         SENSOR_ATTR(fan1_fault, 0444, show_fan_fault, NULL, 0),
 627         SENSOR_ATTR(pwm1_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 628                 store_pwm_auto_point1_pwm, 0),
 629         SENSOR_ATTR(fan2_input, 0444, show_fan_value, NULL, 1),
 630         SENSOR_ATTR(fan2_div,   0644, show_fan_div, store_fan_div, 1),
 631         SENSOR_ATTR(fan2_alarm, 0444, show_fan_alarm, NULL, 1),
 632         SENSOR_ATTR(fan2_fault, 0444, show_fan_fault, NULL, 1),
 633         SENSOR_ATTR(pwm2_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 634                 store_pwm_auto_point1_pwm, 1),
 635         SENSOR_ATTR(fan3_input, 0444, show_fan_value, NULL, 2),
 636         SENSOR_ATTR(fan3_div,   0644, show_fan_div, store_fan_div, 2),
 637         SENSOR_ATTR(fan3_alarm, 0444, show_fan_alarm, NULL, 2),
 638         SENSOR_ATTR(fan3_fault, 0444, show_fan_fault, NULL, 2),
 639         SENSOR_ATTR(pwm3_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 640                 store_pwm_auto_point1_pwm, 2),
 641         SENSOR_ATTR(fan4_input, 0444, show_fan_value, NULL, 3),
 642         SENSOR_ATTR(fan4_div,   0644, show_fan_div, store_fan_div, 3),
 643         SENSOR_ATTR(fan4_alarm, 0444, show_fan_alarm, NULL, 3),
 644         SENSOR_ATTR(fan4_fault, 0444, show_fan_fault, NULL, 3),
 645         SENSOR_ATTR(pwm4_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 646                 store_pwm_auto_point1_pwm, 3),
 647         SENSOR_ATTR(fan5_input, 0444, show_fan_value, NULL, 4),
 648         SENSOR_ATTR(fan5_div,   0644, show_fan_div, store_fan_div, 4),
 649         SENSOR_ATTR(fan5_alarm, 0444, show_fan_alarm, NULL, 4),
 650         SENSOR_ATTR(fan5_fault, 0444, show_fan_fault, NULL, 4),
 651         SENSOR_ATTR(pwm5_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 652                 store_pwm_auto_point1_pwm, 4),
 653         SENSOR_ATTR(fan6_input, 0444, show_fan_value, NULL, 5),
 654         SENSOR_ATTR(fan6_div,   0644, show_fan_div, store_fan_div, 5),
 655         SENSOR_ATTR(fan6_alarm, 0444, show_fan_alarm, NULL, 5),
 656         SENSOR_ATTR(fan6_fault, 0444, show_fan_fault, NULL, 5),
 657         SENSOR_ATTR(pwm6_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 658                 store_pwm_auto_point1_pwm, 5),
 659         SENSOR_ATTR(fan7_input, 0444, show_fan_value, NULL, 6),
 660         SENSOR_ATTR(fan7_div,   0644, show_fan_div, store_fan_div, 6),
 661         SENSOR_ATTR(fan7_alarm, 0444, show_fan_alarm, NULL, 6),
 662         SENSOR_ATTR(fan7_fault, 0444, show_fan_fault, NULL, 6),
 663         SENSOR_ATTR(pwm7_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
 664                 store_pwm_auto_point1_pwm, 6),
 665 };
 666
 667
 668 /*
 669  * Watchdog routines
 670  */
 671
 672 static int watchdog_set_timeout(struct fschmd_data *data, int timeout)
 673 {
 674         int ret, resolution;
 675         int kind = data->kind + 1; /* 0-x array index -> 1-x module param */
 676
 677         /* 2 second or 60 second resolution? */
 678         if (timeout <= 510 || kind == fscpos || kind == fscscy)
 679                 resolution = 2;
 680         else
 681                 resolution = 60;
 682
 683         if (timeout < resolution || timeout > (resolution * 255))
 684                 return -EINVAL;
 685
 686         mutex_lock(&data->watchdog_lock);
 687         if (!data->client) {
 688                 ret = -ENODEV;
 689                 goto leave;
 690         }
 691
 692         if (resolution == 2)
 693                 data->watchdog_control &= ~FSCHMD_WDOG_CONTROL_RESOLUTION;
 694         else
 695                 data->watchdog_control |= FSCHMD_WDOG_CONTROL_RESOLUTION;
 696
 697         data->watchdog_preset = DIV_ROUND_UP(timeout, resolution);
 698
 699         /* Write new timeout value */
 700         i2c_smbus_write_byte_data(data->client,
 701                 FSCHMD_REG_WDOG_PRESET[data->kind], data->watchdog_preset);
 702         /* Write new control register, do not trigger! */
 703         i2c_smbus_write_byte_data(data->client,
 704                 FSCHMD_REG_WDOG_CONTROL[data->kind],
 705                 data->watchdog_control & ~FSCHMD_WDOG_CONTROL_TRIGGER);
 706
 707         ret = data->watchdog_preset * resolution;
 708
 709 leave:
 710         mutex_unlock(&data->watchdog_lock);
 711         return ret;
 712 }
 713
 714 static int watchdog_get_timeout(struct fschmd_data *data)
 715 {
 716         int timeout;
 717
 718         mutex_lock(&data->watchdog_lock);
 719         if (data->watchdog_control & FSCHMD_WDOG_CONTROL_RESOLUTION)
 720                 timeout = data->watchdog_preset * 60;
 721         else
 722                 timeout = data->watchdog_preset * 2;
 723         mutex_unlock(&data->watchdog_lock);
 724
 725         return timeout;
 726 }
 727
 728 static int watchdog_trigger(struct fschmd_data *data)
 729 {
 730         int ret = 0;
 731
 732         mutex_lock(&data->watchdog_lock);
 733         if (!data->client) {
 734                 ret = -ENODEV;
 735                 goto leave;
 736         }
 737
 738         data->watchdog_control |= FSCHMD_WDOG_CONTROL_TRIGGER;
 739         i2c_smbus_write_byte_data(data->client,
 740                                   FSCHMD_REG_WDOG_CONTROL[data->kind],
 741                                   data->watchdog_control);
 742 leave:
 743         mutex_unlock(&data->watchdog_lock);
 744         return ret;
 745 }
 746
 747 static int watchdog_stop(struct fschmd_data *data)
 748 {
 749         int ret = 0;
 750
 751         mutex_lock(&data->watchdog_lock);
 752         if (!data->client) {
 753                 ret = -ENODEV;
 754                 goto leave;
 755         }
 756
 757         data->watchdog_control &= ~FSCHMD_WDOG_CONTROL_STARTED;
 758         /* Don't store the stop flag in our watchdog control register copy, as
 759            its a write only bit (read always returns 0) */
 760         i2c_smbus_write_byte_data(data->client,
 761                 FSCHMD_REG_WDOG_CONTROL[data->kind],
 762                 data->watchdog_control | FSCHMD_WDOG_CONTROL_STOP);
 763 leave:
 764         mutex_unlock(&data->watchdog_lock);
 765         return ret;
 766 }
 767
 768 static int watchdog_open(struct inode *inode, struct file *filp)
 769 {
 770         struct fschmd_data *pos, *data = NULL;
 771         int watchdog_is_open;
 772
 773         /* We get called from drivers/char/misc.c with misc_mtx hold, and we
 774            call misc_register() from fschmd_probe() with watchdog_data_mutex
 775            hold, as misc_register() takes the misc_mtx lock, this is a possible
 776            deadlock, so we use mutex_trylock here. */
 777         if (!mutex_trylock(&watchdog_data_mutex))
 778                 return -ERESTARTSYS;
 779         list_for_each_entry(pos, &watchdog_data_list, list) {
 780                 if (pos->watchdog_miscdev.minor == iminor(inode)) {
 781                         data = pos;
 782                         break;
 783                 }
 784         }
 785         /* Note we can never not have found data, so we don't check for this */
 786         watchdog_is_open = test_and_set_bit(0, &data->watchdog_is_open);
 787         if (!watchdog_is_open)
 788                 kref_get(&data->kref);
 789         mutex_unlock(&watchdog_data_mutex);
 790
 791         if (watchdog_is_open)
 792                 return -EBUSY;
 793
 794         /* Start the watchdog */
 795         watchdog_trigger(data);
 796         filp->private_data = data;
 797
 798         return nonseekable_open(inode, filp);
 799 }
 800
 801 static int watchdog_release(struct inode *inode, struct file *filp)
 802 {
 803         struct fschmd_data *data = filp->private_data;
 804
 805         if (data->watchdog_expect_close) {
 806                 watchdog_stop(data);
 807                 data->watchdog_expect_close = 0;
 808         } else {
 809                 watchdog_trigger(data);
 810                 dev_crit(&data->client->dev,
 811                         "unexpected close, not stopping watchdog!\n");
 812         }
 813
 814         clear_bit(0, &data->watchdog_is_open);
 815
 816         mutex_lock(&watchdog_data_mutex);
 817         kref_put(&data->kref, fschmd_release_resources);
 818         mutex_unlock(&watchdog_data_mutex);
 819
 820         return 0;
 821 }
 822
 823 static ssize_t watchdog_write(struct file *filp, const char __user *buf,
 824         size_t count, loff_t *offset)
 825 {
 826         int ret;
 827         struct fschmd_data *data = filp->private_data;
 828
 829         if (count) {
 830                 if (!nowayout) {
 831                         size_t i;
 832
 833                         /* Clear it in case it was set with a previous write */
 834                         data->watchdog_expect_close = 0;
 835
 836                         for (i = 0; i != count; i++) {
 837                                 char c;
 838                                 if (get_user(c, buf + i))
 839                                         return -EFAULT;
 840                                 if (c == 'V')
 841                                         data->watchdog_expect_close = 1;
 842                         }
 843                 }
 844                 ret = watchdog_trigger(data);
 845                 if (ret < 0)
 846                         return ret;
 847         }
 848         return count;
 849 }
 850
 851 static long watchdog_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
 852 {
 853         static struct watchdog_info ident = {
 854                 .options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT |
 855                                 WDIOF_CARDRESET,
 856                 .identity = "FSC watchdog"
 857         };
 858         int i, ret = 0;
 859         struct fschmd_data *data = filp->private_data;
 860
 861         lock_kernel();
 862         switch (cmd) {
 863         case WDIOC_GETSUPPORT:
 864                 ident.firmware_version = data->revision;
 865                 if (!nowayout)
 866                         ident.options |= WDIOF_MAGICCLOSE;
 867                 if (copy_to_user((void __user *)arg, &ident, sizeof(ident)))
 868                         ret = -EFAULT;
 869                 break;
 870
 871         case WDIOC_GETSTATUS:
 872                 ret = put_user(0, (int __user *)arg);
 873                 break;
 874
 875         case WDIOC_GETBOOTSTATUS:
 876                 if (data->watchdog_state & FSCHMD_WDOG_STATE_CARDRESET)
 877                         ret = put_user(WDIOF_CARDRESET, (int __user *)arg);
 878                 else
 879                         ret = put_user(0, (int __user *)arg);
 880                 break;
 881
 882         case WDIOC_KEEPALIVE:
 883                 ret = watchdog_trigger(data);
 884                 break;
 885
 886         case WDIOC_GETTIMEOUT:
 887                 i = watchdog_get_timeout(data);
 888                 ret = put_user(i, (int __user *)arg);
 889                 break;
 890
 891         case WDIOC_SETTIMEOUT:
 892                 if (get_user(i, (int __user *)arg)) {
 893                         ret = -EFAULT;
 894                         break;
 895                 }
 896                 ret = watchdog_set_timeout(data, i);
 897                 if (ret > 0)
 898                         ret = put_user(ret, (int __user *)arg);
 899                 break;
 900
 901         case WDIOC_SETOPTIONS:
 902                 if (get_user(i, (int __user *)arg)) {
 903                         ret = -EFAULT;
 904                         break;
 905                 }
 906
 907                 if (i & WDIOS_DISABLECARD)
 908                         ret = watchdog_stop(data);
 909                 else if (i & WDIOS_ENABLECARD)
 910                         ret = watchdog_trigger(data);
 911                 else
 912                         ret = -EINVAL;
 913
 914                 break;
 915         default:
 916                 ret = -ENOTTY;
 917         }
 918         unlock_kernel();
 919         return ret;
 920 }
 921
 922 static const struct file_operations watchdog_fops = {
 923         .owner = THIS_MODULE,
 924         .llseek = no_llseek,
 925         .open = watchdog_open,
 926         .release = watchdog_release,
 927         .write = watchdog_write,
 928         .unlocked_ioctl = watchdog_ioctl,
 929 };
 930
 931
 932 /*
 933  * Detect, register, unregister and update device functions
 934  */
 935
 936 /* DMI decode routine to read voltage scaling factors from special DMI tables,
 937    which are available on FSC machines with an fscher or later chip. */
 938 static void fschmd_dmi_decode(const struct dmi_header *header, void *dummy)
 939 {
 940         int i, mult[3] = { 0 }, offset[3] = { 0 }, vref = 0, found = 0;
 941
 942         /* dmi code ugliness, we get passed the address of the contents of
 943            a complete DMI record, but in the form of a dmi_header pointer, in
 944            reality this address holds header->length bytes of which the header
 945            are the first 4 bytes */
 946         u8 *dmi_data = (u8 *)header;
 947
 948         /* We are looking for OEM-specific type 185 */
 949         if (header->type != 185)
 950                 return;
 951
 952         /* we are looking for what Siemens calls "subtype" 19, the subtype
 953            is stored in byte 5 of the dmi block */
 954         if (header->length < 5 || dmi_data[4] != 19)
 955                 return;
 956
 957         /* After the subtype comes 1 unknown byte and then blocks of 5 bytes,
 958            consisting of what Siemens calls an "Entity" number, followed by
 959            2 16-bit words in LSB first order */
 960         for (i = 6; (i + 4) < header->length; i += 5) {
 961                 /* entity 1 - 3: voltage multiplier and offset */
 962                 if (dmi_data[i] >= 1 && dmi_data[i] <= 3) {
 963                         /* Our in sensors order and the DMI order differ */
 964                         const int shuffle[3] = { 1, 0, 2 };
 965                         int in = shuffle[dmi_data[i] - 1];
 966
 967                         /* Check for twice the same entity */
 968                         if (found & (1 << in))
 969                                 return;
 970
 971                         mult[in] = dmi_data[i + 1] | (dmi_data[i + 2] << 8);
 972                         offset[in] = dmi_data[i + 3] | (dmi_data[i + 4] << 8);
 973
 974                         found |= 1 << in;
 975                 }
 976
 977                 /* entity 7: reference voltage */
 978                 if (dmi_data[i] == 7) {
 979                         /* Check for twice the same entity */
 980                         if (found & 0x08)
 981                                 return;
 982
 983                         vref = dmi_data[i + 1] | (dmi_data[i + 2] << 8);
 984
 985                         found |= 0x08;
 986                 }
 987         }
 988
 989         if (found == 0x0F) {
 990                 for (i = 0; i < 3; i++) {
 991                         dmi_mult[i] = mult[i] * 10;
 992                         dmi_offset[i] = offset[i] * 10;
 993                 }
 994                 /* According to the docs there should be separate dmi entries
 995                    for the mult's and offsets of in3-5 of the syl, but on
 996                    my test machine these are not present */
 997                 dmi_mult[3] = dmi_mult[2];
 998                 dmi_mult[4] = dmi_mult[1];
 999                 dmi_mult[5] = dmi_mult[2];
1000                 dmi_offset[3] = dmi_offset[2];
1001                 dmi_offset[4] = dmi_offset[1];
1002                 dmi_offset[5] = dmi_offset[2];
1003                 dmi_vref = vref;
1004         }
1005 }
1006
1007 static int fschmd_detect(struct i2c_client *client,
1008                          struct i2c_board_info *info)
1009 {
1010         enum chips kind;
1011         struct i2c_adapter *adapter = client->adapter;
1012         char id[4];
1013
1014         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1015                 return -ENODEV;
1016
1017         /* Detect & Identify the chip */
1018         id[0] = i2c_smbus_read_byte_data(client, FSCHMD_REG_IDENT_0);
1019         id[1] = i2c_smbus_read_byte_data(client, FSCHMD_REG_IDENT_1);
1020         id[2] = i2c_smbus_read_byte_data(client, FSCHMD_REG_IDENT_2);
1021         id[3] = '\0';
1022
1023         if (!strcmp(id, "PEG"))
1024                 kind = fscpos;
1025         else if (!strcmp(id, "HER"))
1026                 kind = fscher;
1027         else if (!strcmp(id, "SCY"))
1028                 kind = fscscy;
1029         else if (!strcmp(id, "HRC"))
1030                 kind = fschrc;
1031         else if (!strcmp(id, "HMD"))
1032                 kind = fschmd;
1033         else if (!strcmp(id, "HDS"))
1034                 kind = fschds;
1035         else if (!strcmp(id, "SYL"))
1036                 kind = fscsyl;
1037         else
1038                 return -ENODEV;
1039
1040         strlcpy(info->type, fschmd_id[kind].name, I2C_NAME_SIZE);
1041
1042         return 0;
1043 }
1044
1045 static int fschmd_probe(struct i2c_client *client,
1046                         const struct i2c_device_id *id)
1047 {
1048         struct fschmd_data *data;
1049         const char * const names[7] = { "Poseidon", "Hermes", "Scylla",
1050                                 "Heracles", "Heimdall", "Hades", "Syleus" };
1051         const int watchdog_minors[] = { WATCHDOG_MINOR, 212, 213, 214, 215 };
1052         int i, err;
1053         enum chips kind = id->driver_data;
1054
1055         data = kzalloc(sizeof(struct fschmd_data), GFP_KERNEL);
1056         if (!data)
1057                 return -ENOMEM;
1058
1059         i2c_set_clientdata(client, data);
1060         mutex_init(&data->update_lock);
1061         mutex_init(&data->watchdog_lock);
1062         INIT_LIST_HEAD(&data->list);
1063         kref_init(&data->kref);
1064         /* Store client pointer in our data struct for watchdog usage
1065            (where the client is found through a data ptr instead of the
1066            otherway around) */
1067         data->client = client;
1068         data->kind = kind;
1069
1070         if (kind == fscpos) {
1071                 /* The Poseidon has hardwired temp limits, fill these
1072                    in for the alarm resetting code */
1073                 data->temp_max[0] = 70 + 128;
1074                 data->temp_max[1] = 50 + 128;
1075                 data->temp_max[2] = 50 + 128;
1076         }
1077
1078         /* Read the special DMI table for fscher and newer chips */
1079         if ((kind == fscher || kind >= fschrc) && dmi_vref == -1) {
1080                 dmi_walk(fschmd_dmi_decode, NULL);
1081                 if (dmi_vref == -1) {
1082                         dev_warn(&client->dev,
1083                                 "Couldn't get voltage scaling factors from "
1084                                 "BIOS DMI table, using builtin defaults\n");
1085                         dmi_vref = 33;
1086                 }
1087         }
1088
1089         /* Read in some never changing registers */
1090         data->revision = i2c_smbus_read_byte_data(client, FSCHMD_REG_REVISION);
1091         data->global_control = i2c_smbus_read_byte_data(client,
1092                                         FSCHMD_REG_CONTROL);
1093         data->watchdog_control = i2c_smbus_read_byte_data(client,
1094                                         FSCHMD_REG_WDOG_CONTROL[data->kind]);
1095         data->watchdog_state = i2c_smbus_read_byte_data(client,
1096                                         FSCHMD_REG_WDOG_STATE[data->kind]);
1097         data->watchdog_preset = i2c_smbus_read_byte_data(client,
1098                                         FSCHMD_REG_WDOG_PRESET[data->kind]);
1099
1100         err = device_create_file(&client->dev, &dev_attr_alert_led);
1101         if (err)
1102                 goto exit_detach;
1103
1104         for (i = 0; i < FSCHMD_NO_VOLT_SENSORS[data->kind]; i++) {
1105                 err = device_create_file(&client->dev,
1106                                         &fschmd_attr[i].dev_attr);
1107                 if (err)
1108                         goto exit_detach;
1109         }
1110
1111         for (i = 0; i < (FSCHMD_NO_TEMP_SENSORS[data->kind] * 4); i++) {
1112                 /* Poseidon doesn't have TEMP_LIMIT registers */
1113                 if (kind == fscpos && fschmd_temp_attr[i].dev_attr.show ==
1114                                 show_temp_max)
1115                         continue;
1116
1117                 if (kind == fscsyl) {
1118                         if (i % 4 == 0)
1119                                 data->temp_status[i / 4] =
1120                                         i2c_smbus_read_byte_data(client,
1121                                                 FSCHMD_REG_TEMP_STATE
1122                                                 [data->kind][i / 4]);
1123                         if (data->temp_status[i / 4] & FSCHMD_TEMP_DISABLED)
1124                                 continue;
1125                 }
1126
1127                 err = device_create_file(&client->dev,
1128                                         &fschmd_temp_attr[i].dev_attr);
1129                 if (err)
1130                         goto exit_detach;
1131         }
1132
1133         for (i = 0; i < (FSCHMD_NO_FAN_SENSORS[data->kind] * 5); i++) {
1134                 /* Poseidon doesn't have a FAN_MIN register for its 3rd fan */
1135                 if (kind == fscpos &&
1136                                 !strcmp(fschmd_fan_attr[i].dev_attr.attr.name,
1137                                         "pwm3_auto_point1_pwm"))
1138                         continue;
1139
1140                 if (kind == fscsyl) {
1141                         if (i % 5 == 0)
1142                                 data->fan_status[i / 5] =
1143                                         i2c_smbus_read_byte_data(client,
1144                                                 FSCHMD_REG_FAN_STATE
1145                                                 [data->kind][i / 5]);
1146                         if (data->fan_status[i / 5] & FSCHMD_FAN_DISABLED)
1147                                 continue;
1148                 }
1149
1150                 err = device_create_file(&client->dev,
1151                                         &fschmd_fan_attr[i].dev_attr);
1152                 if (err)
1153                         goto exit_detach;
1154         }
1155
1156         data->hwmon_dev = hwmon_device_register(&client->dev);
1157         if (IS_ERR(data->hwmon_dev)) {
1158                 err = PTR_ERR(data->hwmon_dev);
1159                 data->hwmon_dev = NULL;
1160                 goto exit_detach;
1161         }
1162
1163         /* We take the data_mutex lock early so that watchdog_open() cannot
1164            run when misc_register() has completed, but we've not yet added
1165            our data to the watchdog_data_list (and set the default timeout) */
1166         mutex_lock(&watchdog_data_mutex);
1167         for (i = 0; i < ARRAY_SIZE(watchdog_minors); i++) {
1168                 /* Register our watchdog part */
1169                 snprintf(data->watchdog_name, sizeof(data->watchdog_name),
1170                         "watchdog%c", (i == 0) ? '\0' : ('0' + i));
1171                 data->watchdog_miscdev.name = data->watchdog_name;
1172                 data->watchdog_miscdev.fops = &watchdog_fops;
1173                 data->watchdog_miscdev.minor = watchdog_minors[i];
1174                 err = misc_register(&data->watchdog_miscdev);
1175                 if (err == -EBUSY)
1176                         continue;
1177                 if (err) {
1178                         data->watchdog_miscdev.minor = 0;
1179                         dev_err(&client->dev,
1180                                 "Registering watchdog chardev: %d\n", err);
1181                         break;
1182                 }
1183
1184                 list_add(&data->list, &watchdog_data_list);
1185                 watchdog_set_timeout(data, 60);
1186                 dev_info(&client->dev,
1187                         "Registered watchdog chardev major 10, minor: %d\n",
1188                         watchdog_minors[i]);
1189                 break;
1190         }
1191         if (i == ARRAY_SIZE(watchdog_minors)) {
1192                 data->watchdog_miscdev.minor = 0;
1193                 dev_warn(&client->dev, "Couldn't register watchdog chardev "
1194                         "(due to no free minor)\n");
1195         }
1196         mutex_unlock(&watchdog_data_mutex);
1197
1198         dev_info(&client->dev, "Detected FSC %s chip, revision: %d\n",
1199                 names[data->kind], (int) data->revision);
1200
1201         return 0;
1202
1203 exit_detach:
1204         fschmd_remove(client); /* will also free data for us */
1205         return err;
1206 }
1207
1208 static int fschmd_remove(struct i2c_client *client)
1209 {
1210         struct fschmd_data *data = i2c_get_clientdata(client);
1211         int i;
1212
1213         /* Unregister the watchdog (if registered) */
1214         if (data->watchdog_miscdev.minor) {
1215                 misc_deregister(&data->watchdog_miscdev);
1216                 if (data->watchdog_is_open) {
1217                         dev_warn(&client->dev,
1218                                 "i2c client detached with watchdog open! "
1219                                 "Stopping watchdog.\n");
1220                         watchdog_stop(data);
1221                 }
1222                 mutex_lock(&watchdog_data_mutex);
1223                 list_del(&data->list);
1224                 mutex_unlock(&watchdog_data_mutex);
1225                 /* Tell the watchdog code the client is gone */
1226                 mutex_lock(&data->watchdog_lock);
1227                 data->client = NULL;
1228                 mutex_unlock(&data->watchdog_lock);
1229         }
1230
1231         /* Check if registered in case we're called from fschmd_detect
1232            to cleanup after an error */
1233         if (data->hwmon_dev)
1234                 hwmon_device_unregister(data->hwmon_dev);
1235
1236         device_remove_file(&client->dev, &dev_attr_alert_led);
1237         for (i = 0; i < (FSCHMD_NO_VOLT_SENSORS[data->kind]); i++)
1238                 device_remove_file(&client->dev, &fschmd_attr[i].dev_attr);
1239         for (i = 0; i < (FSCHMD_NO_TEMP_SENSORS[data->kind] * 4); i++)
1240                 device_remove_file(&client->dev,
1241                                         &fschmd_temp_attr[i].dev_attr);
1242         for (i = 0; i < (FSCHMD_NO_FAN_SENSORS[data->kind] * 5); i++)
1243                 device_remove_file(&client->dev,
1244                                         &fschmd_fan_attr[i].dev_attr);
1245
1246         mutex_lock(&watchdog_data_mutex);
1247         kref_put(&data->kref, fschmd_release_resources);
1248         mutex_unlock(&watchdog_data_mutex);
1249
1250         return 0;
1251 }
1252
1253 static struct fschmd_data *fschmd_update_device(struct device *dev)
1254 {
1255         struct i2c_client *client = to_i2c_client(dev);
1256         struct fschmd_data *data = i2c_get_clientdata(client);
1257         int i;
1258
1259         mutex_lock(&data->update_lock);
1260
1261         if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
1262
1263                 for (i = 0; i < FSCHMD_NO_TEMP_SENSORS[data->kind]; i++) {
1264                         data->temp_act[i] = i2c_smbus_read_byte_data(client,
1265                                         FSCHMD_REG_TEMP_ACT[data->kind][i]);
1266                         data->temp_status[i] = i2c_smbus_read_byte_data(client,
1267                                         FSCHMD_REG_TEMP_STATE[data->kind][i]);
1268
1269                         /* The fscpos doesn't have TEMP_LIMIT registers */
1270                         if (FSCHMD_REG_TEMP_LIMIT[data->kind][i])
1271                                 data->temp_max[i] = i2c_smbus_read_byte_data(
1272                                         client,
1273                                         FSCHMD_REG_TEMP_LIMIT[data->kind][i]);
1274
1275                         /* reset alarm if the alarm condition is gone,
1276                            the chip doesn't do this itself */
1277                         if ((data->temp_status[i] & FSCHMD_TEMP_ALARM_MASK) ==
1278                                         FSCHMD_TEMP_ALARM_MASK &&
1279                                         data->temp_act[i] < data->temp_max[i])
1280                                 i2c_smbus_write_byte_data(client,
1281                                         FSCHMD_REG_TEMP_STATE[data->kind][i],
1282                                         data->temp_status[i]);
1283                 }
1284
1285                 for (i = 0; i < FSCHMD_NO_FAN_SENSORS[data->kind]; i++) {
1286                         data->fan_act[i] = i2c_smbus_read_byte_data(client,
1287                                         FSCHMD_REG_FAN_ACT[data->kind][i]);
1288                         data->fan_status[i] = i2c_smbus_read_byte_data(client,
1289                                         FSCHMD_REG_FAN_STATE[data->kind][i]);
1290                         data->fan_ripple[i] = i2c_smbus_read_byte_data(client,
1291                                         FSCHMD_REG_FAN_RIPPLE[data->kind][i]);
1292
1293                         /* The fscpos third fan doesn't have a fan_min */
1294                         if (FSCHMD_REG_FAN_MIN[data->kind][i])
1295                                 data->fan_min[i] = i2c_smbus_read_byte_data(
1296                                         client,
1297                                         FSCHMD_REG_FAN_MIN[data->kind][i]);
1298
1299                         /* reset fan status if speed is back to > 0 */
1300                         if ((data->fan_status[i] & FSCHMD_FAN_ALARM) &&
1301                                         data->fan_act[i])
1302                                 i2c_smbus_write_byte_data(client,
1303                                         FSCHMD_REG_FAN_STATE[data->kind][i],
1304                                         data->fan_status[i]);
1305                 }
1306
1307                 for (i = 0; i < FSCHMD_NO_VOLT_SENSORS[data->kind]; i++)
1308                         data->volt[i] = i2c_smbus_read_byte_data(client,
1309                                                FSCHMD_REG_VOLT[data->kind][i]);
1310
1311                 data->last_updated = jiffies;
1312                 data->valid = 1;
1313         }
1314
1315         mutex_unlock(&data->update_lock);
1316
1317         return data;
1318 }
1319
1320 static int __init fschmd_init(void)
1321 {
1322         return i2c_add_driver(&fschmd_driver);
1323 }
1324
1325 static void __exit fschmd_exit(void)
1326 {
1327         i2c_del_driver(&fschmd_driver);
1328 }
1329
1330 MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
1331 MODULE_DESCRIPTION("FSC Poseidon, Hermes, Scylla, Heracles, Heimdall, Hades "
1332                         "and Syleus driver");
1333 MODULE_LICENSE("GPL");
1334
1335 module_init(fschmd_init);
1336 module_exit(fschmd_exit);