drivers/hwmon/gl520sm.c

   1 /*
   2  * gl520sm.c - Part of lm_sensors, Linux kernel modules for hardware
   3  *             monitoring
   4  * Copyright (c) 1998, 1999  Frodo Looijaard <frodol@dds.nl>,
   5  *                           Kyösti Mälkki <kmalkki@cc.hut.fi>
   6  * Copyright (c) 2005   Maarten Deprez <maartendeprez@users.sourceforge.net>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21  *
  22  */
  23
  24 #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/mutex.h>
  34 #include <linux/sysfs.h>
  35
  36 /* Type of the extra sensor */
  37 static unsigned short extra_sensor_type;
  38 module_param(extra_sensor_type, ushort, 0);
  39 MODULE_PARM_DESC(extra_sensor_type, "Type of extra sensor (0=autodetect, 1=temperature, 2=voltage)");
  40
  41 /* Addresses to scan */
  42 static const unsigned short normal_i2c[] = { 0x2c, 0x2d, I2C_CLIENT_END };
  43
  44 /*
  45  * Many GL520 constants specified below
  46  * One of the inputs can be configured as either temp or voltage.
  47  * That's why _TEMP2 and _IN4 access the same register
  48  */
  49
  50 /* The GL520 registers */
  51 #define GL520_REG_CHIP_ID               0x00
  52 #define GL520_REG_REVISION              0x01
  53 #define GL520_REG_CONF                  0x03
  54 #define GL520_REG_MASK                  0x11
  55
  56 #define GL520_REG_VID_INPUT             0x02
  57
  58 static const u8 GL520_REG_IN_INPUT[]    = { 0x15, 0x14, 0x13, 0x0d, 0x0e };
  59 static const u8 GL520_REG_IN_LIMIT[]    = { 0x0c, 0x09, 0x0a, 0x0b };
  60 static const u8 GL520_REG_IN_MIN[]      = { 0x0c, 0x09, 0x0a, 0x0b, 0x18 };
  61 static const u8 GL520_REG_IN_MAX[]      = { 0x0c, 0x09, 0x0a, 0x0b, 0x17 };
  62
  63 static const u8 GL520_REG_TEMP_INPUT[]          = { 0x04, 0x0e };
  64 static const u8 GL520_REG_TEMP_MAX[]            = { 0x05, 0x17 };
  65 static const u8 GL520_REG_TEMP_MAX_HYST[]       = { 0x06, 0x18 };
  66
  67 #define GL520_REG_FAN_INPUT             0x07
  68 #define GL520_REG_FAN_MIN               0x08
  69 #define GL520_REG_FAN_DIV               0x0f
  70 #define GL520_REG_FAN_OFF               GL520_REG_FAN_DIV
  71
  72 #define GL520_REG_ALARMS                0x12
  73 #define GL520_REG_BEEP_MASK             0x10
  74 #define GL520_REG_BEEP_ENABLE           GL520_REG_CONF
  75
  76 /*
  77  * Function declarations
  78  */
  79
  80 static int gl520_probe(struct i2c_client *client,
  81                        const struct i2c_device_id *id);
  82 static int gl520_detect(struct i2c_client *client, struct i2c_board_info *info);
  83 static void gl520_init_client(struct i2c_client *client);
  84 static int gl520_remove(struct i2c_client *client);
  85 static int gl520_read_value(struct i2c_client *client, u8 reg);
  86 static int gl520_write_value(struct i2c_client *client, u8 reg, u16 value);
  87 static struct gl520_data *gl520_update_device(struct device *dev);
  88
  89 /* Driver data */
  90 static const struct i2c_device_id gl520_id[] = {
  91         { "gl520sm", 0 },
  92         { }
  93 };
  94 MODULE_DEVICE_TABLE(i2c, gl520_id);
  95
  96 static struct i2c_driver gl520_driver = {
  97         .class          = I2C_CLASS_HWMON,
  98         .driver = {
  99                 .name   = "gl520sm",
 100         },
 101         .probe          = gl520_probe,
 102         .remove         = gl520_remove,
 103         .id_table       = gl520_id,
 104         .detect         = gl520_detect,
 105         .address_list   = normal_i2c,
 106 };
 107
 108 /* Client data */
 109 struct gl520_data {
 110         struct device *hwmon_dev;
 111         struct mutex update_lock;
 112         char valid;             /* zero until the following fields are valid */
 113         unsigned long last_updated;     /* in jiffies */
 114
 115         u8 vid;
 116         u8 vrm;
 117         u8 in_input[5];         /* [0] = VVD */
 118         u8 in_min[5];           /* [0] = VDD */
 119         u8 in_max[5];           /* [0] = VDD */
 120         u8 fan_input[2];
 121         u8 fan_min[2];
 122         u8 fan_div[2];
 123         u8 fan_off;
 124         u8 temp_input[2];
 125         u8 temp_max[2];
 126         u8 temp_max_hyst[2];
 127         u8 alarms;
 128         u8 beep_enable;
 129         u8 beep_mask;
 130         u8 alarm_mask;
 131         u8 two_temps;
 132 };
 133
 134 /*
 135  * Sysfs stuff
 136  */
 137
 138 static ssize_t get_cpu_vid(struct device *dev, struct device_attribute *attr,
 139                            char *buf)
 140 {
 141         struct gl520_data *data = gl520_update_device(dev);
 142         return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm));
 143 }
 144 static DEVICE_ATTR(cpu0_vid, S_IRUGO, get_cpu_vid, NULL);
 145
 146 #define VDD_FROM_REG(val) (((val) * 95 + 2) / 4)
 147 #define VDD_TO_REG(val) clamp_val((((val) * 4 + 47) / 95), 0, 255)
 148
 149 #define IN_FROM_REG(val) ((val) * 19)
 150 #define IN_TO_REG(val) clamp_val((((val) + 9) / 19), 0, 255)
 151
 152 static ssize_t get_in_input(struct device *dev, struct device_attribute *attr,
 153                             char *buf)
 154 {
 155         int n = to_sensor_dev_attr(attr)->index;
 156         struct gl520_data *data = gl520_update_device(dev);
 157         u8 r = data->in_input[n];
 158
 159         if (n == 0)
 160                 return sprintf(buf, "%d\n", VDD_FROM_REG(r));
 161         else
 162                 return sprintf(buf, "%d\n", IN_FROM_REG(r));
 163 }
 164
 165 static ssize_t get_in_min(struct device *dev, struct device_attribute *attr,
 166                           char *buf)
 167 {
 168         int n = to_sensor_dev_attr(attr)->index;
 169         struct gl520_data *data = gl520_update_device(dev);
 170         u8 r = data->in_min[n];
 171
 172         if (n == 0)
 173                 return sprintf(buf, "%d\n", VDD_FROM_REG(r));
 174         else
 175                 return sprintf(buf, "%d\n", IN_FROM_REG(r));
 176 }
 177
 178 static ssize_t get_in_max(struct device *dev, struct device_attribute *attr,
 179                           char *buf)
 180 {
 181         int n = to_sensor_dev_attr(attr)->index;
 182         struct gl520_data *data = gl520_update_device(dev);
 183         u8 r = data->in_max[n];
 184
 185         if (n == 0)
 186                 return sprintf(buf, "%d\n", VDD_FROM_REG(r));
 187         else
 188                 return sprintf(buf, "%d\n", IN_FROM_REG(r));
 189 }
 190
 191 static ssize_t set_in_min(struct device *dev, struct device_attribute *attr,
 192                           const char *buf, size_t count)
 193 {
 194         struct i2c_client *client = to_i2c_client(dev);
 195         struct gl520_data *data = i2c_get_clientdata(client);
 196         int n = to_sensor_dev_attr(attr)->index;
 197         u8 r;
 198         long v;
 199         int err;
 200
 201         err = kstrtol(buf, 10, &v);
 202         if (err)
 203                 return err;
 204
 205         mutex_lock(&data->update_lock);
 206
 207         if (n == 0)
 208                 r = VDD_TO_REG(v);
 209         else
 210                 r = IN_TO_REG(v);
 211
 212         data->in_min[n] = r;
 213
 214         if (n < 4)
 215                 gl520_write_value(client, GL520_REG_IN_MIN[n],
 216                                   (gl520_read_value(client, GL520_REG_IN_MIN[n])
 217                                    & ~0xff) | r);
 218         else
 219                 gl520_write_value(client, GL520_REG_IN_MIN[n], r);
 220
 221         mutex_unlock(&data->update_lock);
 222         return count;
 223 }
 224
 225 static ssize_t set_in_max(struct device *dev, struct device_attribute *attr,
 226                           const char *buf, size_t count)
 227 {
 228         struct i2c_client *client = to_i2c_client(dev);
 229         struct gl520_data *data = i2c_get_clientdata(client);
 230         int n = to_sensor_dev_attr(attr)->index;
 231         u8 r;
 232         long v;
 233         int err;
 234
 235         err = kstrtol(buf, 10, &v);
 236         if (err)
 237                 return err;
 238
 239         if (n == 0)
 240                 r = VDD_TO_REG(v);
 241         else
 242                 r = IN_TO_REG(v);
 243
 244         mutex_lock(&data->update_lock);
 245
 246         data->in_max[n] = r;
 247
 248         if (n < 4)
 249                 gl520_write_value(client, GL520_REG_IN_MAX[n],
 250                                   (gl520_read_value(client, GL520_REG_IN_MAX[n])
 251                                    & ~0xff00) | (r << 8));
 252         else
 253                 gl520_write_value(client, GL520_REG_IN_MAX[n], r);
 254
 255         mutex_unlock(&data->update_lock);
 256         return count;
 257 }
 258
 259 static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, get_in_input, NULL, 0);
 260 static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, get_in_input, NULL, 1);
 261 static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, get_in_input, NULL, 2);
 262 static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, get_in_input, NULL, 3);
 263 static SENSOR_DEVICE_ATTR(in4_input, S_IRUGO, get_in_input, NULL, 4);
 264 static SENSOR_DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR,
 265                 get_in_min, set_in_min, 0);
 266 static SENSOR_DEVICE_ATTR(in1_min, S_IRUGO | S_IWUSR,
 267                 get_in_min, set_in_min, 1);
 268 static SENSOR_DEVICE_ATTR(in2_min, S_IRUGO | S_IWUSR,
 269                 get_in_min, set_in_min, 2);
 270 static SENSOR_DEVICE_ATTR(in3_min, S_IRUGO | S_IWUSR,
 271                 get_in_min, set_in_min, 3);
 272 static SENSOR_DEVICE_ATTR(in4_min, S_IRUGO | S_IWUSR,
 273                 get_in_min, set_in_min, 4);
 274 static SENSOR_DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR,
 275                 get_in_max, set_in_max, 0);
 276 static SENSOR_DEVICE_ATTR(in1_max, S_IRUGO | S_IWUSR,
 277                 get_in_max, set_in_max, 1);
 278 static SENSOR_DEVICE_ATTR(in2_max, S_IRUGO | S_IWUSR,
 279                 get_in_max, set_in_max, 2);
 280 static SENSOR_DEVICE_ATTR(in3_max, S_IRUGO | S_IWUSR,
 281                 get_in_max, set_in_max, 3);
 282 static SENSOR_DEVICE_ATTR(in4_max, S_IRUGO | S_IWUSR,
 283                 get_in_max, set_in_max, 4);
 284
 285 #define DIV_FROM_REG(val) (1 << (val))
 286 #define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : (480000 / ((val) << (div))))
 287 #define FAN_TO_REG(val, div) ((val) <= 0 ? 0 : \
 288         clamp_val((480000 + ((val) << ((div)-1))) / ((val) << (div)), 1, 255))
 289
 290 static ssize_t get_fan_input(struct device *dev, struct device_attribute *attr,
 291                              char *buf)
 292 {
 293         int n = to_sensor_dev_attr(attr)->index;
 294         struct gl520_data *data = gl520_update_device(dev);
 295
 296         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_input[n],
 297                                                  data->fan_div[n]));
 298 }
 299
 300 static ssize_t get_fan_min(struct device *dev, struct device_attribute *attr,
 301                            char *buf)
 302 {
 303         int n = to_sensor_dev_attr(attr)->index;
 304         struct gl520_data *data = gl520_update_device(dev);
 305
 306         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[n],
 307                                                  data->fan_div[n]));
 308 }
 309
 310 static ssize_t get_fan_div(struct device *dev, struct device_attribute *attr,
 311                            char *buf)
 312 {
 313         int n = to_sensor_dev_attr(attr)->index;
 314         struct gl520_data *data = gl520_update_device(dev);
 315
 316         return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[n]));
 317 }
 318
 319 static ssize_t get_fan_off(struct device *dev, struct device_attribute *attr,
 320                            char *buf)
 321 {
 322         struct gl520_data *data = gl520_update_device(dev);
 323         return sprintf(buf, "%d\n", data->fan_off);
 324 }
 325
 326 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
 327                            const char *buf, size_t count)
 328 {
 329         struct i2c_client *client = to_i2c_client(dev);
 330         struct gl520_data *data = i2c_get_clientdata(client);
 331         int n = to_sensor_dev_attr(attr)->index;
 332         u8 r;
 333         unsigned long v;
 334         int err;
 335
 336         err = kstrtoul(buf, 10, &v);
 337         if (err)
 338                 return err;
 339
 340         mutex_lock(&data->update_lock);
 341         r = FAN_TO_REG(v, data->fan_div[n]);
 342         data->fan_min[n] = r;
 343
 344         if (n == 0)
 345                 gl520_write_value(client, GL520_REG_FAN_MIN,
 346                                   (gl520_read_value(client, GL520_REG_FAN_MIN)
 347                                    & ~0xff00) | (r << 8));
 348         else
 349                 gl520_write_value(client, GL520_REG_FAN_MIN,
 350                                   (gl520_read_value(client, GL520_REG_FAN_MIN)
 351                                    & ~0xff) | r);
 352
 353         data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK);
 354         if (data->fan_min[n] == 0)
 355                 data->alarm_mask &= (n == 0) ? ~0x20 : ~0x40;
 356         else
 357                 data->alarm_mask |= (n == 0) ? 0x20 : 0x40;
 358         data->beep_mask &= data->alarm_mask;
 359         gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
 360
 361         mutex_unlock(&data->update_lock);
 362         return count;
 363 }
 364
 365 static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
 366                            const char *buf, size_t count)
 367 {
 368         struct i2c_client *client = to_i2c_client(dev);
 369         struct gl520_data *data = i2c_get_clientdata(client);
 370         int n = to_sensor_dev_attr(attr)->index;
 371         u8 r;
 372         unsigned long v;
 373         int err;
 374
 375         err = kstrtoul(buf, 10, &v);
 376         if (err)
 377                 return err;
 378
 379         switch (v) {
 380         case 1:
 381                 r = 0;
 382                 break;
 383         case 2:
 384                 r = 1;
 385                 break;
 386         case 4:
 387                 r = 2;
 388                 break;
 389         case 8:
 390                 r = 3;
 391                 break;
 392         default:
 393                 dev_err(&client->dev,
 394         "fan_div value %ld not supported. Choose one of 1, 2, 4 or 8!\n", v);
 395                 return -EINVAL;
 396         }
 397
 398         mutex_lock(&data->update_lock);
 399         data->fan_div[n] = r;
 400
 401         if (n == 0)
 402                 gl520_write_value(client, GL520_REG_FAN_DIV,
 403                                   (gl520_read_value(client, GL520_REG_FAN_DIV)
 404                                    & ~0xc0) | (r << 6));
 405         else
 406                 gl520_write_value(client, GL520_REG_FAN_DIV,
 407                                   (gl520_read_value(client, GL520_REG_FAN_DIV)
 408                                    & ~0x30) | (r << 4));
 409
 410         mutex_unlock(&data->update_lock);
 411         return count;
 412 }
 413
 414 static ssize_t set_fan_off(struct device *dev, struct device_attribute *attr,
 415                            const char *buf, size_t count)
 416 {
 417         struct i2c_client *client = to_i2c_client(dev);
 418         struct gl520_data *data = i2c_get_clientdata(client);
 419         u8 r;
 420         unsigned long v;
 421         int err;
 422
 423         err = kstrtoul(buf, 10, &v);
 424         if (err)
 425                 return err;
 426
 427         r = (v ? 1 : 0);
 428
 429         mutex_lock(&data->update_lock);
 430         data->fan_off = r;
 431         gl520_write_value(client, GL520_REG_FAN_OFF,
 432                           (gl520_read_value(client, GL520_REG_FAN_OFF)
 433                            & ~0x0c) | (r << 2));
 434         mutex_unlock(&data->update_lock);
 435         return count;
 436 }
 437
 438 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, get_fan_input, NULL, 0);
 439 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, get_fan_input, NULL, 1);
 440 static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR,
 441                 get_fan_min, set_fan_min, 0);
 442 static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR,
 443                 get_fan_min, set_fan_min, 1);
 444 static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
 445                 get_fan_div, set_fan_div, 0);
 446 static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
 447                 get_fan_div, set_fan_div, 1);
 448 static DEVICE_ATTR(fan1_off, S_IRUGO | S_IWUSR,
 449                 get_fan_off, set_fan_off);
 450
 451 #define TEMP_FROM_REG(val) (((val) - 130) * 1000)
 452 #define TEMP_TO_REG(val) clamp_val(((((val) < 0 ? \
 453                         (val) - 500 : (val) + 500) / 1000) + 130), 0, 255)
 454
 455 static ssize_t get_temp_input(struct device *dev, struct device_attribute *attr,
 456                               char *buf)
 457 {
 458         int n = to_sensor_dev_attr(attr)->index;
 459         struct gl520_data *data = gl520_update_device(dev);
 460
 461         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_input[n]));
 462 }
 463
 464 static ssize_t get_temp_max(struct device *dev, struct device_attribute *attr,
 465                             char *buf)
 466 {
 467         int n = to_sensor_dev_attr(attr)->index;
 468         struct gl520_data *data = gl520_update_device(dev);
 469
 470         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[n]));
 471 }
 472
 473 static ssize_t get_temp_max_hyst(struct device *dev,
 474                                  struct device_attribute *attr, char *buf)
 475 {
 476         int n = to_sensor_dev_attr(attr)->index;
 477         struct gl520_data *data = gl520_update_device(dev);
 478
 479         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max_hyst[n]));
 480 }
 481
 482 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
 483                             const char *buf, size_t count)
 484 {
 485         struct i2c_client *client = to_i2c_client(dev);
 486         struct gl520_data *data = i2c_get_clientdata(client);
 487         int n = to_sensor_dev_attr(attr)->index;
 488         long v;
 489         int err;
 490
 491         err = kstrtol(buf, 10, &v);
 492         if (err)
 493                 return err;
 494
 495         mutex_lock(&data->update_lock);
 496         data->temp_max[n] = TEMP_TO_REG(v);
 497         gl520_write_value(client, GL520_REG_TEMP_MAX[n], data->temp_max[n]);
 498         mutex_unlock(&data->update_lock);
 499         return count;
 500 }
 501
 502 static ssize_t set_temp_max_hyst(struct device *dev, struct device_attribute
 503                                  *attr, const char *buf, size_t count)
 504 {
 505         struct i2c_client *client = to_i2c_client(dev);
 506         struct gl520_data *data = i2c_get_clientdata(client);
 507         int n = to_sensor_dev_attr(attr)->index;
 508         long v;
 509         int err;
 510
 511         err = kstrtol(buf, 10, &v);
 512         if (err)
 513                 return err;
 514
 515         mutex_lock(&data->update_lock);
 516         data->temp_max_hyst[n] = TEMP_TO_REG(v);
 517         gl520_write_value(client, GL520_REG_TEMP_MAX_HYST[n],
 518                           data->temp_max_hyst[n]);
 519         mutex_unlock(&data->update_lock);
 520         return count;
 521 }
 522
 523 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, get_temp_input, NULL, 0);
 524 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, get_temp_input, NULL, 1);
 525 static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
 526                 get_temp_max, set_temp_max, 0);
 527 static SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO | S_IWUSR,
 528                 get_temp_max, set_temp_max, 1);
 529 static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
 530                 get_temp_max_hyst, set_temp_max_hyst, 0);
 531 static SENSOR_DEVICE_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR,
 532                 get_temp_max_hyst, set_temp_max_hyst, 1);
 533
 534 static ssize_t get_alarms(struct device *dev, struct device_attribute *attr,
 535                           char *buf)
 536 {
 537         struct gl520_data *data = gl520_update_device(dev);
 538         return sprintf(buf, "%d\n", data->alarms);
 539 }
 540
 541 static ssize_t get_beep_enable(struct device *dev, struct device_attribute
 542                                *attr, char *buf)
 543 {
 544         struct gl520_data *data = gl520_update_device(dev);
 545         return sprintf(buf, "%d\n", data->beep_enable);
 546 }
 547
 548 static ssize_t get_beep_mask(struct device *dev, struct device_attribute *attr,
 549                              char *buf)
 550 {
 551         struct gl520_data *data = gl520_update_device(dev);
 552         return sprintf(buf, "%d\n", data->beep_mask);
 553 }
 554
 555 static ssize_t set_beep_enable(struct device *dev, struct device_attribute
 556                                *attr, const char *buf, size_t count)
 557 {
 558         struct i2c_client *client = to_i2c_client(dev);
 559         struct gl520_data *data = i2c_get_clientdata(client);
 560         u8 r;
 561         unsigned long v;
 562         int err;
 563
 564         err = kstrtoul(buf, 10, &v);
 565         if (err)
 566                 return err;
 567
 568         r = (v ? 0 : 1);
 569
 570         mutex_lock(&data->update_lock);
 571         data->beep_enable = !r;
 572         gl520_write_value(client, GL520_REG_BEEP_ENABLE,
 573                           (gl520_read_value(client, GL520_REG_BEEP_ENABLE)
 574                            & ~0x04) | (r << 2));
 575         mutex_unlock(&data->update_lock);
 576         return count;
 577 }
 578
 579 static ssize_t set_beep_mask(struct device *dev, struct device_attribute *attr,
 580                              const char *buf, size_t count)
 581 {
 582         struct i2c_client *client = to_i2c_client(dev);
 583         struct gl520_data *data = i2c_get_clientdata(client);
 584         unsigned long r;
 585         int err;
 586
 587         err = kstrtoul(buf, 10, &r);
 588         if (err)
 589                 return err;
 590
 591         mutex_lock(&data->update_lock);
 592         r &= data->alarm_mask;
 593         data->beep_mask = r;
 594         gl520_write_value(client, GL520_REG_BEEP_MASK, r);
 595         mutex_unlock(&data->update_lock);
 596         return count;
 597 }
 598
 599 static DEVICE_ATTR(alarms, S_IRUGO, get_alarms, NULL);
 600 static DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR,
 601                 get_beep_enable, set_beep_enable);
 602 static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR,
 603                 get_beep_mask, set_beep_mask);
 604
 605 static ssize_t get_alarm(struct device *dev, struct device_attribute *attr,
 606                          char *buf)
 607 {
 608         int bit_nr = to_sensor_dev_attr(attr)->index;
 609         struct gl520_data *data = gl520_update_device(dev);
 610
 611         return sprintf(buf, "%d\n", (data->alarms >> bit_nr) & 1);
 612 }
 613
 614 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, get_alarm, NULL, 0);
 615 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, get_alarm, NULL, 1);
 616 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, get_alarm, NULL, 2);
 617 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, get_alarm, NULL, 3);
 618 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, get_alarm, NULL, 4);
 619 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, get_alarm, NULL, 5);
 620 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, get_alarm, NULL, 6);
 621 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, get_alarm, NULL, 7);
 622 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, get_alarm, NULL, 7);
 623
 624 static ssize_t get_beep(struct device *dev, struct device_attribute *attr,
 625                         char *buf)
 626 {
 627         int bitnr = to_sensor_dev_attr(attr)->index;
 628         struct gl520_data *data = gl520_update_device(dev);
 629
 630         return sprintf(buf, "%d\n", (data->beep_mask >> bitnr) & 1);
 631 }
 632
 633 static ssize_t set_beep(struct device *dev, struct device_attribute *attr,
 634                         const char *buf, size_t count)
 635 {
 636         struct i2c_client *client = to_i2c_client(dev);
 637         struct gl520_data *data = i2c_get_clientdata(client);
 638         int bitnr = to_sensor_dev_attr(attr)->index;
 639         unsigned long bit;
 640
 641         int err;
 642
 643         err = kstrtoul(buf, 10, &bit);
 644         if (err)
 645                 return err;
 646         if (bit & ~1)
 647                 return -EINVAL;
 648
 649         mutex_lock(&data->update_lock);
 650         data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK);
 651         if (bit)
 652                 data->beep_mask |= (1 << bitnr);
 653         else
 654                 data->beep_mask &= ~(1 << bitnr);
 655         gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
 656         mutex_unlock(&data->update_lock);
 657         return count;
 658 }
 659
 660 static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 0);
 661 static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 1);
 662 static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 2);
 663 static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 3);
 664 static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 4);
 665 static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 5);
 666 static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 6);
 667 static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 7);
 668 static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 7);
 669
 670 static struct attribute *gl520_attributes[] = {
 671         &dev_attr_cpu0_vid.attr,
 672
 673         &sensor_dev_attr_in0_input.dev_attr.attr,
 674         &sensor_dev_attr_in0_min.dev_attr.attr,
 675         &sensor_dev_attr_in0_max.dev_attr.attr,
 676         &sensor_dev_attr_in0_alarm.dev_attr.attr,
 677         &sensor_dev_attr_in0_beep.dev_attr.attr,
 678         &sensor_dev_attr_in1_input.dev_attr.attr,
 679         &sensor_dev_attr_in1_min.dev_attr.attr,
 680         &sensor_dev_attr_in1_max.dev_attr.attr,
 681         &sensor_dev_attr_in1_alarm.dev_attr.attr,
 682         &sensor_dev_attr_in1_beep.dev_attr.attr,
 683         &sensor_dev_attr_in2_input.dev_attr.attr,
 684         &sensor_dev_attr_in2_min.dev_attr.attr,
 685         &sensor_dev_attr_in2_max.dev_attr.attr,
 686         &sensor_dev_attr_in2_alarm.dev_attr.attr,
 687         &sensor_dev_attr_in2_beep.dev_attr.attr,
 688         &sensor_dev_attr_in3_input.dev_attr.attr,
 689         &sensor_dev_attr_in3_min.dev_attr.attr,
 690         &sensor_dev_attr_in3_max.dev_attr.attr,
 691         &sensor_dev_attr_in3_alarm.dev_attr.attr,
 692         &sensor_dev_attr_in3_beep.dev_attr.attr,
 693
 694         &sensor_dev_attr_fan1_input.dev_attr.attr,
 695         &sensor_dev_attr_fan1_min.dev_attr.attr,
 696         &sensor_dev_attr_fan1_div.dev_attr.attr,
 697         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
 698         &sensor_dev_attr_fan1_beep.dev_attr.attr,
 699         &dev_attr_fan1_off.attr,
 700         &sensor_dev_attr_fan2_input.dev_attr.attr,
 701         &sensor_dev_attr_fan2_min.dev_attr.attr,
 702         &sensor_dev_attr_fan2_div.dev_attr.attr,
 703         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
 704         &sensor_dev_attr_fan2_beep.dev_attr.attr,
 705
 706         &sensor_dev_attr_temp1_input.dev_attr.attr,
 707         &sensor_dev_attr_temp1_max.dev_attr.attr,
 708         &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
 709         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
 710         &sensor_dev_attr_temp1_beep.dev_attr.attr,
 711
 712         &dev_attr_alarms.attr,
 713         &dev_attr_beep_enable.attr,
 714         &dev_attr_beep_mask.attr,
 715         NULL
 716 };
 717
 718 static const struct attribute_group gl520_group = {
 719         .attrs = gl520_attributes,
 720 };
 721
 722 static struct attribute *gl520_attributes_in4[] = {
 723         &sensor_dev_attr_in4_input.dev_attr.attr,
 724         &sensor_dev_attr_in4_min.dev_attr.attr,
 725         &sensor_dev_attr_in4_max.dev_attr.attr,
 726         &sensor_dev_attr_in4_alarm.dev_attr.attr,
 727         &sensor_dev_attr_in4_beep.dev_attr.attr,
 728         NULL
 729 };
 730
 731 static struct attribute *gl520_attributes_temp2[] = {
 732         &sensor_dev_attr_temp2_input.dev_attr.attr,
 733         &sensor_dev_attr_temp2_max.dev_attr.attr,
 734         &sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
 735         &sensor_dev_attr_temp2_alarm.dev_attr.attr,
 736         &sensor_dev_attr_temp2_beep.dev_attr.attr,
 737         NULL
 738 };
 739
 740 static const struct attribute_group gl520_group_in4 = {
 741         .attrs = gl520_attributes_in4,
 742 };
 743
 744 static const struct attribute_group gl520_group_temp2 = {
 745         .attrs = gl520_attributes_temp2,
 746 };
 747
 748
 749 /*
 750  * Real code
 751  */
 752
 753 /* Return 0 if detection is successful, -ENODEV otherwise */
 754 static int gl520_detect(struct i2c_client *client, struct i2c_board_info *info)
 755 {
 756         struct i2c_adapter *adapter = client->adapter;
 757
 758         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
 759                                      I2C_FUNC_SMBUS_WORD_DATA))
 760                 return -ENODEV;
 761
 762         /* Determine the chip type. */
 763         if ((gl520_read_value(client, GL520_REG_CHIP_ID) != 0x20) ||
 764             ((gl520_read_value(client, GL520_REG_REVISION) & 0x7f) != 0x00) ||
 765             ((gl520_read_value(client, GL520_REG_CONF) & 0x80) != 0x00)) {
 766                 dev_dbg(&client->dev, "Unknown chip type, skipping\n");
 767                 return -ENODEV;
 768         }
 769
 770         strlcpy(info->type, "gl520sm", I2C_NAME_SIZE);
 771
 772         return 0;
 773 }
 774
 775 static int gl520_probe(struct i2c_client *client,
 776                        const struct i2c_device_id *id)
 777 {
 778         struct gl520_data *data;
 779         int err;
 780
 781         data = devm_kzalloc(&client->dev, sizeof(struct gl520_data),
 782                             GFP_KERNEL);
 783         if (!data)
 784                 return -ENOMEM;
 785
 786         i2c_set_clientdata(client, data);
 787         mutex_init(&data->update_lock);
 788
 789         /* Initialize the GL520SM chip */
 790         gl520_init_client(client);
 791
 792         /* Register sysfs hooks */
 793         err = sysfs_create_group(&client->dev.kobj, &gl520_group);
 794         if (err)
 795                 return err;
 796
 797         if (data->two_temps)
 798                 err = sysfs_create_group(&client->dev.kobj, &gl520_group_temp2);
 799         else
 800                 err = sysfs_create_group(&client->dev.kobj, &gl520_group_in4);
 801
 802         if (err)
 803                 goto exit_remove_files;
 804
 805         data->hwmon_dev = hwmon_device_register(&client->dev);
 806         if (IS_ERR(data->hwmon_dev)) {
 807                 err = PTR_ERR(data->hwmon_dev);
 808                 goto exit_remove_files;
 809         }
 810
 811         return 0;
 812
 813 exit_remove_files:
 814         sysfs_remove_group(&client->dev.kobj, &gl520_group);
 815         sysfs_remove_group(&client->dev.kobj, &gl520_group_in4);
 816         sysfs_remove_group(&client->dev.kobj, &gl520_group_temp2);
 817         return err;
 818 }
 819
 820
 821 /* Called when we have found a new GL520SM. */
 822 static void gl520_init_client(struct i2c_client *client)
 823 {
 824         struct gl520_data *data = i2c_get_clientdata(client);
 825         u8 oldconf, conf;
 826
 827         conf = oldconf = gl520_read_value(client, GL520_REG_CONF);
 828
 829         data->alarm_mask = 0xff;
 830         data->vrm = vid_which_vrm();
 831
 832         if (extra_sensor_type == 1)
 833                 conf &= ~0x10;
 834         else if (extra_sensor_type == 2)
 835                 conf |= 0x10;
 836         data->two_temps = !(conf & 0x10);
 837
 838         /* If IRQ# is disabled, we can safely force comparator mode */
 839         if (!(conf & 0x20))
 840                 conf &= 0xf7;
 841
 842         /* Enable monitoring if needed */
 843         conf |= 0x40;
 844
 845         if (conf != oldconf)
 846                 gl520_write_value(client, GL520_REG_CONF, conf);
 847
 848         gl520_update_device(&(client->dev));
 849
 850         if (data->fan_min[0] == 0)
 851                 data->alarm_mask &= ~0x20;
 852         if (data->fan_min[1] == 0)
 853                 data->alarm_mask &= ~0x40;
 854
 855         data->beep_mask &= data->alarm_mask;
 856         gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask);
 857 }
 858
 859 static int gl520_remove(struct i2c_client *client)
 860 {
 861         struct gl520_data *data = i2c_get_clientdata(client);
 862
 863         hwmon_device_unregister(data->hwmon_dev);
 864         sysfs_remove_group(&client->dev.kobj, &gl520_group);
 865         sysfs_remove_group(&client->dev.kobj, &gl520_group_in4);
 866         sysfs_remove_group(&client->dev.kobj, &gl520_group_temp2);
 867
 868         return 0;
 869 }
 870
 871
 872 /*
 873  * Registers 0x07 to 0x0c are word-sized, others are byte-sized
 874  * GL520 uses a high-byte first convention
 875  */
 876 static int gl520_read_value(struct i2c_client *client, u8 reg)
 877 {
 878         if ((reg >= 0x07) && (reg <= 0x0c))
 879                 return i2c_smbus_read_word_swapped(client, reg);
 880         else
 881                 return i2c_smbus_read_byte_data(client, reg);
 882 }
 883
 884 static int gl520_write_value(struct i2c_client *client, u8 reg, u16 value)
 885 {
 886         if ((reg >= 0x07) && (reg <= 0x0c))
 887                 return i2c_smbus_write_word_swapped(client, reg, value);
 888         else
 889                 return i2c_smbus_write_byte_data(client, reg, value);
 890 }
 891
 892
 893 static struct gl520_data *gl520_update_device(struct device *dev)
 894 {
 895         struct i2c_client *client = to_i2c_client(dev);
 896         struct gl520_data *data = i2c_get_clientdata(client);
 897         int val, i;
 898
 899         mutex_lock(&data->update_lock);
 900
 901         if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
 902
 903                 dev_dbg(&client->dev, "Starting gl520sm update\n");
 904
 905                 data->alarms = gl520_read_value(client, GL520_REG_ALARMS);
 906                 data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK);
 907                 data->vid = gl520_read_value(client,
 908                                              GL520_REG_VID_INPUT) & 0x1f;
 909
 910                 for (i = 0; i < 4; i++) {
 911                         data->in_input[i] = gl520_read_value(client,
 912                                                         GL520_REG_IN_INPUT[i]);
 913                         val = gl520_read_value(client, GL520_REG_IN_LIMIT[i]);
 914                         data->in_min[i] = val & 0xff;
 915                         data->in_max[i] = (val >> 8) & 0xff;
 916                 }
 917
 918                 val = gl520_read_value(client, GL520_REG_FAN_INPUT);
 919                 data->fan_input[0] = (val >> 8) & 0xff;
 920                 data->fan_input[1] = val & 0xff;
 921
 922                 val = gl520_read_value(client, GL520_REG_FAN_MIN);
 923                 data->fan_min[0] = (val >> 8) & 0xff;
 924                 data->fan_min[1] = val & 0xff;
 925
 926                 data->temp_input[0] = gl520_read_value(client,
 927                                                 GL520_REG_TEMP_INPUT[0]);
 928                 data->temp_max[0] = gl520_read_value(client,
 929                                                 GL520_REG_TEMP_MAX[0]);
 930                 data->temp_max_hyst[0] = gl520_read_value(client,
 931                                                 GL520_REG_TEMP_MAX_HYST[0]);
 932
 933                 val = gl520_read_value(client, GL520_REG_FAN_DIV);
 934                 data->fan_div[0] = (val >> 6) & 0x03;
 935                 data->fan_div[1] = (val >> 4) & 0x03;
 936                 data->fan_off = (val >> 2) & 0x01;
 937
 938                 data->alarms &= data->alarm_mask;
 939
 940                 val = gl520_read_value(client, GL520_REG_CONF);
 941                 data->beep_enable = !((val >> 2) & 1);
 942
 943                 /* Temp1 and Vin4 are the same input */
 944                 if (data->two_temps) {
 945                         data->temp_input[1] = gl520_read_value(client,
 946                                                 GL520_REG_TEMP_INPUT[1]);
 947                         data->temp_max[1] = gl520_read_value(client,
 948                                                 GL520_REG_TEMP_MAX[1]);
 949                         data->temp_max_hyst[1] = gl520_read_value(client,
 950                                                 GL520_REG_TEMP_MAX_HYST[1]);
 951                 } else {
 952                         data->in_input[4] = gl520_read_value(client,
 953                                                 GL520_REG_IN_INPUT[4]);
 954                         data->in_min[4] = gl520_read_value(client,
 955                                                 GL520_REG_IN_MIN[4]);
 956                         data->in_max[4] = gl520_read_value(client,
 957                                                 GL520_REG_IN_MAX[4]);
 958                 }
 959
 960                 data->last_updated = jiffies;
 961                 data->valid = 1;
 962         }
 963
 964         mutex_unlock(&data->update_lock);
 965
 966         return data;
 967 }
 968
 969 module_i2c_driver(gl520_driver);
 970
 971 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
 972         "Kyösti Mälkki <kmalkki@cc.hut.fi>, "
 973         "Maarten Deprez <maartendeprez@users.sourceforge.net>");
 974 MODULE_DESCRIPTION("GL520SM driver");
 975 MODULE_LICENSE("GPL");