drivers/hwmon/smsc47m192.c

   1 /*
   2     smsc47m192.c - Support for hardware monitoring block of
   3                    SMSC LPC47M192 and compatible Super I/O chips
   4
   5     Copyright (C) 2006  Hartmut Rick <linux@rick.claranet.de>
   6
   7     Derived from lm78.c and other chip drivers.
   8
   9     This program is free software; you can redistribute it and/or modify
  10     it under the terms of the GNU General Public License as published by
  11     the Free Software Foundation; either version 2 of the License, or
  12     (at your option) any later version.
  13
  14     This program is distributed in the hope that it will be useful,
  15     but WITHOUT ANY WARRANTY; without even the implied warranty of
  16     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17     GNU General Public License for more details.
  18
  19     You should have received a copy of the GNU General Public License
  20     along with this program; if not, write to the Free Software
  21     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22 */
  23
  24 #include <linux/module.h>
  25 #include <linux/init.h>
  26 #include <linux/slab.h>
  27 #include <linux/jiffies.h>
  28 #include <linux/i2c.h>
  29 #include <linux/hwmon.h>
  30 #include <linux/hwmon-sysfs.h>
  31 #include <linux/hwmon-vid.h>
  32 #include <linux/err.h>
  33 #include <linux/sysfs.h>
  34 #include <linux/mutex.h>
  35
  36 /* Addresses to scan */
  37 static const unsigned short normal_i2c[] = { 0x2c, 0x2d, I2C_CLIENT_END };
  38
  39 /* SMSC47M192 registers */
  40 #define SMSC47M192_REG_IN(nr)           ((nr)<6 ? (0x20 + (nr)) : \
  41                                         (0x50 + (nr) - 6))
  42 #define SMSC47M192_REG_IN_MAX(nr)       ((nr)<6 ? (0x2b + (nr) * 2) : \
  43                                         (0x54 + (((nr) - 6) * 2)))
  44 #define SMSC47M192_REG_IN_MIN(nr)       ((nr)<6 ? (0x2c + (nr) * 2) : \
  45                                         (0x55 + (((nr) - 6) * 2)))
  46 static u8 SMSC47M192_REG_TEMP[3] =      { 0x27, 0x26, 0x52 };
  47 static u8 SMSC47M192_REG_TEMP_MAX[3] =  { 0x39, 0x37, 0x58 };
  48 static u8 SMSC47M192_REG_TEMP_MIN[3] =  { 0x3A, 0x38, 0x59 };
  49 #define SMSC47M192_REG_TEMP_OFFSET(nr)  ((nr)==2 ? 0x1e : 0x1f)
  50 #define SMSC47M192_REG_ALARM1           0x41
  51 #define SMSC47M192_REG_ALARM2           0x42
  52 #define SMSC47M192_REG_VID              0x47
  53 #define SMSC47M192_REG_VID4             0x49
  54 #define SMSC47M192_REG_CONFIG           0x40
  55 #define SMSC47M192_REG_SFR              0x4f
  56 #define SMSC47M192_REG_COMPANY_ID       0x3e
  57 #define SMSC47M192_REG_VERSION          0x3f
  58
  59 /* generalised scaling with integer rounding */
  60 static inline int SCALE(long val, int mul, int div)
  61 {
  62         if (val < 0)
  63                 return (val * mul - div / 2) / div;
  64         else
  65                 return (val * mul + div / 2) / div;
  66 }
  67
  68 /* Conversions */
  69
  70 /* smsc47m192 internally scales voltage measurements */
  71 static const u16 nom_mv[] = { 2500, 2250, 3300, 5000, 12000, 3300, 1500, 1800 };
  72
  73 static inline unsigned int IN_FROM_REG(u8 reg, int n)
  74 {
  75         return SCALE(reg, nom_mv[n], 192);
  76 }
  77
  78 static inline u8 IN_TO_REG(unsigned long val, int n)
  79 {
  80         return SENSORS_LIMIT(SCALE(val, 192, nom_mv[n]), 0, 255);
  81 }
  82
  83 /* TEMP: 0.001 degC units (-128C to +127C)
  84    REG: 1C/bit, two's complement */
  85 static inline s8 TEMP_TO_REG(int val)
  86 {
  87         return SCALE(SENSORS_LIMIT(val, -128000, 127000), 1, 1000);
  88 }
  89
  90 static inline int TEMP_FROM_REG(s8 val)
  91 {
  92         return val * 1000;
  93 }
  94
  95 struct smsc47m192_data {
  96         struct device *hwmon_dev;
  97         struct mutex update_lock;
  98         char valid;             /* !=0 if following fields are valid */
  99         unsigned long last_updated;     /* In jiffies */
 100
 101         u8 in[8];               /* Register value */
 102         u8 in_max[8];           /* Register value */
 103         u8 in_min[8];           /* Register value */
 104         s8 temp[3];             /* Register value */
 105         s8 temp_max[3];         /* Register value */
 106         s8 temp_min[3];         /* Register value */
 107         s8 temp_offset[3];      /* Register value */
 108         u16 alarms;             /* Register encoding, combined */
 109         u8 vid;                 /* Register encoding, combined */
 110         u8 vrm;
 111 };
 112
 113 static int smsc47m192_probe(struct i2c_client *client,
 114                             const struct i2c_device_id *id);
 115 static int smsc47m192_detect(struct i2c_client *client,
 116                              struct i2c_board_info *info);
 117 static int smsc47m192_remove(struct i2c_client *client);
 118 static struct smsc47m192_data *smsc47m192_update_device(struct device *dev);
 119
 120 static const struct i2c_device_id smsc47m192_id[] = {
 121         { "smsc47m192", 0 },
 122         { }
 123 };
 124 MODULE_DEVICE_TABLE(i2c, smsc47m192_id);
 125
 126 static struct i2c_driver smsc47m192_driver = {
 127         .class          = I2C_CLASS_HWMON,
 128         .driver = {
 129                 .name   = "smsc47m192",
 130         },
 131         .probe          = smsc47m192_probe,
 132         .remove         = smsc47m192_remove,
 133         .id_table       = smsc47m192_id,
 134         .detect         = smsc47m192_detect,
 135         .address_list   = normal_i2c,
 136 };
 137
 138 /* Voltages */
 139 static ssize_t show_in(struct device *dev, struct device_attribute *attr,
 140                 char *buf)
 141 {
 142         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 143         int nr = sensor_attr->index;
 144         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 145         return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr], nr));
 146 }
 147
 148 static ssize_t show_in_min(struct device *dev, struct device_attribute *attr,
 149                 char *buf)
 150 {
 151         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 152         int nr = sensor_attr->index;
 153         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 154         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[nr], nr));
 155 }
 156
 157 static ssize_t show_in_max(struct device *dev, struct device_attribute *attr,
 158                 char *buf)
 159 {
 160         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 161         int nr = sensor_attr->index;
 162         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 163         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[nr], nr));
 164 }
 165
 166 static ssize_t set_in_min(struct device *dev, struct device_attribute *attr,
 167                 const char *buf, size_t count)
 168 {
 169         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 170         int nr = sensor_attr->index;
 171         struct i2c_client *client = to_i2c_client(dev);
 172         struct smsc47m192_data *data = i2c_get_clientdata(client);
 173         unsigned long val = simple_strtoul(buf, NULL, 10);
 174
 175         mutex_lock(&data->update_lock);
 176         data->in_min[nr] = IN_TO_REG(val, nr);
 177         i2c_smbus_write_byte_data(client, SMSC47M192_REG_IN_MIN(nr),
 178                                                         data->in_min[nr]);
 179         mutex_unlock(&data->update_lock);
 180         return count;
 181 }
 182
 183 static ssize_t set_in_max(struct device *dev, struct device_attribute *attr,
 184                 const char *buf, size_t count)
 185 {
 186         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 187         int nr = sensor_attr->index;
 188         struct i2c_client *client = to_i2c_client(dev);
 189         struct smsc47m192_data *data = i2c_get_clientdata(client);
 190         unsigned long val = simple_strtoul(buf, NULL, 10);
 191
 192         mutex_lock(&data->update_lock);
 193         data->in_max[nr] = IN_TO_REG(val, nr);
 194         i2c_smbus_write_byte_data(client, SMSC47M192_REG_IN_MAX(nr),
 195                                                         data->in_max[nr]);
 196         mutex_unlock(&data->update_lock);
 197         return count;
 198 }
 199
 200 #define show_in_offset(offset)                                  \
 201 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO,          \
 202                 show_in, NULL, offset);                         \
 203 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR,  \
 204                 show_in_min, set_in_min, offset);               \
 205 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR,  \
 206                 show_in_max, set_in_max, offset);
 207
 208 show_in_offset(0)
 209 show_in_offset(1)
 210 show_in_offset(2)
 211 show_in_offset(3)
 212 show_in_offset(4)
 213 show_in_offset(5)
 214 show_in_offset(6)
 215 show_in_offset(7)
 216
 217 /* Temperatures */
 218 static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
 219                 char *buf)
 220 {
 221         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 222         int nr = sensor_attr->index;
 223         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 224         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr]));
 225 }
 226
 227 static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr,
 228                 char *buf)
 229 {
 230         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 231         int nr = sensor_attr->index;
 232         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 233         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
 234 }
 235
 236 static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr,
 237                 char *buf)
 238 {
 239         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 240         int nr = sensor_attr->index;
 241         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 242         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
 243 }
 244
 245 static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
 246                 const char *buf, size_t count)
 247 {
 248         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 249         int nr = sensor_attr->index;
 250         struct i2c_client *client = to_i2c_client(dev);
 251         struct smsc47m192_data *data = i2c_get_clientdata(client);
 252         long val = simple_strtol(buf, NULL, 10);
 253
 254         mutex_lock(&data->update_lock);
 255         data->temp_min[nr] = TEMP_TO_REG(val);
 256         i2c_smbus_write_byte_data(client, SMSC47M192_REG_TEMP_MIN[nr],
 257                                                 data->temp_min[nr]);
 258         mutex_unlock(&data->update_lock);
 259         return count;
 260 }
 261
 262 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
 263                 const char *buf, size_t count)
 264 {
 265         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 266         int nr = sensor_attr->index;
 267         struct i2c_client *client = to_i2c_client(dev);
 268         struct smsc47m192_data *data = i2c_get_clientdata(client);
 269         long val = simple_strtol(buf, NULL, 10);
 270
 271         mutex_lock(&data->update_lock);
 272         data->temp_max[nr] = TEMP_TO_REG(val);
 273         i2c_smbus_write_byte_data(client, SMSC47M192_REG_TEMP_MAX[nr],
 274                                                 data->temp_max[nr]);
 275         mutex_unlock(&data->update_lock);
 276         return count;
 277 }
 278
 279 static ssize_t show_temp_offset(struct device *dev, struct device_attribute
 280                 *attr, char *buf)
 281 {
 282         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 283         int nr = sensor_attr->index;
 284         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 285         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_offset[nr]));
 286 }
 287
 288 static ssize_t set_temp_offset(struct device *dev, struct device_attribute
 289                 *attr, const char *buf, size_t count)
 290 {
 291         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 292         int nr = sensor_attr->index;
 293         struct i2c_client *client = to_i2c_client(dev);
 294         struct smsc47m192_data *data = i2c_get_clientdata(client);
 295         u8 sfr = i2c_smbus_read_byte_data(client, SMSC47M192_REG_SFR);
 296         long val = simple_strtol(buf, NULL, 10);
 297
 298         mutex_lock(&data->update_lock);
 299         data->temp_offset[nr] = TEMP_TO_REG(val);
 300         if (nr>1)
 301                 i2c_smbus_write_byte_data(client,
 302                         SMSC47M192_REG_TEMP_OFFSET(nr), data->temp_offset[nr]);
 303         else if (data->temp_offset[nr] != 0) {
 304                 /* offset[0] and offset[1] share the same register,
 305                         SFR bit 4 activates offset[0] */
 306                 i2c_smbus_write_byte_data(client, SMSC47M192_REG_SFR,
 307                                         (sfr & 0xef) | (nr==0 ? 0x10 : 0));
 308                 data->temp_offset[1-nr] = 0;
 309                 i2c_smbus_write_byte_data(client,
 310                         SMSC47M192_REG_TEMP_OFFSET(nr), data->temp_offset[nr]);
 311         } else if ((sfr & 0x10) == (nr==0 ? 0x10 : 0))
 312                 i2c_smbus_write_byte_data(client,
 313                                         SMSC47M192_REG_TEMP_OFFSET(nr), 0);
 314         mutex_unlock(&data->update_lock);
 315         return count;
 316 }
 317
 318 #define show_temp_index(index)                                          \
 319 static SENSOR_DEVICE_ATTR(temp##index##_input, S_IRUGO,                 \
 320                 show_temp, NULL, index-1);                              \
 321 static SENSOR_DEVICE_ATTR(temp##index##_min, S_IRUGO | S_IWUSR,         \
 322                 show_temp_min, set_temp_min, index-1);                  \
 323 static SENSOR_DEVICE_ATTR(temp##index##_max, S_IRUGO | S_IWUSR,         \
 324                 show_temp_max, set_temp_max, index-1);                  \
 325 static SENSOR_DEVICE_ATTR(temp##index##_offset, S_IRUGO | S_IWUSR,      \
 326                 show_temp_offset, set_temp_offset, index-1);
 327
 328 show_temp_index(1)
 329 show_temp_index(2)
 330 show_temp_index(3)
 331
 332 /* VID */
 333 static ssize_t show_vid(struct device *dev, struct device_attribute *attr,
 334                 char *buf)
 335 {
 336         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 337         return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
 338 }
 339 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
 340
 341 static ssize_t show_vrm(struct device *dev, struct device_attribute *attr,
 342                 char *buf)
 343 {
 344         struct smsc47m192_data *data = dev_get_drvdata(dev);
 345         return sprintf(buf, "%d\n", data->vrm);
 346 }
 347
 348 static ssize_t set_vrm(struct device *dev, struct device_attribute *attr,
 349                 const char *buf, size_t count)
 350 {
 351         struct smsc47m192_data *data = dev_get_drvdata(dev);
 352         unsigned long val;
 353
 354         val = simple_strtoul(buf, NULL, 10);
 355         if (val > 255)
 356                 return -EINVAL;
 357
 358         data->vrm = val;
 359         return count;
 360 }
 361 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm, set_vrm);
 362
 363 /* Alarms */
 364 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
 365                 char *buf)
 366 {
 367         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 368         int nr = sensor_attr->index;
 369         struct smsc47m192_data *data = smsc47m192_update_device(dev);
 370         return sprintf(buf, "%u\n", (data->alarms & nr) ? 1 : 0);
 371 }
 372
 373 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 0x0010);
 374 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 0x0020);
 375 static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 0x0040);
 376 static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 0x4000);
 377 static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 0x8000);
 378 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0x0001);
 379 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 0x0002);
 380 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 0x0004);
 381 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 0x0008);
 382 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 0x0100);
 383 static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 0x0200);
 384 static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 0x0400);
 385 static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 0x0800);
 386
 387 static struct attribute *smsc47m192_attributes[] = {
 388         &sensor_dev_attr_in0_input.dev_attr.attr,
 389         &sensor_dev_attr_in0_min.dev_attr.attr,
 390         &sensor_dev_attr_in0_max.dev_attr.attr,
 391         &sensor_dev_attr_in0_alarm.dev_attr.attr,
 392         &sensor_dev_attr_in1_input.dev_attr.attr,
 393         &sensor_dev_attr_in1_min.dev_attr.attr,
 394         &sensor_dev_attr_in1_max.dev_attr.attr,
 395         &sensor_dev_attr_in1_alarm.dev_attr.attr,
 396         &sensor_dev_attr_in2_input.dev_attr.attr,
 397         &sensor_dev_attr_in2_min.dev_attr.attr,
 398         &sensor_dev_attr_in2_max.dev_attr.attr,
 399         &sensor_dev_attr_in2_alarm.dev_attr.attr,
 400         &sensor_dev_attr_in3_input.dev_attr.attr,
 401         &sensor_dev_attr_in3_min.dev_attr.attr,
 402         &sensor_dev_attr_in3_max.dev_attr.attr,
 403         &sensor_dev_attr_in3_alarm.dev_attr.attr,
 404         &sensor_dev_attr_in5_input.dev_attr.attr,
 405         &sensor_dev_attr_in5_min.dev_attr.attr,
 406         &sensor_dev_attr_in5_max.dev_attr.attr,
 407         &sensor_dev_attr_in5_alarm.dev_attr.attr,
 408         &sensor_dev_attr_in6_input.dev_attr.attr,
 409         &sensor_dev_attr_in6_min.dev_attr.attr,
 410         &sensor_dev_attr_in6_max.dev_attr.attr,
 411         &sensor_dev_attr_in6_alarm.dev_attr.attr,
 412         &sensor_dev_attr_in7_input.dev_attr.attr,
 413         &sensor_dev_attr_in7_min.dev_attr.attr,
 414         &sensor_dev_attr_in7_max.dev_attr.attr,
 415         &sensor_dev_attr_in7_alarm.dev_attr.attr,
 416
 417         &sensor_dev_attr_temp1_input.dev_attr.attr,
 418         &sensor_dev_attr_temp1_max.dev_attr.attr,
 419         &sensor_dev_attr_temp1_min.dev_attr.attr,
 420         &sensor_dev_attr_temp1_offset.dev_attr.attr,
 421         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
 422         &sensor_dev_attr_temp2_input.dev_attr.attr,
 423         &sensor_dev_attr_temp2_max.dev_attr.attr,
 424         &sensor_dev_attr_temp2_min.dev_attr.attr,
 425         &sensor_dev_attr_temp2_offset.dev_attr.attr,
 426         &sensor_dev_attr_temp2_alarm.dev_attr.attr,
 427         &sensor_dev_attr_temp2_fault.dev_attr.attr,
 428         &sensor_dev_attr_temp3_input.dev_attr.attr,
 429         &sensor_dev_attr_temp3_max.dev_attr.attr,
 430         &sensor_dev_attr_temp3_min.dev_attr.attr,
 431         &sensor_dev_attr_temp3_offset.dev_attr.attr,
 432         &sensor_dev_attr_temp3_alarm.dev_attr.attr,
 433         &sensor_dev_attr_temp3_fault.dev_attr.attr,
 434
 435         &dev_attr_cpu0_vid.attr,
 436         &dev_attr_vrm.attr,
 437         NULL
 438 };
 439
 440 static const struct attribute_group smsc47m192_group = {
 441         .attrs = smsc47m192_attributes,
 442 };
 443
 444 static struct attribute *smsc47m192_attributes_in4[] = {
 445         &sensor_dev_attr_in4_input.dev_attr.attr,
 446         &sensor_dev_attr_in4_min.dev_attr.attr,
 447         &sensor_dev_attr_in4_max.dev_attr.attr,
 448         &sensor_dev_attr_in4_alarm.dev_attr.attr,
 449         NULL
 450 };
 451
 452 static const struct attribute_group smsc47m192_group_in4 = {
 453         .attrs = smsc47m192_attributes_in4,
 454 };
 455
 456 static void smsc47m192_init_client(struct i2c_client *client)
 457 {
 458         int i;
 459         u8 config = i2c_smbus_read_byte_data(client, SMSC47M192_REG_CONFIG);
 460         u8 sfr = i2c_smbus_read_byte_data(client, SMSC47M192_REG_SFR);
 461
 462         /* select cycle mode (pause 1 sec between updates) */
 463         i2c_smbus_write_byte_data(client, SMSC47M192_REG_SFR,
 464                                                 (sfr & 0xfd) | 0x02);
 465         if (!(config & 0x01)) {
 466                 /* initialize alarm limits */
 467                 for (i=0; i<8; i++) {
 468                         i2c_smbus_write_byte_data(client,
 469                                 SMSC47M192_REG_IN_MIN(i), 0);
 470                         i2c_smbus_write_byte_data(client,
 471                                 SMSC47M192_REG_IN_MAX(i), 0xff);
 472                 }
 473                 for (i=0; i<3; i++) {
 474                         i2c_smbus_write_byte_data(client,
 475                                 SMSC47M192_REG_TEMP_MIN[i], 0x80);
 476                         i2c_smbus_write_byte_data(client,
 477                                 SMSC47M192_REG_TEMP_MAX[i], 0x7f);
 478                 }
 479
 480                 /* start monitoring */
 481                 i2c_smbus_write_byte_data(client, SMSC47M192_REG_CONFIG,
 482                                                 (config & 0xf7) | 0x01);
 483         }
 484 }
 485
 486 /* Return 0 if detection is successful, -ENODEV otherwise */
 487 static int smsc47m192_detect(struct i2c_client *client,
 488                              struct i2c_board_info *info)
 489 {
 490         struct i2c_adapter *adapter = client->adapter;
 491         int version;
 492
 493         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 494                 return -ENODEV;
 495
 496         /* Detection criteria from sensors_detect script */
 497         version = i2c_smbus_read_byte_data(client, SMSC47M192_REG_VERSION);
 498         if (i2c_smbus_read_byte_data(client,
 499                                 SMSC47M192_REG_COMPANY_ID) == 0x55
 500          && (version & 0xf0) == 0x20
 501          && (i2c_smbus_read_byte_data(client,
 502                                 SMSC47M192_REG_VID) & 0x70) == 0x00
 503          && (i2c_smbus_read_byte_data(client,
 504                                 SMSC47M192_REG_VID4) & 0xfe) == 0x80) {
 505                 dev_info(&adapter->dev,
 506                          "found SMSC47M192 or compatible, "
 507                          "version 2, stepping A%d\n", version & 0x0f);
 508         } else {
 509                 dev_dbg(&adapter->dev,
 510                         "SMSC47M192 detection failed at 0x%02x\n",
 511                         client->addr);
 512                 return -ENODEV;
 513         }
 514
 515         strlcpy(info->type, "smsc47m192", I2C_NAME_SIZE);
 516
 517         return 0;
 518 }
 519
 520 static int smsc47m192_probe(struct i2c_client *client,
 521                             const struct i2c_device_id *id)
 522 {
 523         struct smsc47m192_data *data;
 524         int config;
 525         int err;
 526
 527         data = kzalloc(sizeof(struct smsc47m192_data), GFP_KERNEL);
 528         if (!data) {
 529                 err = -ENOMEM;
 530                 goto exit;
 531         }
 532
 533         i2c_set_clientdata(client, data);
 534         data->vrm = vid_which_vrm();
 535         mutex_init(&data->update_lock);
 536
 537         /* Initialize the SMSC47M192 chip */
 538         smsc47m192_init_client(client);
 539
 540         /* Register sysfs hooks */
 541         if ((err = sysfs_create_group(&client->dev.kobj, &smsc47m192_group)))
 542                 goto exit_free;
 543
 544         /* Pin 110 is either in4 (+12V) or VID4 */
 545         config = i2c_smbus_read_byte_data(client, SMSC47M192_REG_CONFIG);
 546         if (!(config & 0x20)) {
 547                 if ((err = sysfs_create_group(&client->dev.kobj,
 548                                               &smsc47m192_group_in4)))
 549                         goto exit_remove_files;
 550         }
 551
 552         data->hwmon_dev = hwmon_device_register(&client->dev);
 553         if (IS_ERR(data->hwmon_dev)) {
 554                 err = PTR_ERR(data->hwmon_dev);
 555                 goto exit_remove_files;
 556         }
 557
 558         return 0;
 559
 560 exit_remove_files:
 561         sysfs_remove_group(&client->dev.kobj, &smsc47m192_group);
 562         sysfs_remove_group(&client->dev.kobj, &smsc47m192_group_in4);
 563 exit_free:
 564         kfree(data);
 565 exit:
 566         return err;
 567 }
 568
 569 static int smsc47m192_remove(struct i2c_client *client)
 570 {
 571         struct smsc47m192_data *data = i2c_get_clientdata(client);
 572
 573         hwmon_device_unregister(data->hwmon_dev);
 574         sysfs_remove_group(&client->dev.kobj, &smsc47m192_group);
 575         sysfs_remove_group(&client->dev.kobj, &smsc47m192_group_in4);
 576
 577         kfree(data);
 578
 579         return 0;
 580 }
 581
 582 static struct smsc47m192_data *smsc47m192_update_device(struct device *dev)
 583 {
 584         struct i2c_client *client = to_i2c_client(dev);
 585         struct smsc47m192_data *data = i2c_get_clientdata(client);
 586         int i, config;
 587
 588         mutex_lock(&data->update_lock);
 589
 590         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 591          || !data->valid) {
 592                 u8 sfr = i2c_smbus_read_byte_data(client, SMSC47M192_REG_SFR);
 593
 594                 dev_dbg(&client->dev, "Starting smsc47m192 update\n");
 595
 596                 for (i = 0; i <= 7; i++) {
 597                         data->in[i] = i2c_smbus_read_byte_data(client,
 598                                                 SMSC47M192_REG_IN(i));
 599                         data->in_min[i] = i2c_smbus_read_byte_data(client,
 600                                                 SMSC47M192_REG_IN_MIN(i));
 601                         data->in_max[i] = i2c_smbus_read_byte_data(client,
 602                                                 SMSC47M192_REG_IN_MAX(i));
 603                 }
 604                 for (i = 0; i < 3; i++) {
 605                         data->temp[i] = i2c_smbus_read_byte_data(client,
 606                                                 SMSC47M192_REG_TEMP[i]);
 607                         data->temp_max[i] = i2c_smbus_read_byte_data(client,
 608                                                 SMSC47M192_REG_TEMP_MAX[i]);
 609                         data->temp_min[i] = i2c_smbus_read_byte_data(client,
 610                                                 SMSC47M192_REG_TEMP_MIN[i]);
 611                 }
 612                 for (i = 1; i < 3; i++)
 613                         data->temp_offset[i] = i2c_smbus_read_byte_data(client,
 614                                                 SMSC47M192_REG_TEMP_OFFSET(i));
 615                 /* first offset is temp_offset[0] if SFR bit 4 is set,
 616                                         temp_offset[1] otherwise */
 617                 if (sfr & 0x10) {
 618                         data->temp_offset[0] = data->temp_offset[1];
 619                         data->temp_offset[1] = 0;
 620                 } else
 621                         data->temp_offset[0] = 0;
 622
 623                 data->vid = i2c_smbus_read_byte_data(client, SMSC47M192_REG_VID)
 624                             & 0x0f;
 625                 config = i2c_smbus_read_byte_data(client,
 626                                                   SMSC47M192_REG_CONFIG);
 627                 if (config & 0x20)
 628                         data->vid |= (i2c_smbus_read_byte_data(client,
 629                                         SMSC47M192_REG_VID4) & 0x01) << 4;
 630                 data->alarms = i2c_smbus_read_byte_data(client,
 631                                                 SMSC47M192_REG_ALARM1) |
 632                                (i2c_smbus_read_byte_data(client,
 633                                                 SMSC47M192_REG_ALARM2) << 8);
 634
 635                 data->last_updated = jiffies;
 636                 data->valid = 1;
 637         }
 638
 639         mutex_unlock(&data->update_lock);
 640
 641         return data;
 642 }
 643
 644 static int __init smsc47m192_init(void)
 645 {
 646         return i2c_add_driver(&smsc47m192_driver);
 647 }
 648
 649 static void __exit smsc47m192_exit(void)
 650 {
 651         i2c_del_driver(&smsc47m192_driver);
 652 }
 653
 654 MODULE_AUTHOR("Hartmut Rick <linux@rick.claranet.de>");
 655 MODULE_DESCRIPTION("SMSC47M192 driver");
 656 MODULE_LICENSE("GPL");
 657
 658 module_init(smsc47m192_init);
 659 module_exit(smsc47m192_exit);