drivers/hwmon/adt7470.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * A hwmon driver for the Analog Devices ADT7470
   4  * Copyright (C) 2007 IBM
   5  *
   6  * Author: Darrick J. Wong <darrick.wong@oracle.com>
   7  */
   8
   9 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  10
  11 #include <linux/module.h>
  12 #include <linux/jiffies.h>
  13 #include <linux/i2c.h>
  14 #include <linux/hwmon.h>
  15 #include <linux/hwmon-sysfs.h>
  16 #include <linux/err.h>
  17 #include <linux/mutex.h>
  18 #include <linux/delay.h>
  19 #include <linux/log2.h>
  20 #include <linux/kthread.h>
  21 #include <linux/regmap.h>
  22 #include <linux/sched.h>
  23 #include <linux/slab.h>
  24 #include <linux/util_macros.h>
  25
  26 /* Addresses to scan */
  27 static const unsigned short normal_i2c[] = { 0x2C, 0x2E, 0x2F, I2C_CLIENT_END };
  28
  29 /* ADT7470 registers */
  30 #define ADT7470_REG_BASE_ADDR                   0x20
  31 #define ADT7470_REG_TEMP_BASE_ADDR              0x20
  32 #define ADT7470_REG_TEMP_MAX_ADDR               0x29
  33 #define ADT7470_REG_FAN_BASE_ADDR               0x2A
  34 #define ADT7470_REG_FAN_MAX_ADDR                0x31
  35 #define ADT7470_REG_PWM_BASE_ADDR               0x32
  36 #define ADT7470_REG_PWM_MAX_ADDR                0x35
  37 #define ADT7470_REG_PWM_MAX_BASE_ADDR           0x38
  38 #define ADT7470_REG_PWM_MAX_MAX_ADDR            0x3B
  39 #define ADT7470_REG_CFG                         0x40
  40 #define         ADT7470_STRT_MASK               0x01
  41 #define         ADT7470_TEST_MASK               0x02
  42 #define         ADT7470_FSPD_MASK               0x04
  43 #define         ADT7470_T05_STB_MASK            0x80
  44 #define ADT7470_REG_ALARM1                      0x41
  45 #define         ADT7470_R1T_ALARM               0x01
  46 #define         ADT7470_R2T_ALARM               0x02
  47 #define         ADT7470_R3T_ALARM               0x04
  48 #define         ADT7470_R4T_ALARM               0x08
  49 #define         ADT7470_R5T_ALARM               0x10
  50 #define         ADT7470_R6T_ALARM               0x20
  51 #define         ADT7470_R7T_ALARM               0x40
  52 #define         ADT7470_OOL_ALARM               0x80
  53 #define ADT7470_REG_ALARM2                      0x42
  54 #define         ADT7470_R8T_ALARM               0x01
  55 #define         ADT7470_R9T_ALARM               0x02
  56 #define         ADT7470_R10T_ALARM              0x04
  57 #define         ADT7470_FAN1_ALARM              0x10
  58 #define         ADT7470_FAN2_ALARM              0x20
  59 #define         ADT7470_FAN3_ALARM              0x40
  60 #define         ADT7470_FAN4_ALARM              0x80
  61 #define ADT7470_REG_TEMP_LIMITS_BASE_ADDR       0x44
  62 #define ADT7470_REG_TEMP_LIMITS_MAX_ADDR        0x57
  63 #define ADT7470_REG_FAN_MIN_BASE_ADDR           0x58
  64 #define ADT7470_REG_FAN_MIN_MAX_ADDR            0x5F
  65 #define ADT7470_REG_FAN_MAX_BASE_ADDR           0x60
  66 #define ADT7470_REG_FAN_MAX_MAX_ADDR            0x67
  67 #define ADT7470_REG_PWM_CFG_BASE_ADDR           0x68
  68 #define ADT7470_REG_PWM12_CFG                   0x68
  69 #define         ADT7470_PWM2_AUTO_MASK          0x40
  70 #define         ADT7470_PWM1_AUTO_MASK          0x80
  71 #define         ADT7470_PWM_AUTO_MASK           0xC0
  72 #define ADT7470_REG_PWM34_CFG                   0x69
  73 #define         ADT7470_PWM3_AUTO_MASK          0x40
  74 #define         ADT7470_PWM4_AUTO_MASK          0x80
  75 #define ADT7470_REG_PWM_MIN_BASE_ADDR           0x6A
  76 #define ADT7470_REG_PWM_MIN_MAX_ADDR            0x6D
  77 #define ADT7470_REG_PWM_TEMP_MIN_BASE_ADDR      0x6E
  78 #define ADT7470_REG_PWM_TEMP_MIN_MAX_ADDR       0x71
  79 #define ADT7470_REG_CFG_2                       0x74
  80 #define ADT7470_REG_ACOUSTICS12                 0x75
  81 #define ADT7470_REG_ACOUSTICS34                 0x76
  82 #define ADT7470_REG_DEVICE                      0x3D
  83 #define ADT7470_REG_VENDOR                      0x3E
  84 #define ADT7470_REG_REVISION                    0x3F
  85 #define ADT7470_REG_ALARM1_MASK                 0x72
  86 #define ADT7470_REG_ALARM2_MASK                 0x73
  87 #define ADT7470_REG_PWM_AUTO_TEMP_BASE_ADDR     0x7C
  88 #define ADT7470_REG_PWM_AUTO_TEMP_MAX_ADDR      0x7D
  89 #define ADT7470_REG_MAX_ADDR                    0x81
  90
  91 #define ADT7470_TEMP_COUNT      10
  92 #define ADT7470_TEMP_REG(x)     (ADT7470_REG_TEMP_BASE_ADDR + (x))
  93 #define ADT7470_TEMP_MIN_REG(x) (ADT7470_REG_TEMP_LIMITS_BASE_ADDR + ((x) * 2))
  94 #define ADT7470_TEMP_MAX_REG(x) (ADT7470_REG_TEMP_LIMITS_BASE_ADDR + \
  95                                 ((x) * 2) + 1)
  96
  97 #define ADT7470_FAN_COUNT       4
  98 #define ADT7470_REG_FAN(x)      (ADT7470_REG_FAN_BASE_ADDR + ((x) * 2))
  99 #define ADT7470_REG_FAN_MIN(x)  (ADT7470_REG_FAN_MIN_BASE_ADDR + ((x) * 2))
 100 #define ADT7470_REG_FAN_MAX(x)  (ADT7470_REG_FAN_MAX_BASE_ADDR + ((x) * 2))
 101
 102 #define ADT7470_PWM_COUNT       4
 103 #define ADT7470_REG_PWM(x)      (ADT7470_REG_PWM_BASE_ADDR + (x))
 104 #define ADT7470_REG_PWM_MAX(x)  (ADT7470_REG_PWM_MAX_BASE_ADDR + (x))
 105 #define ADT7470_REG_PWM_MIN(x)  (ADT7470_REG_PWM_MIN_BASE_ADDR + (x))
 106 #define ADT7470_REG_PWM_TMIN(x) (ADT7470_REG_PWM_TEMP_MIN_BASE_ADDR + (x))
 107 #define ADT7470_REG_PWM_CFG(x)  (ADT7470_REG_PWM_CFG_BASE_ADDR + ((x) / 2))
 108 #define ADT7470_REG_PWM_AUTO_TEMP(x)    (ADT7470_REG_PWM_AUTO_TEMP_BASE_ADDR + \
 109                                         ((x) / 2))
 110
 111 #define ALARM2(x)               ((x) << 8)
 112
 113 #define ADT7470_VENDOR          0x41
 114 #define ADT7470_DEVICE          0x70
 115 /* datasheet only mentions a revision 2 */
 116 #define ADT7470_REVISION        0x02
 117
 118 /* "all temps" according to hwmon sysfs interface spec */
 119 #define ADT7470_PWM_ALL_TEMPS   0x3FF
 120
 121 /* How often do we reread sensors values? (In jiffies) */
 122 #define SENSOR_REFRESH_INTERVAL (5 * HZ)
 123
 124 /* How often do we reread sensor limit values? (In jiffies) */
 125 #define LIMIT_REFRESH_INTERVAL  (60 * HZ)
 126
 127 /* Wait at least 200ms per sensor for 10 sensors */
 128 #define TEMP_COLLECTION_TIME    2000
 129
 130 /* auto update thing won't fire more than every 2s */
 131 #define AUTO_UPDATE_INTERVAL    2000
 132
 133 /* datasheet says to divide this number by the fan reading to get fan rpm */
 134 #define FAN_PERIOD_TO_RPM(x)    ((90000 * 60) / (x))
 135 #define FAN_RPM_TO_PERIOD       FAN_PERIOD_TO_RPM
 136 #define FAN_PERIOD_INVALID      65535
 137 #define FAN_DATA_VALID(x)       ((x) && (x) != FAN_PERIOD_INVALID)
 138
 139 /* Config registers 1 and 2 include fields for selecting the PWM frequency */
 140 #define ADT7470_CFG_LF          0x40
 141 #define ADT7470_FREQ_MASK       0x70
 142 #define ADT7470_FREQ_SHIFT      4
 143
 144 struct adt7470_data {
 145         struct regmap           *regmap;
 146         struct mutex            lock;
 147         char                    sensors_valid;
 148         char                    limits_valid;
 149         unsigned long           sensors_last_updated;   /* In jiffies */
 150         unsigned long           limits_last_updated;    /* In jiffies */
 151
 152         int                     num_temp_sensors;       /* -1 = probe */
 153         int                     temperatures_probed;
 154
 155         s8                      temp[ADT7470_TEMP_COUNT];
 156         s8                      temp_min[ADT7470_TEMP_COUNT];
 157         s8                      temp_max[ADT7470_TEMP_COUNT];
 158         u16                     fan[ADT7470_FAN_COUNT];
 159         u16                     fan_min[ADT7470_FAN_COUNT];
 160         u16                     fan_max[ADT7470_FAN_COUNT];
 161         u16                     alarm;
 162         u16                     alarms_mask;
 163         u8                      force_pwm_max;
 164         u8                      pwm[ADT7470_PWM_COUNT];
 165         u8                      pwm_max[ADT7470_PWM_COUNT];
 166         u8                      pwm_automatic[ADT7470_PWM_COUNT];
 167         u8                      pwm_min[ADT7470_PWM_COUNT];
 168         s8                      pwm_tmin[ADT7470_PWM_COUNT];
 169         u8                      pwm_auto_temp[ADT7470_PWM_COUNT];
 170
 171         struct task_struct      *auto_update;
 172         unsigned int            auto_update_interval;
 173 };
 174
 175 /*
 176  * 16-bit registers on the ADT7470 are low-byte first.  The data sheet says
 177  * that the low byte must be read before the high byte.
 178  */
 179 static inline int adt7470_read_word_data(struct adt7470_data *data, unsigned int reg,
 180                                          unsigned int *val)
 181 {
 182         u8 regval[2];
 183         int err;
 184
 185         err = regmap_bulk_read(data->regmap, reg, &regval, 2);
 186         if (err < 0)
 187                 return err;
 188
 189         *val = regval[0] | (regval[1] << 8);
 190
 191         return 0;
 192 }
 193
 194 static inline int adt7470_write_word_data(struct adt7470_data *data, unsigned int reg,
 195                                           unsigned int val)
 196 {
 197         u8 regval[2];
 198
 199         regval[0] = val & 0xFF;
 200         regval[1] = val >> 8;
 201
 202         return regmap_bulk_write(data->regmap, reg, &regval, 2);
 203 }
 204
 205 /* Probe for temperature sensors.  Assumes lock is held */
 206 static int adt7470_read_temperatures(struct adt7470_data *data)
 207 {
 208         unsigned long res;
 209         unsigned int pwm_cfg[2];
 210         int err;
 211         int i;
 212         u8 pwm[ADT7470_FAN_COUNT];
 213
 214         /* save pwm[1-4] config register */
 215         err = regmap_read(data->regmap, ADT7470_REG_PWM_CFG(0), &pwm_cfg[0]);
 216         if (err < 0)
 217                 return err;
 218         err = regmap_read(data->regmap, ADT7470_REG_PWM_CFG(2), &pwm_cfg[1]);
 219         if (err < 0)
 220                 return err;
 221
 222         /* set manual pwm to whatever it is set to now */
 223         err = regmap_bulk_read(data->regmap, ADT7470_REG_PWM(0), &pwm[0],
 224                                ADT7470_PWM_COUNT);
 225         if (err < 0)
 226                 return err;
 227
 228         /* put pwm in manual mode */
 229         err = regmap_update_bits(data->regmap, ADT7470_REG_PWM_CFG(0),
 230                                  ADT7470_PWM_AUTO_MASK, 0);
 231         if (err < 0)
 232                 return err;
 233         err = regmap_update_bits(data->regmap, ADT7470_REG_PWM_CFG(2),
 234                                  ADT7470_PWM_AUTO_MASK, 0);
 235         if (err < 0)
 236                 return err;
 237
 238         /* write pwm control to whatever it was */
 239         err = regmap_bulk_write(data->regmap, ADT7470_REG_PWM(0), &pwm[0],
 240                                 ADT7470_PWM_COUNT);
 241         if (err < 0)
 242                 return err;
 243
 244         /* start reading temperature sensors */
 245         err = regmap_update_bits(data->regmap, ADT7470_REG_CFG,
 246                                  ADT7470_T05_STB_MASK, ADT7470_T05_STB_MASK);
 247         if (err < 0)
 248                 return err;
 249
 250         /* Delay is 200ms * number of temp sensors. */
 251         res = msleep_interruptible((data->num_temp_sensors >= 0 ?
 252                                     data->num_temp_sensors * 200 :
 253                                     TEMP_COLLECTION_TIME));
 254
 255         /* done reading temperature sensors */
 256         err = regmap_update_bits(data->regmap, ADT7470_REG_CFG,
 257                                  ADT7470_T05_STB_MASK, 0);
 258         if (err < 0)
 259                 return err;
 260
 261         /* restore pwm[1-4] config registers */
 262         err = regmap_write(data->regmap, ADT7470_REG_PWM_CFG(0), pwm_cfg[0]);
 263         if (err < 0)
 264                 return err;
 265         err = regmap_write(data->regmap, ADT7470_REG_PWM_CFG(2), pwm_cfg[1]);
 266         if (err < 0)
 267                 return err;
 268
 269         if (res)
 270                 return -EAGAIN;
 271
 272         /* Only count fans if we have to */
 273         if (data->num_temp_sensors >= 0)
 274                 return 0;
 275
 276         err = regmap_bulk_read(data->regmap, ADT7470_TEMP_REG(0), &data->temp[0],
 277                                ADT7470_TEMP_COUNT);
 278         if (err < 0)
 279                 return err;
 280         for (i = 0; i < ADT7470_TEMP_COUNT; i++) {
 281                 if (data->temp[i])
 282                         data->num_temp_sensors = i + 1;
 283         }
 284         data->temperatures_probed = 1;
 285         return 0;
 286 }
 287
 288 static int adt7470_update_thread(void *p)
 289 {
 290         struct i2c_client *client = p;
 291         struct adt7470_data *data = i2c_get_clientdata(client);
 292
 293         while (!kthread_should_stop()) {
 294                 mutex_lock(&data->lock);
 295                 adt7470_read_temperatures(data);
 296                 mutex_unlock(&data->lock);
 297
 298                 if (kthread_should_stop())
 299                         break;
 300
 301                 schedule_timeout_interruptible(msecs_to_jiffies(data->auto_update_interval));
 302         }
 303
 304         return 0;
 305 }
 306
 307 static int adt7470_update_sensors(struct adt7470_data *data)
 308 {
 309         unsigned int val;
 310         int err;
 311         int i;
 312
 313         if (!data->temperatures_probed)
 314                 err = adt7470_read_temperatures(data);
 315         else
 316                 err = regmap_bulk_read(data->regmap, ADT7470_TEMP_REG(0), &data->temp[0],
 317                                        ADT7470_TEMP_COUNT);
 318         if (err < 0)
 319                 return err;
 320
 321         for (i = 0; i < ADT7470_FAN_COUNT; i++) {
 322                 err = adt7470_read_word_data(data, ADT7470_REG_FAN(i), &val);
 323                 if (err < 0)
 324                         return err;
 325                 data->fan[i] =  val;
 326         }
 327
 328         err = regmap_bulk_read(data->regmap, ADT7470_REG_PWM(0), &data->pwm[0], ADT7470_PWM_COUNT);
 329         if (err < 0)
 330                 return err;
 331
 332         for (i = 0; i < ADT7470_PWM_COUNT; i++) {
 333                 unsigned int mask;
 334
 335                 if (i % 2)
 336                         mask = ADT7470_PWM2_AUTO_MASK;
 337                 else
 338                         mask = ADT7470_PWM1_AUTO_MASK;
 339
 340                 err = regmap_read(data->regmap, ADT7470_REG_PWM_CFG(i), &val);
 341                 if (err < 0)
 342                         return err;
 343                 data->pwm_automatic[i] = !!(val & mask);
 344
 345                 err = regmap_read(data->regmap, ADT7470_REG_PWM_AUTO_TEMP(i), &val);
 346                 if (err < 0)
 347                         return err;
 348                 if (!(i % 2))
 349                         data->pwm_auto_temp[i] = val >> 4;
 350                 else
 351                         data->pwm_auto_temp[i] = val & 0xF;
 352         }
 353
 354         err = regmap_read(data->regmap, ADT7470_REG_CFG, &val);
 355         if (err < 0)
 356                 return err;
 357         data->force_pwm_max = !!(val & ADT7470_FSPD_MASK);
 358
 359         err = regmap_read(data->regmap, ADT7470_REG_ALARM1, &val);
 360         if (err < 0)
 361                 return err;
 362         data->alarm = val;
 363         if (data->alarm & ADT7470_OOL_ALARM) {
 364                 err = regmap_read(data->regmap, ADT7470_REG_ALARM2, &val);
 365                 if (err < 0)
 366                         return err;
 367                 data->alarm |= ALARM2(val);
 368         }
 369
 370         err = adt7470_read_word_data(data, ADT7470_REG_ALARM1_MASK, &val);
 371         if (err < 0)
 372                 return err;
 373         data->alarms_mask = val;
 374
 375         return 0;
 376 }
 377
 378 static int adt7470_update_limits(struct adt7470_data *data)
 379 {
 380         unsigned int val;
 381         int err;
 382         int i;
 383
 384         for (i = 0; i < ADT7470_TEMP_COUNT; i++) {
 385                 err = regmap_read(data->regmap, ADT7470_TEMP_MIN_REG(i), &val);
 386                 if (err < 0)
 387                         return err;
 388                 data->temp_min[i] = (s8)val;
 389                 err = regmap_read(data->regmap, ADT7470_TEMP_MAX_REG(i), &val);
 390                 if (err < 0)
 391                         return err;
 392                 data->temp_max[i] = (s8)val;
 393         }
 394
 395         for (i = 0; i < ADT7470_FAN_COUNT; i++) {
 396                 err = adt7470_read_word_data(data, ADT7470_REG_FAN_MIN(i), &val);
 397                 if (err < 0)
 398                         return err;
 399                 data->fan_min[i] = val;
 400                 err = adt7470_read_word_data(data, ADT7470_REG_FAN_MAX(i), &val);
 401                 if (err < 0)
 402                         return err;
 403                 data->fan_max[i] = val;
 404         }
 405
 406         for (i = 0; i < ADT7470_PWM_COUNT; i++) {
 407                 err = regmap_read(data->regmap, ADT7470_REG_PWM_MAX(i), &val);
 408                 if (err < 0)
 409                         return err;
 410                 data->pwm_max[i] = val;
 411                 err = regmap_read(data->regmap, ADT7470_REG_PWM_MIN(i), &val);
 412                 if (err < 0)
 413                         return err;
 414                 data->pwm_min[i] = val;
 415                 err = regmap_read(data->regmap, ADT7470_REG_PWM_TMIN(i), &val);
 416                 if (err < 0)
 417                         return err;
 418                 data->pwm_tmin[i] = (s8)val;
 419         }
 420
 421         return 0;
 422 }
 423
 424 static struct adt7470_data *adt7470_update_device(struct device *dev)
 425 {
 426         struct adt7470_data *data = dev_get_drvdata(dev);
 427         unsigned long local_jiffies = jiffies;
 428         int need_sensors = 1;
 429         int need_limits = 1;
 430         int err;
 431
 432         /*
 433          * Figure out if we need to update the shadow registers.
 434          * Lockless means that we may occasionally report out of
 435          * date data.
 436          */
 437         if (time_before(local_jiffies, data->sensors_last_updated +
 438                         SENSOR_REFRESH_INTERVAL) &&
 439             data->sensors_valid)
 440                 need_sensors = 0;
 441
 442         if (time_before(local_jiffies, data->limits_last_updated +
 443                         LIMIT_REFRESH_INTERVAL) &&
 444             data->limits_valid)
 445                 need_limits = 0;
 446
 447         if (!need_sensors && !need_limits)
 448                 return data;
 449
 450         mutex_lock(&data->lock);
 451         if (need_sensors) {
 452                 err = adt7470_update_sensors(data);
 453                 if (err < 0)
 454                         goto out;
 455                 data->sensors_last_updated = local_jiffies;
 456                 data->sensors_valid = 1;
 457         }
 458
 459         if (need_limits) {
 460                 err = adt7470_update_limits(data);
 461                 if (err < 0)
 462                         goto out;
 463                 data->limits_last_updated = local_jiffies;
 464                 data->limits_valid = 1;
 465         }
 466 out:
 467         mutex_unlock(&data->lock);
 468
 469         return err < 0 ? ERR_PTR(err) : data;
 470 }
 471
 472 static ssize_t auto_update_interval_show(struct device *dev,
 473                                          struct device_attribute *devattr,
 474                                          char *buf)
 475 {
 476         struct adt7470_data *data = adt7470_update_device(dev);
 477
 478         if (IS_ERR(data))
 479                 return PTR_ERR(data);
 480
 481         return sprintf(buf, "%d\n", data->auto_update_interval);
 482 }
 483
 484 static ssize_t auto_update_interval_store(struct device *dev,
 485                                           struct device_attribute *devattr,
 486                                           const char *buf, size_t count)
 487 {
 488         struct adt7470_data *data = dev_get_drvdata(dev);
 489         long temp;
 490
 491         if (kstrtol(buf, 10, &temp))
 492                 return -EINVAL;
 493
 494         temp = clamp_val(temp, 0, 60000);
 495
 496         mutex_lock(&data->lock);
 497         data->auto_update_interval = temp;
 498         mutex_unlock(&data->lock);
 499
 500         return count;
 501 }
 502
 503 static ssize_t num_temp_sensors_show(struct device *dev,
 504                                      struct device_attribute *devattr,
 505                                      char *buf)
 506 {
 507         struct adt7470_data *data = adt7470_update_device(dev);
 508
 509         if (IS_ERR(data))
 510                 return PTR_ERR(data);
 511
 512         return sprintf(buf, "%d\n", data->num_temp_sensors);
 513 }
 514
 515 static ssize_t num_temp_sensors_store(struct device *dev,
 516                                       struct device_attribute *devattr,
 517                                       const char *buf, size_t count)
 518 {
 519         struct adt7470_data *data = dev_get_drvdata(dev);
 520         long temp;
 521
 522         if (kstrtol(buf, 10, &temp))
 523                 return -EINVAL;
 524
 525         temp = clamp_val(temp, -1, 10);
 526
 527         mutex_lock(&data->lock);
 528         data->num_temp_sensors = temp;
 529         if (temp < 0)
 530                 data->temperatures_probed = 0;
 531         mutex_unlock(&data->lock);
 532
 533         return count;
 534 }
 535
 536 static int adt7470_temp_read(struct device *dev, u32 attr, int channel, long *val)
 537 {
 538         struct adt7470_data *data = adt7470_update_device(dev);
 539
 540         if (IS_ERR(data))
 541                 return PTR_ERR(data);
 542
 543         switch (attr) {
 544         case hwmon_temp_input:
 545                 *val = 1000 * data->temp[channel];
 546                 break;
 547         case hwmon_temp_min:
 548                 *val = 1000 * data->temp_min[channel];
 549                 break;
 550         case hwmon_temp_max:
 551                 *val = 1000 * data->temp_max[channel];
 552                 break;
 553         case hwmon_temp_alarm:
 554                 *val = !!(data->alarm & channel);
 555                 break;
 556         default:
 557                 return -EOPNOTSUPP;
 558         }
 559
 560         return 0;
 561 }
 562
 563 static int adt7470_temp_write(struct device *dev, u32 attr, int channel, long val)
 564 {
 565         struct adt7470_data *data = dev_get_drvdata(dev);
 566         int err;
 567
 568         val = clamp_val(val, -128000, 127000);
 569         val = DIV_ROUND_CLOSEST(val, 1000);
 570
 571         switch (attr) {
 572         case hwmon_temp_min:
 573                 mutex_lock(&data->lock);
 574                 data->temp_min[channel] = val;
 575                 err = regmap_write(data->regmap, ADT7470_TEMP_MIN_REG(channel), val);
 576                 mutex_unlock(&data->lock);
 577                 break;
 578         case hwmon_temp_max:
 579                 mutex_lock(&data->lock);
 580                 data->temp_max[channel] = val;
 581                 err = regmap_write(data->regmap, ADT7470_TEMP_MAX_REG(channel), val);
 582                 mutex_unlock(&data->lock);
 583                 break;
 584         default:
 585                 return -EOPNOTSUPP;
 586         }
 587
 588         return err;
 589 }
 590
 591 static ssize_t alarm_mask_show(struct device *dev,
 592                                struct device_attribute *devattr, char *buf)
 593 {
 594         struct adt7470_data *data = adt7470_update_device(dev);
 595
 596         if (IS_ERR(data))
 597                 return PTR_ERR(data);
 598
 599         return sprintf(buf, "%x\n", data->alarms_mask);
 600 }
 601
 602 static ssize_t alarm_mask_store(struct device *dev,
 603                                 struct device_attribute *devattr,
 604                                 const char *buf, size_t count)
 605 {
 606         struct adt7470_data *data = dev_get_drvdata(dev);
 607         long mask;
 608         int err;
 609
 610         if (kstrtoul(buf, 0, &mask))
 611                 return -EINVAL;
 612
 613         if (mask & ~0xffff)
 614                 return -EINVAL;
 615
 616         mutex_lock(&data->lock);
 617         data->alarms_mask = mask;
 618         err = adt7470_write_word_data(data, ADT7470_REG_ALARM1_MASK, mask);
 619         mutex_unlock(&data->lock);
 620
 621         return err < 0 ? err : count;
 622 }
 623
 624 static int adt7470_fan_read(struct device *dev, u32 attr, int channel, long *val)
 625 {
 626         struct adt7470_data *data = adt7470_update_device(dev);
 627
 628         if (IS_ERR(data))
 629                 return PTR_ERR(data);
 630
 631         switch (attr) {
 632         case hwmon_fan_input:
 633                 if (FAN_DATA_VALID(data->fan[channel]))
 634                         *val = FAN_PERIOD_TO_RPM(data->fan[channel]);
 635                 else
 636                         *val = 0;
 637                 break;
 638         case hwmon_fan_min:
 639                 if (FAN_DATA_VALID(data->fan_min[channel]))
 640                         *val = FAN_PERIOD_TO_RPM(data->fan_min[channel]);
 641                 else
 642                         *val = 0;
 643                 break;
 644         case hwmon_fan_max:
 645                 if (FAN_DATA_VALID(data->fan_max[channel]))
 646                         *val = FAN_PERIOD_TO_RPM(data->fan_max[channel]);
 647                 else
 648                         *val = 0;
 649                 break;
 650         case hwmon_fan_alarm:
 651                 *val = !!(data->alarm & (1 << (12 + channel)));
 652                 break;
 653         default:
 654                 return -EOPNOTSUPP;
 655         }
 656
 657         return 0;
 658 }
 659
 660 static int adt7470_fan_write(struct device *dev, u32 attr, int channel, long val)
 661 {
 662         struct adt7470_data *data = dev_get_drvdata(dev);
 663         int err;
 664
 665         if (val <= 0)
 666                 return -EINVAL;
 667
 668         val = FAN_RPM_TO_PERIOD(val);
 669         val = clamp_val(val, 1, 65534);
 670
 671         switch (attr) {
 672         case hwmon_fan_min:
 673                 mutex_lock(&data->lock);
 674                 data->fan_min[channel] = val;
 675                 err = adt7470_write_word_data(data, ADT7470_REG_FAN_MIN(channel), val);
 676                 mutex_unlock(&data->lock);
 677                 break;
 678         case hwmon_fan_max:
 679                 mutex_lock(&data->lock);
 680                 data->fan_max[channel] = val;
 681                 err = adt7470_write_word_data(data, ADT7470_REG_FAN_MAX(channel), val);
 682                 mutex_unlock(&data->lock);
 683                 break;
 684         default:
 685                 return -EOPNOTSUPP;
 686         }
 687
 688         return err;
 689 }
 690
 691 static ssize_t force_pwm_max_show(struct device *dev,
 692                                   struct device_attribute *devattr, char *buf)
 693 {
 694         struct adt7470_data *data = adt7470_update_device(dev);
 695
 696         if (IS_ERR(data))
 697                 return PTR_ERR(data);
 698
 699         return sprintf(buf, "%d\n", data->force_pwm_max);
 700 }
 701
 702 static ssize_t force_pwm_max_store(struct device *dev,
 703                                    struct device_attribute *devattr,
 704                                    const char *buf, size_t count)
 705 {
 706         struct adt7470_data *data = dev_get_drvdata(dev);
 707         long temp;
 708         int err;
 709
 710         if (kstrtol(buf, 10, &temp))
 711                 return -EINVAL;
 712
 713         mutex_lock(&data->lock);
 714         data->force_pwm_max = temp;
 715         err = regmap_update_bits(data->regmap, ADT7470_REG_CFG,
 716                                  ADT7470_FSPD_MASK,
 717                                  temp ? ADT7470_FSPD_MASK : 0);
 718         mutex_unlock(&data->lock);
 719
 720         return err < 0 ? err : count;
 721 }
 722
 723 /* These are the valid PWM frequencies to the nearest Hz */
 724 static const int adt7470_freq_map[] = {
 725         11, 15, 22, 29, 35, 44, 59, 88, 1400, 22500
 726 };
 727
 728 static int pwm1_freq_get(struct device *dev)
 729 {
 730         struct adt7470_data *data = dev_get_drvdata(dev);
 731         unsigned int cfg_reg_1, cfg_reg_2;
 732         int index;
 733         int err;
 734
 735         mutex_lock(&data->lock);
 736         err = regmap_read(data->regmap, ADT7470_REG_CFG, &cfg_reg_1);
 737         if (err < 0)
 738                 goto out;
 739         err = regmap_read(data->regmap, ADT7470_REG_CFG_2, &cfg_reg_2);
 740         if (err < 0)
 741                 goto out;
 742         mutex_unlock(&data->lock);
 743
 744         index = (cfg_reg_2 & ADT7470_FREQ_MASK) >> ADT7470_FREQ_SHIFT;
 745         if (!(cfg_reg_1 & ADT7470_CFG_LF))
 746                 index += 8;
 747         if (index >= ARRAY_SIZE(adt7470_freq_map))
 748                 index = ARRAY_SIZE(adt7470_freq_map) - 1;
 749
 750         return adt7470_freq_map[index];
 751
 752 out:
 753         mutex_unlock(&data->lock);
 754         return err;
 755 }
 756
 757 static int adt7470_pwm_read(struct device *dev, u32 attr, int channel, long *val)
 758 {
 759         struct adt7470_data *data = adt7470_update_device(dev);
 760
 761         if (IS_ERR(data))
 762                 return PTR_ERR(data);
 763
 764         switch (attr) {
 765         case hwmon_pwm_input:
 766                 *val = data->pwm[channel];
 767                 break;
 768         case hwmon_pwm_enable:
 769                 *val = 1 + data->pwm_automatic[channel];
 770                 break;
 771         case hwmon_pwm_freq:
 772                 *val = pwm1_freq_get(dev);
 773                 break;
 774         default:
 775                 return -EOPNOTSUPP;
 776         }
 777
 778         return 0;
 779 }
 780
 781 static int pwm1_freq_set(struct device *dev, long freq)
 782 {
 783         struct adt7470_data *data = dev_get_drvdata(dev);
 784         unsigned int low_freq = ADT7470_CFG_LF;
 785         int index;
 786         int err;
 787
 788         /* Round the user value given to the closest available frequency */
 789         index = find_closest(freq, adt7470_freq_map,
 790                              ARRAY_SIZE(adt7470_freq_map));
 791
 792         if (index >= 8) {
 793                 index -= 8;
 794                 low_freq = 0;
 795         }
 796
 797         mutex_lock(&data->lock);
 798         /* Configuration Register 1 */
 799         err = regmap_update_bits(data->regmap, ADT7470_REG_CFG,
 800                                  ADT7470_CFG_LF, low_freq);
 801         if (err < 0)
 802                 goto out;
 803
 804         /* Configuration Register 2 */
 805         err = regmap_update_bits(data->regmap, ADT7470_REG_CFG_2,
 806                                  ADT7470_FREQ_MASK,
 807                                  index << ADT7470_FREQ_SHIFT);
 808 out:
 809         mutex_unlock(&data->lock);
 810
 811         return err;
 812 }
 813
 814 static int adt7470_pwm_write(struct device *dev, u32 attr, int channel, long val)
 815 {
 816         struct adt7470_data *data = dev_get_drvdata(dev);
 817         unsigned int pwm_auto_reg_mask;
 818         int err;
 819
 820         switch (attr) {
 821         case hwmon_pwm_input:
 822                 val = clamp_val(val, 0, 255);
 823                 mutex_lock(&data->lock);
 824                 data->pwm[channel] = val;
 825                 err = regmap_write(data->regmap, ADT7470_REG_PWM(channel),
 826                                    data->pwm[channel]);
 827                 mutex_unlock(&data->lock);
 828                 break;
 829         case hwmon_pwm_enable:
 830                 if (channel % 2)
 831                         pwm_auto_reg_mask = ADT7470_PWM2_AUTO_MASK;
 832                 else
 833                         pwm_auto_reg_mask = ADT7470_PWM1_AUTO_MASK;
 834
 835                 if (val != 2 && val != 1)
 836                         return -EINVAL;
 837                 val--;
 838
 839                 mutex_lock(&data->lock);
 840                 data->pwm_automatic[channel] = val;
 841                 err = regmap_update_bits(data->regmap, ADT7470_REG_PWM_CFG(channel),
 842                                          pwm_auto_reg_mask,
 843                                          val ? pwm_auto_reg_mask : 0);
 844                 mutex_unlock(&data->lock);
 845                 break;
 846         case hwmon_pwm_freq:
 847                 err = pwm1_freq_set(dev, val);
 848                 break;
 849         default:
 850                 return -EOPNOTSUPP;
 851         }
 852
 853         return err;
 854 }
 855
 856 static ssize_t pwm_max_show(struct device *dev,
 857                             struct device_attribute *devattr, char *buf)
 858 {
 859         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 860         struct adt7470_data *data = adt7470_update_device(dev);
 861
 862         if (IS_ERR(data))
 863                 return PTR_ERR(data);
 864
 865         return sprintf(buf, "%d\n", data->pwm_max[attr->index]);
 866 }
 867
 868 static ssize_t pwm_max_store(struct device *dev,
 869                              struct device_attribute *devattr,
 870                              const char *buf, size_t count)
 871 {
 872         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 873         struct adt7470_data *data = dev_get_drvdata(dev);
 874         long temp;
 875         int err;
 876
 877         if (kstrtol(buf, 10, &temp))
 878                 return -EINVAL;
 879
 880         temp = clamp_val(temp, 0, 255);
 881
 882         mutex_lock(&data->lock);
 883         data->pwm_max[attr->index] = temp;
 884         err = regmap_write(data->regmap, ADT7470_REG_PWM_MAX(attr->index),
 885                            temp);
 886         mutex_unlock(&data->lock);
 887
 888         return err < 0 ? err : count;
 889 }
 890
 891 static ssize_t pwm_min_show(struct device *dev,
 892                             struct device_attribute *devattr, char *buf)
 893 {
 894         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 895         struct adt7470_data *data = adt7470_update_device(dev);
 896
 897         if (IS_ERR(data))
 898                 return PTR_ERR(data);
 899
 900         return sprintf(buf, "%d\n", data->pwm_min[attr->index]);
 901 }
 902
 903 static ssize_t pwm_min_store(struct device *dev,
 904                              struct device_attribute *devattr,
 905                              const char *buf, size_t count)
 906 {
 907         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 908         struct adt7470_data *data = dev_get_drvdata(dev);
 909         long temp;
 910         int err;
 911
 912         if (kstrtol(buf, 10, &temp))
 913                 return -EINVAL;
 914
 915         temp = clamp_val(temp, 0, 255);
 916
 917         mutex_lock(&data->lock);
 918         data->pwm_min[attr->index] = temp;
 919         err = regmap_write(data->regmap, ADT7470_REG_PWM_MIN(attr->index),
 920                            temp);
 921         mutex_unlock(&data->lock);
 922
 923         return err < 0 ? err : count;
 924 }
 925
 926 static ssize_t pwm_tmax_show(struct device *dev,
 927                              struct device_attribute *devattr, char *buf)
 928 {
 929         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 930         struct adt7470_data *data = adt7470_update_device(dev);
 931
 932         if (IS_ERR(data))
 933                 return PTR_ERR(data);
 934
 935         /* the datasheet says that tmax = tmin + 20C */
 936         return sprintf(buf, "%d\n", 1000 * (20 + data->pwm_tmin[attr->index]));
 937 }
 938
 939 static ssize_t pwm_tmin_show(struct device *dev,
 940                              struct device_attribute *devattr, char *buf)
 941 {
 942         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 943         struct adt7470_data *data = adt7470_update_device(dev);
 944
 945         if (IS_ERR(data))
 946                 return PTR_ERR(data);
 947
 948         return sprintf(buf, "%d\n", 1000 * data->pwm_tmin[attr->index]);
 949 }
 950
 951 static ssize_t pwm_tmin_store(struct device *dev,
 952                               struct device_attribute *devattr,
 953                               const char *buf, size_t count)
 954 {
 955         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 956         struct adt7470_data *data = dev_get_drvdata(dev);
 957         long temp;
 958         int err;
 959
 960         if (kstrtol(buf, 10, &temp))
 961                 return -EINVAL;
 962
 963         temp = clamp_val(temp, -128000, 127000);
 964         temp = DIV_ROUND_CLOSEST(temp, 1000);
 965
 966         mutex_lock(&data->lock);
 967         data->pwm_tmin[attr->index] = temp;
 968         err = regmap_write(data->regmap, ADT7470_REG_PWM_TMIN(attr->index),
 969                            temp);
 970         mutex_unlock(&data->lock);
 971
 972         return err < 0 ? err : count;
 973 }
 974
 975 static ssize_t pwm_auto_temp_show(struct device *dev,
 976                                   struct device_attribute *devattr, char *buf)
 977 {
 978         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 979         struct adt7470_data *data = adt7470_update_device(dev);
 980         u8 ctrl;
 981
 982         if (IS_ERR(data))
 983                 return PTR_ERR(data);
 984
 985         ctrl = data->pwm_auto_temp[attr->index];
 986         if (ctrl)
 987                 return sprintf(buf, "%d\n", 1 << (ctrl - 1));
 988         else
 989                 return sprintf(buf, "%d\n", ADT7470_PWM_ALL_TEMPS);
 990 }
 991
 992 static int cvt_auto_temp(int input)
 993 {
 994         if (input == ADT7470_PWM_ALL_TEMPS)
 995                 return 0;
 996         if (input < 1 || !is_power_of_2(input))
 997                 return -EINVAL;
 998         return ilog2(input) + 1;
 999 }
1000
1001 static ssize_t pwm_auto_temp_store(struct device *dev,
1002                                    struct device_attribute *devattr,
1003                                    const char *buf, size_t count)
1004 {
1005         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
1006         struct adt7470_data *data = dev_get_drvdata(dev);
1007         int pwm_auto_reg = ADT7470_REG_PWM_AUTO_TEMP(attr->index);
1008         unsigned int mask, val;
1009         long temp;
1010         int err;
1011
1012         if (kstrtol(buf, 10, &temp))
1013                 return -EINVAL;
1014
1015         temp = cvt_auto_temp(temp);
1016         if (temp < 0)
1017                 return temp;
1018
1019         mutex_lock(&data->lock);
1020         data->pwm_automatic[attr->index] = temp;
1021
1022         if (!(attr->index % 2)) {
1023                 mask = 0xF0;
1024                 val = (temp << 4) & 0xF0;
1025         } else {
1026                 mask = 0x0F;
1027                 val = temp & 0x0F;
1028         }
1029
1030         err = regmap_update_bits(data->regmap, pwm_auto_reg, mask, val);
1031         mutex_unlock(&data->lock);
1032
1033         return err < 0 ? err : count;
1034 }
1035
1036 static DEVICE_ATTR_RW(alarm_mask);
1037 static DEVICE_ATTR_RW(num_temp_sensors);
1038 static DEVICE_ATTR_RW(auto_update_interval);
1039
1040 static SENSOR_DEVICE_ATTR_RW(force_pwm_max, force_pwm_max, 0);
1041
1042 static SENSOR_DEVICE_ATTR_RW(pwm1_auto_point1_pwm, pwm_min, 0);
1043 static SENSOR_DEVICE_ATTR_RW(pwm2_auto_point1_pwm, pwm_min, 1);
1044 static SENSOR_DEVICE_ATTR_RW(pwm3_auto_point1_pwm, pwm_min, 2);
1045 static SENSOR_DEVICE_ATTR_RW(pwm4_auto_point1_pwm, pwm_min, 3);
1046
1047 static SENSOR_DEVICE_ATTR_RW(pwm1_auto_point2_pwm, pwm_max, 0);
1048 static SENSOR_DEVICE_ATTR_RW(pwm2_auto_point2_pwm, pwm_max, 1);
1049 static SENSOR_DEVICE_ATTR_RW(pwm3_auto_point2_pwm, pwm_max, 2);
1050 static SENSOR_DEVICE_ATTR_RW(pwm4_auto_point2_pwm, pwm_max, 3);
1051
1052 static SENSOR_DEVICE_ATTR_RW(pwm1_auto_point1_temp, pwm_tmin, 0);
1053 static SENSOR_DEVICE_ATTR_RW(pwm2_auto_point1_temp, pwm_tmin, 1);
1054 static SENSOR_DEVICE_ATTR_RW(pwm3_auto_point1_temp, pwm_tmin, 2);
1055 static SENSOR_DEVICE_ATTR_RW(pwm4_auto_point1_temp, pwm_tmin, 3);
1056
1057 static SENSOR_DEVICE_ATTR_RO(pwm1_auto_point2_temp, pwm_tmax, 0);
1058 static SENSOR_DEVICE_ATTR_RO(pwm2_auto_point2_temp, pwm_tmax, 1);
1059 static SENSOR_DEVICE_ATTR_RO(pwm3_auto_point2_temp, pwm_tmax, 2);
1060 static SENSOR_DEVICE_ATTR_RO(pwm4_auto_point2_temp, pwm_tmax, 3);
1061
1062 static SENSOR_DEVICE_ATTR_RW(pwm1_auto_channels_temp, pwm_auto_temp, 0);
1063 static SENSOR_DEVICE_ATTR_RW(pwm2_auto_channels_temp, pwm_auto_temp, 1);
1064 static SENSOR_DEVICE_ATTR_RW(pwm3_auto_channels_temp, pwm_auto_temp, 2);
1065 static SENSOR_DEVICE_ATTR_RW(pwm4_auto_channels_temp, pwm_auto_temp, 3);
1066
1067 static struct attribute *adt7470_attrs[] = {
1068         &dev_attr_alarm_mask.attr,
1069         &dev_attr_num_temp_sensors.attr,
1070         &dev_attr_auto_update_interval.attr,
1071         &sensor_dev_attr_force_pwm_max.dev_attr.attr,
1072         &sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
1073         &sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
1074         &sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
1075         &sensor_dev_attr_pwm4_auto_point1_pwm.dev_attr.attr,
1076         &sensor_dev_attr_pwm1_auto_point2_pwm.dev_attr.attr,
1077         &sensor_dev_attr_pwm2_auto_point2_pwm.dev_attr.attr,
1078         &sensor_dev_attr_pwm3_auto_point2_pwm.dev_attr.attr,
1079         &sensor_dev_attr_pwm4_auto_point2_pwm.dev_attr.attr,
1080         &sensor_dev_attr_pwm1_auto_point1_temp.dev_attr.attr,
1081         &sensor_dev_attr_pwm2_auto_point1_temp.dev_attr.attr,
1082         &sensor_dev_attr_pwm3_auto_point1_temp.dev_attr.attr,
1083         &sensor_dev_attr_pwm4_auto_point1_temp.dev_attr.attr,
1084         &sensor_dev_attr_pwm1_auto_point2_temp.dev_attr.attr,
1085         &sensor_dev_attr_pwm2_auto_point2_temp.dev_attr.attr,
1086         &sensor_dev_attr_pwm3_auto_point2_temp.dev_attr.attr,
1087         &sensor_dev_attr_pwm4_auto_point2_temp.dev_attr.attr,
1088         &sensor_dev_attr_pwm1_auto_channels_temp.dev_attr.attr,
1089         &sensor_dev_attr_pwm2_auto_channels_temp.dev_attr.attr,
1090         &sensor_dev_attr_pwm3_auto_channels_temp.dev_attr.attr,
1091         &sensor_dev_attr_pwm4_auto_channels_temp.dev_attr.attr,
1092         NULL
1093 };
1094
1095 ATTRIBUTE_GROUPS(adt7470);
1096
1097 static int adt7470_read(struct device *dev, enum hwmon_sensor_types type, u32 attr,
1098                         int channel, long *val)
1099 {
1100         switch (type) {
1101         case hwmon_temp:
1102                 return adt7470_temp_read(dev, attr, channel, val);
1103         case hwmon_fan:
1104                 return adt7470_fan_read(dev, attr, channel, val);
1105         case hwmon_pwm:
1106                 return adt7470_pwm_read(dev, attr, channel, val);
1107         default:
1108                 return -EOPNOTSUPP;
1109         }
1110 }
1111
1112 static int adt7470_write(struct device *dev, enum hwmon_sensor_types type, u32 attr,
1113                          int channel, long val)
1114 {
1115         switch (type) {
1116         case hwmon_temp:
1117                 return adt7470_temp_write(dev, attr, channel, val);
1118         case hwmon_fan:
1119                 return adt7470_fan_write(dev, attr, channel, val);
1120         case hwmon_pwm:
1121                 return adt7470_pwm_write(dev, attr, channel, val);
1122         default:
1123                 return -EOPNOTSUPP;
1124         }
1125 }
1126
1127 static umode_t adt7470_is_visible(const void *_data, enum hwmon_sensor_types type,
1128                                   u32 attr, int channel)
1129 {
1130         umode_t mode = 0;
1131
1132         switch (type) {
1133         case hwmon_temp:
1134                 switch (attr) {
1135                 case hwmon_temp:
1136                 case hwmon_temp_alarm:
1137                         mode = 0444;
1138                         break;
1139                 case hwmon_temp_min:
1140                 case hwmon_temp_max:
1141                         mode = 0644;
1142                         break;
1143                 default:
1144                         break;
1145                 }
1146                 break;
1147         case hwmon_fan:
1148                 switch (attr) {
1149                 case hwmon_fan_input:
1150                 case hwmon_fan_alarm:
1151                         mode = 0444;
1152                         break;
1153                 case hwmon_fan_min:
1154                 case hwmon_fan_max:
1155                         mode = 0644;
1156                         break;
1157                 default:
1158                         break;
1159                 }
1160                 break;
1161         case hwmon_pwm:
1162                 switch (attr) {
1163                 case hwmon_pwm_input:
1164                 case hwmon_pwm_enable:
1165                         mode = 0644;
1166                         break;
1167                 case hwmon_pwm_freq:
1168                         if (channel == 0)
1169                                 mode = 0644;
1170                         else
1171                                 mode = 0;
1172                         break;
1173                 default:
1174                         break;
1175                 }
1176                 break;
1177         default:
1178                 break;
1179         }
1180
1181         return mode;
1182 }
1183
1184 static const struct hwmon_ops adt7470_hwmon_ops = {
1185         .is_visible = adt7470_is_visible,
1186         .read = adt7470_read,
1187         .write = adt7470_write,
1188 };
1189
1190 static const struct hwmon_channel_info *adt7470_info[] = {
1191         HWMON_CHANNEL_INFO(temp,
1192                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1193                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1194                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1195                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1196                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1197                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1198                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1199                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1200                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM,
1201                            HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX | HWMON_T_ALARM),
1202         HWMON_CHANNEL_INFO(fan,
1203                            HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_MAX | HWMON_F_DIV | HWMON_F_ALARM,
1204                            HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_MAX | HWMON_F_DIV | HWMON_F_ALARM,
1205                            HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_MAX | HWMON_F_DIV | HWMON_F_ALARM,
1206                            HWMON_F_INPUT | HWMON_F_MIN | HWMON_F_MAX | HWMON_F_DIV | HWMON_F_ALARM),
1207         HWMON_CHANNEL_INFO(pwm,
1208                            HWMON_PWM_INPUT | HWMON_PWM_ENABLE | HWMON_PWM_FREQ,
1209                            HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
1210                            HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
1211                            HWMON_PWM_INPUT | HWMON_PWM_ENABLE),
1212         NULL
1213 };
1214
1215 static const struct hwmon_chip_info adt7470_chip_info = {
1216         .ops = &adt7470_hwmon_ops,
1217         .info = adt7470_info,
1218 };
1219
1220 /* Return 0 if detection is successful, -ENODEV otherwise */
1221 static int adt7470_detect(struct i2c_client *client,
1222                           struct i2c_board_info *info)
1223 {
1224         struct i2c_adapter *adapter = client->adapter;
1225         int vendor, device, revision;
1226
1227         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1228                 return -ENODEV;
1229
1230         vendor = i2c_smbus_read_byte_data(client, ADT7470_REG_VENDOR);
1231         if (vendor != ADT7470_VENDOR)
1232                 return -ENODEV;
1233
1234         device = i2c_smbus_read_byte_data(client, ADT7470_REG_DEVICE);
1235         if (device != ADT7470_DEVICE)
1236                 return -ENODEV;
1237
1238         revision = i2c_smbus_read_byte_data(client, ADT7470_REG_REVISION);
1239         if (revision != ADT7470_REVISION)
1240                 return -ENODEV;
1241
1242         strscpy(info->type, "adt7470", I2C_NAME_SIZE);
1243
1244         return 0;
1245 }
1246
1247 static const struct regmap_config adt7470_regmap_config = {
1248         .reg_bits = 8,
1249         .val_bits = 8,
1250         .use_single_read = true,
1251         .use_single_write = true,
1252 };
1253
1254 static int adt7470_probe(struct i2c_client *client)
1255 {
1256         struct device *dev = &client->dev;
1257         struct adt7470_data *data;
1258         struct device *hwmon_dev;
1259         int err;
1260
1261         data = devm_kzalloc(dev, sizeof(struct adt7470_data), GFP_KERNEL);
1262         if (!data)
1263                 return -ENOMEM;
1264
1265         data->num_temp_sensors = -1;
1266         data->auto_update_interval = AUTO_UPDATE_INTERVAL;
1267         data->regmap = devm_regmap_init_i2c(client, &adt7470_regmap_config);
1268         if (IS_ERR(data->regmap))
1269                 return PTR_ERR(data->regmap);
1270
1271         i2c_set_clientdata(client, data);
1272         mutex_init(&data->lock);
1273
1274         dev_info(&client->dev, "%s chip found\n", client->name);
1275
1276         /* Initialize the ADT7470 chip */
1277         err = regmap_update_bits(data->regmap, ADT7470_REG_CFG,
1278                                  ADT7470_STRT_MASK | ADT7470_TEST_MASK,
1279                                  ADT7470_STRT_MASK | ADT7470_TEST_MASK);
1280         if (err < 0)
1281                 return err;
1282
1283         /* Register sysfs hooks */
1284         hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name, data,
1285                                                          &adt7470_chip_info,
1286                                                          adt7470_groups);
1287
1288         if (IS_ERR(hwmon_dev))
1289                 return PTR_ERR(hwmon_dev);
1290
1291         data->auto_update = kthread_run(adt7470_update_thread, client, "%s",
1292                                         dev_name(hwmon_dev));
1293         if (IS_ERR(data->auto_update))
1294                 return PTR_ERR(data->auto_update);
1295
1296         return 0;
1297 }
1298
1299 static void adt7470_remove(struct i2c_client *client)
1300 {
1301         struct adt7470_data *data = i2c_get_clientdata(client);
1302
1303         kthread_stop(data->auto_update);
1304 }
1305
1306 static const struct i2c_device_id adt7470_id[] = {
1307         { "adt7470", 0 },
1308         { }
1309 };
1310 MODULE_DEVICE_TABLE(i2c, adt7470_id);
1311
1312 static struct i2c_driver adt7470_driver = {
1313         .class          = I2C_CLASS_HWMON,
1314         .driver = {
1315                 .name   = "adt7470",
1316         },
1317         .probe_new      = adt7470_probe,
1318         .remove         = adt7470_remove,
1319         .id_table       = adt7470_id,
1320         .detect         = adt7470_detect,
1321         .address_list   = normal_i2c,
1322 };
1323
1324 module_i2c_driver(adt7470_driver);
1325
1326 MODULE_AUTHOR("Darrick J. Wong <darrick.wong@oracle.com>");
1327 MODULE_DESCRIPTION("ADT7470 driver");
1328 MODULE_LICENSE("GPL");