drivers/hwmon/max6650.c

   1 /*
   2  * max6650.c - Part of lm_sensors, Linux kernel modules for hardware
   3  *             monitoring.
   4  *
   5  * (C) 2007 by Hans J. Koch <hjk@hansjkoch.de>
   6  *
   7  * based on code written by John Morris <john.morris@spirentcom.com>
   8  * Copyright (c) 2003 Spirent Communications
   9  * and Claus Gindhart <claus.gindhart@kontron.com>
  10  *
  11  * This module has only been tested with the MAX6650 chip. It should
  12  * also work with the MAX6651. It does not distinguish max6650 and max6651
  13  * chips.
  14  *
  15  * The datasheet was last seen at:
  16  *
  17  *        http://pdfserv.maxim-ic.com/en/ds/MAX6650-MAX6651.pdf
  18  *
  19  * This program is free software; you can redistribute it and/or modify
  20  * it under the terms of the GNU General Public License as published by
  21  * the Free Software Foundation; either version 2 of the License, or
  22  * (at your option) any later version.
  23  *
  24  * This program is distributed in the hope that it will be useful,
  25  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  26  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  27  * GNU General Public License for more details.
  28  *
  29  * You should have received a copy of the GNU General Public License
  30  * along with this program; if not, write to the Free Software
  31  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  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/err.h>
  42 #include <linux/of_device.h>
  43
  44 /*
  45  * Insmod parameters
  46  */
  47
  48 /* fan_voltage: 5=5V fan, 12=12V fan, 0=don't change */
  49 static int fan_voltage;
  50 /* prescaler: Possible values are 1, 2, 4, 8, 16 or 0 for don't change */
  51 static int prescaler;
  52 /* clock: The clock frequency of the chip (max6651 can be clocked externally) */
  53 static int clock = 254000;
  54
  55 module_param(fan_voltage, int, S_IRUGO);
  56 module_param(prescaler, int, S_IRUGO);
  57 module_param(clock, int, S_IRUGO);
  58
  59 /*
  60  * MAX 6650/6651 registers
  61  */
  62
  63 #define MAX6650_REG_SPEED       0x00
  64 #define MAX6650_REG_CONFIG      0x02
  65 #define MAX6650_REG_GPIO_DEF    0x04
  66 #define MAX6650_REG_DAC         0x06
  67 #define MAX6650_REG_ALARM_EN    0x08
  68 #define MAX6650_REG_ALARM       0x0A
  69 #define MAX6650_REG_TACH0       0x0C
  70 #define MAX6650_REG_TACH1       0x0E
  71 #define MAX6650_REG_TACH2       0x10
  72 #define MAX6650_REG_TACH3       0x12
  73 #define MAX6650_REG_GPIO_STAT   0x14
  74 #define MAX6650_REG_COUNT       0x16
  75
  76 /*
  77  * Config register bits
  78  */
  79
  80 #define MAX6650_CFG_V12                 0x08
  81 #define MAX6650_CFG_PRESCALER_MASK      0x07
  82 #define MAX6650_CFG_PRESCALER_2         0x01
  83 #define MAX6650_CFG_PRESCALER_4         0x02
  84 #define MAX6650_CFG_PRESCALER_8         0x03
  85 #define MAX6650_CFG_PRESCALER_16        0x04
  86 #define MAX6650_CFG_MODE_MASK           0x30
  87 #define MAX6650_CFG_MODE_ON             0x00
  88 #define MAX6650_CFG_MODE_OFF            0x10
  89 #define MAX6650_CFG_MODE_CLOSED_LOOP    0x20
  90 #define MAX6650_CFG_MODE_OPEN_LOOP      0x30
  91 #define MAX6650_COUNT_MASK              0x03
  92
  93 /*
  94  * Alarm status register bits
  95  */
  96
  97 #define MAX6650_ALRM_MAX        0x01
  98 #define MAX6650_ALRM_MIN        0x02
  99 #define MAX6650_ALRM_TACH       0x04
 100 #define MAX6650_ALRM_GPIO1      0x08
 101 #define MAX6650_ALRM_GPIO2      0x10
 102
 103 /* Minimum and maximum values of the FAN-RPM */
 104 #define FAN_RPM_MIN 240
 105 #define FAN_RPM_MAX 30000
 106
 107 #define DIV_FROM_REG(reg) (1 << (reg & 7))
 108
 109 /*
 110  * Client data (each client gets its own)
 111  */
 112
 113 struct max6650_data {
 114         struct i2c_client *client;
 115         const struct attribute_group *groups[3];
 116         struct mutex update_lock;
 117         int nr_fans;
 118         char valid; /* zero until following fields are valid */
 119         unsigned long last_updated; /* in jiffies */
 120
 121         /* register values */
 122         u8 speed;
 123         u8 config;
 124         u8 tach[4];
 125         u8 count;
 126         u8 dac;
 127         u8 alarm;
 128 };
 129
 130 static const u8 tach_reg[] = {
 131         MAX6650_REG_TACH0,
 132         MAX6650_REG_TACH1,
 133         MAX6650_REG_TACH2,
 134         MAX6650_REG_TACH3,
 135 };
 136
 137 static const struct of_device_id max6650_dt_match[] = {
 138         {
 139                 .compatible = "maxim,max6650",
 140                 .data = (void *)1
 141         },
 142         {
 143                 .compatible = "maxim,max6651",
 144                 .data = (void *)4
 145         },
 146         { },
 147 };
 148 MODULE_DEVICE_TABLE(of, max6650_dt_match);
 149
 150 static struct max6650_data *max6650_update_device(struct device *dev)
 151 {
 152         struct max6650_data *data = dev_get_drvdata(dev);
 153         struct i2c_client *client = data->client;
 154         int i;
 155
 156         mutex_lock(&data->update_lock);
 157
 158         if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
 159                 data->speed = i2c_smbus_read_byte_data(client,
 160                                                        MAX6650_REG_SPEED);
 161                 data->config = i2c_smbus_read_byte_data(client,
 162                                                         MAX6650_REG_CONFIG);
 163                 for (i = 0; i < data->nr_fans; i++) {
 164                         data->tach[i] = i2c_smbus_read_byte_data(client,
 165                                                                  tach_reg[i]);
 166                 }
 167                 data->count = i2c_smbus_read_byte_data(client,
 168                                                         MAX6650_REG_COUNT);
 169                 data->dac = i2c_smbus_read_byte_data(client, MAX6650_REG_DAC);
 170
 171                 /*
 172                  * Alarms are cleared on read in case the condition that
 173                  * caused the alarm is removed. Keep the value latched here
 174                  * for providing the register through different alarm files.
 175                  */
 176                 data->alarm |= i2c_smbus_read_byte_data(client,
 177                                                         MAX6650_REG_ALARM);
 178
 179                 data->last_updated = jiffies;
 180                 data->valid = 1;
 181         }
 182
 183         mutex_unlock(&data->update_lock);
 184
 185         return data;
 186 }
 187
 188 /*
 189  * Change the operating mode of the chip (if needed).
 190  * mode is one of the MAX6650_CFG_MODE_* values.
 191  */
 192 static int max6650_set_operating_mode(struct max6650_data *data, u8 mode)
 193 {
 194         int result;
 195         u8 config = data->config;
 196
 197         if (mode == (config & MAX6650_CFG_MODE_MASK))
 198                 return 0;
 199
 200         config = (config & ~MAX6650_CFG_MODE_MASK) | mode;
 201
 202         result = i2c_smbus_write_byte_data(data->client, MAX6650_REG_CONFIG,
 203                                            config);
 204         if (result < 0)
 205                 return result;
 206
 207         data->config = config;
 208
 209         return 0;
 210 }
 211
 212 static ssize_t get_fan(struct device *dev, struct device_attribute *devattr,
 213                        char *buf)
 214 {
 215         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 216         struct max6650_data *data = max6650_update_device(dev);
 217         int rpm;
 218
 219         /*
 220          * Calculation details:
 221          *
 222          * Each tachometer counts over an interval given by the "count"
 223          * register (0.25, 0.5, 1 or 2 seconds). This module assumes
 224          * that the fans produce two pulses per revolution (this seems
 225          * to be the most common).
 226          */
 227
 228         rpm = ((data->tach[attr->index] * 120) / DIV_FROM_REG(data->count));
 229         return sprintf(buf, "%d\n", rpm);
 230 }
 231
 232 /*
 233  * Set the fan speed to the specified RPM (or read back the RPM setting).
 234  * This works in closed loop mode only. Use pwm1 for open loop speed setting.
 235  *
 236  * The MAX6650/1 will automatically control fan speed when in closed loop
 237  * mode.
 238  *
 239  * Assumptions:
 240  *
 241  * 1) The MAX6650/1 internal 254kHz clock frequency is set correctly. Use
 242  *    the clock module parameter if you need to fine tune this.
 243  *
 244  * 2) The prescaler (low three bits of the config register) has already
 245  *    been set to an appropriate value. Use the prescaler module parameter
 246  *    if your BIOS doesn't initialize the chip properly.
 247  *
 248  * The relevant equations are given on pages 21 and 22 of the datasheet.
 249  *
 250  * From the datasheet, the relevant equation when in regulation is:
 251  *
 252  *    [fCLK / (128 x (KTACH + 1))] = 2 x FanSpeed / KSCALE
 253  *
 254  * where:
 255  *
 256  *    fCLK is the oscillator frequency (either the 254kHz internal
 257  *         oscillator or the externally applied clock)
 258  *
 259  *    KTACH is the value in the speed register
 260  *
 261  *    FanSpeed is the speed of the fan in rps
 262  *
 263  *    KSCALE is the prescaler value (1, 2, 4, 8, or 16)
 264  *
 265  * When reading, we need to solve for FanSpeed. When writing, we need to
 266  * solve for KTACH.
 267  *
 268  * Note: this tachometer is completely separate from the tachometers
 269  * used to measure the fan speeds. Only one fan's speed (fan1) is
 270  * controlled.
 271  */
 272
 273 static ssize_t fan1_target_show(struct device *dev,
 274                                 struct device_attribute *devattr, char *buf)
 275 {
 276         struct max6650_data *data = max6650_update_device(dev);
 277         int kscale, ktach, rpm;
 278
 279         /*
 280          * Use the datasheet equation:
 281          *
 282          *    FanSpeed = KSCALE x fCLK / [256 x (KTACH + 1)]
 283          *
 284          * then multiply by 60 to give rpm.
 285          */
 286
 287         kscale = DIV_FROM_REG(data->config);
 288         ktach = data->speed;
 289         rpm = 60 * kscale * clock / (256 * (ktach + 1));
 290         return sprintf(buf, "%d\n", rpm);
 291 }
 292
 293 static int max6650_set_target(struct max6650_data *data, unsigned long rpm)
 294 {
 295         int kscale, ktach;
 296
 297         if (rpm == 0)
 298                 return max6650_set_operating_mode(data, MAX6650_CFG_MODE_OFF);
 299
 300         rpm = clamp_val(rpm, FAN_RPM_MIN, FAN_RPM_MAX);
 301
 302         /*
 303          * Divide the required speed by 60 to get from rpm to rps, then
 304          * use the datasheet equation:
 305          *
 306          *     KTACH = [(fCLK x KSCALE) / (256 x FanSpeed)] - 1
 307          */
 308
 309         kscale = DIV_FROM_REG(data->config);
 310         ktach = ((clock * kscale) / (256 * rpm / 60)) - 1;
 311         if (ktach < 0)
 312                 ktach = 0;
 313         if (ktach > 255)
 314                 ktach = 255;
 315         data->speed = ktach;
 316
 317         return i2c_smbus_write_byte_data(data->client, MAX6650_REG_SPEED,
 318                                          data->speed);
 319 }
 320
 321 static ssize_t fan1_target_store(struct device *dev,
 322                                  struct device_attribute *devattr,
 323                                  const char *buf, size_t count)
 324 {
 325         struct max6650_data *data = dev_get_drvdata(dev);
 326         unsigned long rpm;
 327         int err;
 328
 329         err = kstrtoul(buf, 10, &rpm);
 330         if (err)
 331                 return err;
 332
 333         mutex_lock(&data->update_lock);
 334
 335         err = max6650_set_target(data, rpm);
 336
 337         mutex_unlock(&data->update_lock);
 338
 339         if (err < 0)
 340                 return err;
 341
 342         return count;
 343 }
 344
 345 /*
 346  * Get/set the fan speed in open loop mode using pwm1 sysfs file.
 347  * Speed is given as a relative value from 0 to 255, where 255 is maximum
 348  * speed. Note that this is done by writing directly to the chip's DAC,
 349  * it won't change the closed loop speed set by fan1_target.
 350  * Also note that due to rounding errors it is possible that you don't read
 351  * back exactly the value you have set.
 352  */
 353
 354 static ssize_t pwm1_show(struct device *dev, struct device_attribute *devattr,
 355                          char *buf)
 356 {
 357         int pwm;
 358         struct max6650_data *data = max6650_update_device(dev);
 359
 360         /*
 361          * Useful range for dac is 0-180 for 12V fans and 0-76 for 5V fans.
 362          * Lower DAC values mean higher speeds.
 363          */
 364         if (data->config & MAX6650_CFG_V12)
 365                 pwm = 255 - (255 * (int)data->dac)/180;
 366         else
 367                 pwm = 255 - (255 * (int)data->dac)/76;
 368
 369         if (pwm < 0)
 370                 pwm = 0;
 371
 372         return sprintf(buf, "%d\n", pwm);
 373 }
 374
 375 static ssize_t pwm1_store(struct device *dev,
 376                           struct device_attribute *devattr, const char *buf,
 377                           size_t count)
 378 {
 379         struct max6650_data *data = dev_get_drvdata(dev);
 380         struct i2c_client *client = data->client;
 381         unsigned long pwm;
 382         int err;
 383
 384         err = kstrtoul(buf, 10, &pwm);
 385         if (err)
 386                 return err;
 387
 388         pwm = clamp_val(pwm, 0, 255);
 389
 390         mutex_lock(&data->update_lock);
 391
 392         if (data->config & MAX6650_CFG_V12)
 393                 data->dac = 180 - (180 * pwm)/255;
 394         else
 395                 data->dac = 76 - (76 * pwm)/255;
 396         err = i2c_smbus_write_byte_data(client, MAX6650_REG_DAC, data->dac);
 397
 398         mutex_unlock(&data->update_lock);
 399
 400         return err < 0 ? err : count;
 401 }
 402
 403 /*
 404  * Get/Set controller mode:
 405  * Possible values:
 406  * 0 = Fan always on
 407  * 1 = Open loop, Voltage is set according to speed, not regulated.
 408  * 2 = Closed loop, RPM for all fans regulated by fan1 tachometer
 409  * 3 = Fan off
 410  */
 411 static ssize_t pwm1_enable_show(struct device *dev,
 412                                 struct device_attribute *devattr, char *buf)
 413 {
 414         struct max6650_data *data = max6650_update_device(dev);
 415         int mode = (data->config & MAX6650_CFG_MODE_MASK) >> 4;
 416         int sysfs_modes[4] = {0, 3, 2, 1};
 417
 418         return sprintf(buf, "%d\n", sysfs_modes[mode]);
 419 }
 420
 421 static ssize_t pwm1_enable_store(struct device *dev,
 422                                  struct device_attribute *devattr,
 423                                  const char *buf, size_t count)
 424 {
 425         struct max6650_data *data = dev_get_drvdata(dev);
 426         unsigned long mode;
 427         int err;
 428         const u8 max6650_modes[] = {
 429                 MAX6650_CFG_MODE_ON,
 430                 MAX6650_CFG_MODE_OPEN_LOOP,
 431                 MAX6650_CFG_MODE_CLOSED_LOOP,
 432                 MAX6650_CFG_MODE_OFF,
 433                 };
 434
 435         err = kstrtoul(buf, 10, &mode);
 436         if (err)
 437                 return err;
 438
 439         if (mode >= ARRAY_SIZE(max6650_modes))
 440                 return -EINVAL;
 441
 442         mutex_lock(&data->update_lock);
 443
 444         max6650_set_operating_mode(data, max6650_modes[mode]);
 445
 446         mutex_unlock(&data->update_lock);
 447
 448         return count;
 449 }
 450
 451 /*
 452  * Read/write functions for fan1_div sysfs file. The MAX6650 has no such
 453  * divider. We handle this by converting between divider and counttime:
 454  *
 455  * (counttime == k) <==> (divider == 2^k), k = 0, 1, 2, or 3
 456  *
 457  * Lower values of k allow to connect a faster fan without the risk of
 458  * counter overflow. The price is lower resolution. You can also set counttime
 459  * using the module parameter. Note that the module parameter "prescaler" also
 460  * influences the behaviour. Unfortunately, there's no sysfs attribute
 461  * defined for that. See the data sheet for details.
 462  */
 463
 464 static ssize_t fan1_div_show(struct device *dev,
 465                              struct device_attribute *devattr, char *buf)
 466 {
 467         struct max6650_data *data = max6650_update_device(dev);
 468
 469         return sprintf(buf, "%d\n", DIV_FROM_REG(data->count));
 470 }
 471
 472 static ssize_t fan1_div_store(struct device *dev,
 473                               struct device_attribute *devattr,
 474                               const char *buf, size_t count)
 475 {
 476         struct max6650_data *data = dev_get_drvdata(dev);
 477         struct i2c_client *client = data->client;
 478         unsigned long div;
 479         int err;
 480
 481         err = kstrtoul(buf, 10, &div);
 482         if (err)
 483                 return err;
 484
 485         mutex_lock(&data->update_lock);
 486         switch (div) {
 487         case 1:
 488                 data->count = 0;
 489                 break;
 490         case 2:
 491                 data->count = 1;
 492                 break;
 493         case 4:
 494                 data->count = 2;
 495                 break;
 496         case 8:
 497                 data->count = 3;
 498                 break;
 499         default:
 500                 mutex_unlock(&data->update_lock);
 501                 return -EINVAL;
 502         }
 503
 504         i2c_smbus_write_byte_data(client, MAX6650_REG_COUNT, data->count);
 505         mutex_unlock(&data->update_lock);
 506
 507         return count;
 508 }
 509
 510 /*
 511  * Get alarm stati:
 512  * Possible values:
 513  * 0 = no alarm
 514  * 1 = alarm
 515  */
 516
 517 static ssize_t get_alarm(struct device *dev, struct device_attribute *devattr,
 518                          char *buf)
 519 {
 520         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 521         struct max6650_data *data = max6650_update_device(dev);
 522         struct i2c_client *client = data->client;
 523         int alarm = 0;
 524
 525         if (data->alarm & attr->index) {
 526                 mutex_lock(&data->update_lock);
 527                 alarm = 1;
 528                 data->alarm &= ~attr->index;
 529                 data->alarm |= i2c_smbus_read_byte_data(client,
 530                                                         MAX6650_REG_ALARM);
 531                 mutex_unlock(&data->update_lock);
 532         }
 533
 534         return sprintf(buf, "%d\n", alarm);
 535 }
 536
 537 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, get_fan, NULL, 0);
 538 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, get_fan, NULL, 1);
 539 static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, get_fan, NULL, 2);
 540 static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, get_fan, NULL, 3);
 541 static DEVICE_ATTR_RW(fan1_target);
 542 static DEVICE_ATTR_RW(fan1_div);
 543 static DEVICE_ATTR_RW(pwm1_enable);
 544 static DEVICE_ATTR_RW(pwm1);
 545 static SENSOR_DEVICE_ATTR(fan1_max_alarm, S_IRUGO, get_alarm, NULL,
 546                           MAX6650_ALRM_MAX);
 547 static SENSOR_DEVICE_ATTR(fan1_min_alarm, S_IRUGO, get_alarm, NULL,
 548                           MAX6650_ALRM_MIN);
 549 static SENSOR_DEVICE_ATTR(fan1_fault, S_IRUGO, get_alarm, NULL,
 550                           MAX6650_ALRM_TACH);
 551 static SENSOR_DEVICE_ATTR(gpio1_alarm, S_IRUGO, get_alarm, NULL,
 552                           MAX6650_ALRM_GPIO1);
 553 static SENSOR_DEVICE_ATTR(gpio2_alarm, S_IRUGO, get_alarm, NULL,
 554                           MAX6650_ALRM_GPIO2);
 555
 556 static umode_t max6650_attrs_visible(struct kobject *kobj, struct attribute *a,
 557                                     int n)
 558 {
 559         struct device *dev = container_of(kobj, struct device, kobj);
 560         struct max6650_data *data = dev_get_drvdata(dev);
 561         struct i2c_client *client = data->client;
 562         u8 alarm_en = i2c_smbus_read_byte_data(client, MAX6650_REG_ALARM_EN);
 563         struct device_attribute *devattr;
 564
 565         /*
 566          * Hide the alarms that have not been enabled by the firmware
 567          */
 568
 569         devattr = container_of(a, struct device_attribute, attr);
 570         if (devattr == &sensor_dev_attr_fan1_max_alarm.dev_attr
 571          || devattr == &sensor_dev_attr_fan1_min_alarm.dev_attr
 572          || devattr == &sensor_dev_attr_fan1_fault.dev_attr
 573          || devattr == &sensor_dev_attr_gpio1_alarm.dev_attr
 574          || devattr == &sensor_dev_attr_gpio2_alarm.dev_attr) {
 575                 if (!(alarm_en & to_sensor_dev_attr(devattr)->index))
 576                         return 0;
 577         }
 578
 579         return a->mode;
 580 }
 581
 582 static struct attribute *max6650_attrs[] = {
 583         &sensor_dev_attr_fan1_input.dev_attr.attr,
 584         &dev_attr_fan1_target.attr,
 585         &dev_attr_fan1_div.attr,
 586         &dev_attr_pwm1_enable.attr,
 587         &dev_attr_pwm1.attr,
 588         &sensor_dev_attr_fan1_max_alarm.dev_attr.attr,
 589         &sensor_dev_attr_fan1_min_alarm.dev_attr.attr,
 590         &sensor_dev_attr_fan1_fault.dev_attr.attr,
 591         &sensor_dev_attr_gpio1_alarm.dev_attr.attr,
 592         &sensor_dev_attr_gpio2_alarm.dev_attr.attr,
 593         NULL
 594 };
 595
 596 static const struct attribute_group max6650_group = {
 597         .attrs = max6650_attrs,
 598         .is_visible = max6650_attrs_visible,
 599 };
 600
 601 static struct attribute *max6651_attrs[] = {
 602         &sensor_dev_attr_fan2_input.dev_attr.attr,
 603         &sensor_dev_attr_fan3_input.dev_attr.attr,
 604         &sensor_dev_attr_fan4_input.dev_attr.attr,
 605         NULL
 606 };
 607
 608 static const struct attribute_group max6651_group = {
 609         .attrs = max6651_attrs,
 610 };
 611
 612 /*
 613  * Real code
 614  */
 615
 616 static int max6650_init_client(struct max6650_data *data,
 617                                struct i2c_client *client)
 618 {
 619         struct device *dev = &client->dev;
 620         int config;
 621         int err = -EIO;
 622         u32 voltage;
 623         u32 prescale;
 624         u32 target_rpm;
 625
 626         if (of_property_read_u32(dev->of_node, "maxim,fan-microvolt",
 627                                  &voltage))
 628                 voltage = fan_voltage;
 629         else
 630                 voltage /= 1000000; /* Microvolts to volts */
 631         if (of_property_read_u32(dev->of_node, "maxim,fan-prescale",
 632                                  &prescale))
 633                 prescale = prescaler;
 634
 635         config = i2c_smbus_read_byte_data(client, MAX6650_REG_CONFIG);
 636
 637         if (config < 0) {
 638                 dev_err(dev, "Error reading config, aborting.\n");
 639                 return err;
 640         }
 641
 642         switch (voltage) {
 643         case 0:
 644                 break;
 645         case 5:
 646                 config &= ~MAX6650_CFG_V12;
 647                 break;
 648         case 12:
 649                 config |= MAX6650_CFG_V12;
 650                 break;
 651         default:
 652                 dev_err(dev, "illegal value for fan_voltage (%d)\n", voltage);
 653         }
 654
 655         switch (prescale) {
 656         case 0:
 657                 break;
 658         case 1:
 659                 config &= ~MAX6650_CFG_PRESCALER_MASK;
 660                 break;
 661         case 2:
 662                 config = (config & ~MAX6650_CFG_PRESCALER_MASK)
 663                          | MAX6650_CFG_PRESCALER_2;
 664                 break;
 665         case  4:
 666                 config = (config & ~MAX6650_CFG_PRESCALER_MASK)
 667                          | MAX6650_CFG_PRESCALER_4;
 668                 break;
 669         case  8:
 670                 config = (config & ~MAX6650_CFG_PRESCALER_MASK)
 671                          | MAX6650_CFG_PRESCALER_8;
 672                 break;
 673         case 16:
 674                 config = (config & ~MAX6650_CFG_PRESCALER_MASK)
 675                          | MAX6650_CFG_PRESCALER_16;
 676                 break;
 677         default:
 678                 dev_err(dev, "illegal value for prescaler (%d)\n", prescale);
 679         }
 680
 681         dev_info(dev, "Fan voltage: %dV, prescaler: %d.\n",
 682                  (config & MAX6650_CFG_V12) ? 12 : 5,
 683                  1 << (config & MAX6650_CFG_PRESCALER_MASK));
 684
 685         if (i2c_smbus_write_byte_data(client, MAX6650_REG_CONFIG, config)) {
 686                 dev_err(dev, "Config write error, aborting.\n");
 687                 return err;
 688         }
 689
 690         data->config = config;
 691         data->count = i2c_smbus_read_byte_data(client, MAX6650_REG_COUNT);
 692
 693         if (!of_property_read_u32(client->dev.of_node, "maxim,fan-target-rpm",
 694                                   &target_rpm)) {
 695                 max6650_set_target(data, target_rpm);
 696                 max6650_set_operating_mode(data, MAX6650_CFG_MODE_CLOSED_LOOP);
 697         }
 698
 699         return 0;
 700 }
 701
 702 static int max6650_probe(struct i2c_client *client,
 703                          const struct i2c_device_id *id)
 704 {
 705         struct device *dev = &client->dev;
 706         const struct of_device_id *of_id =
 707                 of_match_device(of_match_ptr(max6650_dt_match), dev);
 708         struct max6650_data *data;
 709         struct device *hwmon_dev;
 710         int err;
 711
 712         data = devm_kzalloc(dev, sizeof(struct max6650_data), GFP_KERNEL);
 713         if (!data)
 714                 return -ENOMEM;
 715
 716         data->client = client;
 717         mutex_init(&data->update_lock);
 718         data->nr_fans = of_id ? (int)(uintptr_t)of_id->data : id->driver_data;
 719
 720         /*
 721          * Initialize the max6650 chip
 722          */
 723         err = max6650_init_client(data, client);
 724         if (err)
 725                 return err;
 726
 727         data->groups[0] = &max6650_group;
 728         /* 3 additional fan inputs for the MAX6651 */
 729         if (data->nr_fans == 4)
 730                 data->groups[1] = &max6651_group;
 731
 732         hwmon_dev = devm_hwmon_device_register_with_groups(dev,
 733                                                            client->name, data,
 734                                                            data->groups);
 735         return PTR_ERR_OR_ZERO(hwmon_dev);
 736 }
 737
 738 static const struct i2c_device_id max6650_id[] = {
 739         { "max6650", 1 },
 740         { "max6651", 4 },
 741         { }
 742 };
 743 MODULE_DEVICE_TABLE(i2c, max6650_id);
 744
 745 static struct i2c_driver max6650_driver = {
 746         .driver = {
 747                 .name   = "max6650",
 748                 .of_match_table = of_match_ptr(max6650_dt_match),
 749         },
 750         .probe          = max6650_probe,
 751         .id_table       = max6650_id,
 752 };
 753
 754 module_i2c_driver(max6650_driver);
 755
 756 MODULE_AUTHOR("Hans J. Koch");
 757 MODULE_DESCRIPTION("MAX6650 sensor driver");
 758 MODULE_LICENSE("GPL");