drivers/hwmon/nct7904.c

   1 /*
   2  * nct7904.c - driver for Nuvoton NCT7904D.
   3  *
   4  * Copyright (c) 2015 Kontron
   5  * Author: Vadim V. Vlasov <vvlasov@dev.rtsoft.ru>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  */
  17
  18 #include <linux/module.h>
  19 #include <linux/device.h>
  20 #include <linux/init.h>
  21 #include <linux/i2c.h>
  22 #include <linux/mutex.h>
  23 #include <linux/hwmon.h>
  24 #include <linux/hwmon-sysfs.h>
  25
  26 #define VENDOR_ID_REG           0x7A    /* Any bank */
  27 #define NUVOTON_ID              0x50
  28 #define CHIP_ID_REG             0x7B    /* Any bank */
  29 #define NCT7904_ID              0xC5
  30 #define DEVICE_ID_REG           0x7C    /* Any bank */
  31
  32 #define BANK_SEL_REG            0xFF
  33 #define BANK_0                  0x00
  34 #define BANK_1                  0x01
  35 #define BANK_2                  0x02
  36 #define BANK_3                  0x03
  37 #define BANK_4                  0x04
  38 #define BANK_MAX                0x04
  39
  40 #define FANIN_MAX               12      /* Counted from 1 */
  41 #define VSEN_MAX                21      /* VSEN1..14, 3VDD, VBAT, V3VSB,
  42                                            LTD (not a voltage), VSEN17..19 */
  43 #define FANCTL_MAX              4       /* Counted from 1 */
  44 #define TCPU_MAX                8       /* Counted from 1 */
  45 #define TEMP_MAX                4       /* Counted from 1 */
  46
  47 #define VT_ADC_CTRL0_REG        0x20    /* Bank 0 */
  48 #define VT_ADC_CTRL1_REG        0x21    /* Bank 0 */
  49 #define VT_ADC_CTRL2_REG        0x22    /* Bank 0 */
  50 #define FANIN_CTRL0_REG         0x24
  51 #define FANIN_CTRL1_REG         0x25
  52 #define DTS_T_CTRL0_REG         0x26
  53 #define DTS_T_CTRL1_REG         0x27
  54 #define VT_ADC_MD_REG           0x2E
  55
  56 #define VSEN1_HV_REG            0x40    /* Bank 0; 2 regs (HV/LV) per sensor */
  57 #define TEMP_CH1_HV_REG         0x42    /* Bank 0; same as VSEN2_HV */
  58 #define LTD_HV_REG              0x62    /* Bank 0; 2 regs in VSEN range */
  59 #define FANIN1_HV_REG           0x80    /* Bank 0; 2 regs (HV/LV) per sensor */
  60 #define T_CPU1_HV_REG           0xA0    /* Bank 0; 2 regs (HV/LV) per sensor */
  61
  62 #define PRTS_REG                0x03    /* Bank 2 */
  63 #define FANCTL1_FMR_REG         0x00    /* Bank 3; 1 reg per channel */
  64 #define FANCTL1_OUT_REG         0x10    /* Bank 3; 1 reg per channel */
  65
  66 static const unsigned short normal_i2c[] = {
  67         0x2d, 0x2e, I2C_CLIENT_END
  68 };
  69
  70 struct nct7904_data {
  71         struct i2c_client *client;
  72         struct mutex bank_lock;
  73         int bank_sel;
  74         u32 fanin_mask;
  75         u32 vsen_mask;
  76         u32 tcpu_mask;
  77         u8 fan_mode[FANCTL_MAX];
  78 };
  79
  80 /* Access functions */
  81 static int nct7904_bank_lock(struct nct7904_data *data, unsigned bank)
  82 {
  83         int ret;
  84
  85         mutex_lock(&data->bank_lock);
  86         if (data->bank_sel == bank)
  87                 return 0;
  88         ret = i2c_smbus_write_byte_data(data->client, BANK_SEL_REG, bank);
  89         if (ret == 0)
  90                 data->bank_sel = bank;
  91         else
  92                 data->bank_sel = -1;
  93         return ret;
  94 }
  95
  96 static inline void nct7904_bank_release(struct nct7904_data *data)
  97 {
  98         mutex_unlock(&data->bank_lock);
  99 }
 100
 101 /* Read 1-byte register. Returns unsigned reg or -ERRNO on error. */
 102 static int nct7904_read_reg(struct nct7904_data *data,
 103                             unsigned bank, unsigned reg)
 104 {
 105         struct i2c_client *client = data->client;
 106         int ret;
 107
 108         ret = nct7904_bank_lock(data, bank);
 109         if (ret == 0)
 110                 ret = i2c_smbus_read_byte_data(client, reg);
 111
 112         nct7904_bank_release(data);
 113         return ret;
 114 }
 115
 116 /*
 117  * Read 2-byte register. Returns register in big-endian format or
 118  * -ERRNO on error.
 119  */
 120 static int nct7904_read_reg16(struct nct7904_data *data,
 121                               unsigned bank, unsigned reg)
 122 {
 123         struct i2c_client *client = data->client;
 124         int ret, hi;
 125
 126         ret = nct7904_bank_lock(data, bank);
 127         if (ret == 0) {
 128                 ret = i2c_smbus_read_byte_data(client, reg);
 129                 if (ret >= 0) {
 130                         hi = ret;
 131                         ret = i2c_smbus_read_byte_data(client, reg + 1);
 132                         if (ret >= 0)
 133                                 ret |= hi << 8;
 134                 }
 135         }
 136
 137         nct7904_bank_release(data);
 138         return ret;
 139 }
 140
 141 /* Write 1-byte register. Returns 0 or -ERRNO on error. */
 142 static int nct7904_write_reg(struct nct7904_data *data,
 143                              unsigned bank, unsigned reg, u8 val)
 144 {
 145         struct i2c_client *client = data->client;
 146         int ret;
 147
 148         ret = nct7904_bank_lock(data, bank);
 149         if (ret == 0)
 150                 ret = i2c_smbus_write_byte_data(client, reg, val);
 151
 152         nct7904_bank_release(data);
 153         return ret;
 154 }
 155
 156 /* FANIN ATTR */
 157 static ssize_t show_fan(struct device *dev,
 158                         struct device_attribute *devattr, char *buf)
 159 {
 160         int index = to_sensor_dev_attr(devattr)->index;
 161         struct nct7904_data *data = dev_get_drvdata(dev);
 162         int ret;
 163         unsigned cnt, rpm;
 164
 165         ret = nct7904_read_reg16(data, BANK_0, FANIN1_HV_REG + index * 2);
 166         if (ret < 0)
 167                 return ret;
 168         cnt = ((ret & 0xff00) >> 3) | (ret & 0x1f);
 169         if (cnt == 0x1fff)
 170                 rpm = 0;
 171         else
 172                 rpm = 1350000 / cnt;
 173         return sprintf(buf, "%u\n", rpm);
 174 }
 175
 176 static umode_t nct7904_fanin_is_visible(struct kobject *kobj,
 177                                         struct attribute *a, int n)
 178 {
 179         struct device *dev = container_of(kobj, struct device, kobj);
 180         struct nct7904_data *data = dev_get_drvdata(dev);
 181
 182         if (data->fanin_mask & (1 << n))
 183                 return a->mode;
 184         return 0;
 185 }
 186
 187 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
 188 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
 189 static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
 190 static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3);
 191 static SENSOR_DEVICE_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4);
 192 static SENSOR_DEVICE_ATTR(fan6_input, S_IRUGO, show_fan, NULL, 5);
 193 static SENSOR_DEVICE_ATTR(fan7_input, S_IRUGO, show_fan, NULL, 6);
 194 static SENSOR_DEVICE_ATTR(fan8_input, S_IRUGO, show_fan, NULL, 7);
 195 static SENSOR_DEVICE_ATTR(fan9_input, S_IRUGO, show_fan, NULL, 8);
 196 static SENSOR_DEVICE_ATTR(fan10_input, S_IRUGO, show_fan, NULL, 9);
 197 static SENSOR_DEVICE_ATTR(fan11_input, S_IRUGO, show_fan, NULL, 10);
 198 static SENSOR_DEVICE_ATTR(fan12_input, S_IRUGO, show_fan, NULL, 11);
 199
 200 static struct attribute *nct7904_fanin_attrs[] = {
 201         &sensor_dev_attr_fan1_input.dev_attr.attr,
 202         &sensor_dev_attr_fan2_input.dev_attr.attr,
 203         &sensor_dev_attr_fan3_input.dev_attr.attr,
 204         &sensor_dev_attr_fan4_input.dev_attr.attr,
 205         &sensor_dev_attr_fan5_input.dev_attr.attr,
 206         &sensor_dev_attr_fan6_input.dev_attr.attr,
 207         &sensor_dev_attr_fan7_input.dev_attr.attr,
 208         &sensor_dev_attr_fan8_input.dev_attr.attr,
 209         &sensor_dev_attr_fan9_input.dev_attr.attr,
 210         &sensor_dev_attr_fan10_input.dev_attr.attr,
 211         &sensor_dev_attr_fan11_input.dev_attr.attr,
 212         &sensor_dev_attr_fan12_input.dev_attr.attr,
 213         NULL
 214 };
 215
 216 static const struct attribute_group nct7904_fanin_group = {
 217         .attrs = nct7904_fanin_attrs,
 218         .is_visible = nct7904_fanin_is_visible,
 219 };
 220
 221 /* VSEN ATTR */
 222 static ssize_t show_voltage(struct device *dev,
 223                             struct device_attribute *devattr, char *buf)
 224 {
 225         int index = to_sensor_dev_attr(devattr)->index;
 226         struct nct7904_data *data = dev_get_drvdata(dev);
 227         int ret;
 228         int volt;
 229
 230         ret = nct7904_read_reg16(data, BANK_0, VSEN1_HV_REG + index * 2);
 231         if (ret < 0)
 232                 return ret;
 233         volt = ((ret & 0xff00) >> 5) | (ret & 0x7);
 234         if (index < 14)
 235                 volt *= 2; /* 0.002V scale */
 236         else
 237                 volt *= 6; /* 0.006V scale */
 238
 239         return sprintf(buf, "%d\n", volt);
 240 }
 241
 242 static ssize_t show_ltemp(struct device *dev,
 243                           struct device_attribute *devattr, char *buf)
 244 {
 245         struct nct7904_data *data = dev_get_drvdata(dev);
 246         int ret;
 247         int temp;
 248
 249         ret = nct7904_read_reg16(data, BANK_0, LTD_HV_REG);
 250         if (ret < 0)
 251                 return ret;
 252         temp = ((ret & 0xff00) >> 5) | (ret & 0x7);
 253         temp = sign_extend32(temp, 10) * 125;
 254
 255         return sprintf(buf, "%d\n", temp);
 256 }
 257
 258 static umode_t nct7904_vsen_is_visible(struct kobject *kobj,
 259                                        struct attribute *a, int n)
 260 {
 261         struct device *dev = container_of(kobj, struct device, kobj);
 262         struct nct7904_data *data = dev_get_drvdata(dev);
 263
 264         if (data->vsen_mask & (1 << n))
 265                 return a->mode;
 266         return 0;
 267 }
 268
 269 static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, show_voltage, NULL, 0);
 270 static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, show_voltage, NULL, 1);
 271 static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, show_voltage, NULL, 2);
 272 static SENSOR_DEVICE_ATTR(in4_input, S_IRUGO, show_voltage, NULL, 3);
 273 static SENSOR_DEVICE_ATTR(in5_input, S_IRUGO, show_voltage, NULL, 4);
 274 static SENSOR_DEVICE_ATTR(in6_input, S_IRUGO, show_voltage, NULL, 5);
 275 static SENSOR_DEVICE_ATTR(in7_input, S_IRUGO, show_voltage, NULL, 6);
 276 static SENSOR_DEVICE_ATTR(in8_input, S_IRUGO, show_voltage, NULL, 7);
 277 static SENSOR_DEVICE_ATTR(in9_input, S_IRUGO, show_voltage, NULL, 8);
 278 static SENSOR_DEVICE_ATTR(in10_input, S_IRUGO, show_voltage, NULL, 9);
 279 static SENSOR_DEVICE_ATTR(in11_input, S_IRUGO, show_voltage, NULL, 10);
 280 static SENSOR_DEVICE_ATTR(in12_input, S_IRUGO, show_voltage, NULL, 11);
 281 static SENSOR_DEVICE_ATTR(in13_input, S_IRUGO, show_voltage, NULL, 12);
 282 static SENSOR_DEVICE_ATTR(in14_input, S_IRUGO, show_voltage, NULL, 13);
 283 /*
 284  * Next 3 voltage sensors have specific names in the Nuvoton doc
 285  * (3VDD, VBAT, 3VSB) but we use vacant numbers for them.
 286  */
 287 static SENSOR_DEVICE_ATTR(in15_input, S_IRUGO, show_voltage, NULL, 14);
 288 static SENSOR_DEVICE_ATTR(in16_input, S_IRUGO, show_voltage, NULL, 15);
 289 static SENSOR_DEVICE_ATTR(in20_input, S_IRUGO, show_voltage, NULL, 16);
 290 /* This is not a voltage, but a local temperature sensor. */
 291 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_ltemp, NULL, 0);
 292 static SENSOR_DEVICE_ATTR(in17_input, S_IRUGO, show_voltage, NULL, 18);
 293 static SENSOR_DEVICE_ATTR(in18_input, S_IRUGO, show_voltage, NULL, 19);
 294 static SENSOR_DEVICE_ATTR(in19_input, S_IRUGO, show_voltage, NULL, 20);
 295
 296 static struct attribute *nct7904_vsen_attrs[] = {
 297         &sensor_dev_attr_in1_input.dev_attr.attr,
 298         &sensor_dev_attr_in2_input.dev_attr.attr,
 299         &sensor_dev_attr_in3_input.dev_attr.attr,
 300         &sensor_dev_attr_in4_input.dev_attr.attr,
 301         &sensor_dev_attr_in5_input.dev_attr.attr,
 302         &sensor_dev_attr_in6_input.dev_attr.attr,
 303         &sensor_dev_attr_in7_input.dev_attr.attr,
 304         &sensor_dev_attr_in8_input.dev_attr.attr,
 305         &sensor_dev_attr_in9_input.dev_attr.attr,
 306         &sensor_dev_attr_in10_input.dev_attr.attr,
 307         &sensor_dev_attr_in11_input.dev_attr.attr,
 308         &sensor_dev_attr_in12_input.dev_attr.attr,
 309         &sensor_dev_attr_in13_input.dev_attr.attr,
 310         &sensor_dev_attr_in14_input.dev_attr.attr,
 311         &sensor_dev_attr_in15_input.dev_attr.attr,
 312         &sensor_dev_attr_in16_input.dev_attr.attr,
 313         &sensor_dev_attr_in20_input.dev_attr.attr,
 314         &sensor_dev_attr_temp1_input.dev_attr.attr,
 315         &sensor_dev_attr_in17_input.dev_attr.attr,
 316         &sensor_dev_attr_in18_input.dev_attr.attr,
 317         &sensor_dev_attr_in19_input.dev_attr.attr,
 318         NULL
 319 };
 320
 321 static const struct attribute_group nct7904_vsen_group = {
 322         .attrs = nct7904_vsen_attrs,
 323         .is_visible = nct7904_vsen_is_visible,
 324 };
 325
 326 /* CPU_TEMP ATTR */
 327 static ssize_t show_tcpu(struct device *dev,
 328                          struct device_attribute *devattr, char *buf)
 329 {
 330         int index = to_sensor_dev_attr(devattr)->index;
 331         struct nct7904_data *data = dev_get_drvdata(dev);
 332         int ret;
 333         int temp;
 334
 335         ret = nct7904_read_reg16(data, BANK_0, T_CPU1_HV_REG + index * 2);
 336         if (ret < 0)
 337                 return ret;
 338
 339         temp = ((ret & 0xff00) >> 5) | (ret & 0x7);
 340         temp = sign_extend32(temp, 10) * 125;
 341         return sprintf(buf, "%d\n", temp);
 342 }
 343
 344 static umode_t nct7904_tcpu_is_visible(struct kobject *kobj,
 345                                        struct attribute *a, int n)
 346 {
 347         struct device *dev = container_of(kobj, struct device, kobj);
 348         struct nct7904_data *data = dev_get_drvdata(dev);
 349
 350         if (data->tcpu_mask & (1 << n))
 351                 return a->mode;
 352         return 0;
 353 }
 354
 355 /* "temp1_input" reserved for local temp */
 356 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_tcpu, NULL, 0);
 357 static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_tcpu, NULL, 1);
 358 static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, show_tcpu, NULL, 2);
 359 static SENSOR_DEVICE_ATTR(temp5_input, S_IRUGO, show_tcpu, NULL, 3);
 360 static SENSOR_DEVICE_ATTR(temp6_input, S_IRUGO, show_tcpu, NULL, 4);
 361 static SENSOR_DEVICE_ATTR(temp7_input, S_IRUGO, show_tcpu, NULL, 5);
 362 static SENSOR_DEVICE_ATTR(temp8_input, S_IRUGO, show_tcpu, NULL, 6);
 363 static SENSOR_DEVICE_ATTR(temp9_input, S_IRUGO, show_tcpu, NULL, 7);
 364
 365 static struct attribute *nct7904_tcpu_attrs[] = {
 366         &sensor_dev_attr_temp2_input.dev_attr.attr,
 367         &sensor_dev_attr_temp3_input.dev_attr.attr,
 368         &sensor_dev_attr_temp4_input.dev_attr.attr,
 369         &sensor_dev_attr_temp5_input.dev_attr.attr,
 370         &sensor_dev_attr_temp6_input.dev_attr.attr,
 371         &sensor_dev_attr_temp7_input.dev_attr.attr,
 372         &sensor_dev_attr_temp8_input.dev_attr.attr,
 373         &sensor_dev_attr_temp9_input.dev_attr.attr,
 374         NULL
 375 };
 376
 377 static const struct attribute_group nct7904_tcpu_group = {
 378         .attrs = nct7904_tcpu_attrs,
 379         .is_visible = nct7904_tcpu_is_visible,
 380 };
 381
 382 /* PWM ATTR */
 383 static ssize_t store_pwm(struct device *dev, struct device_attribute *devattr,
 384                          const char *buf, size_t count)
 385 {
 386         int index = to_sensor_dev_attr(devattr)->index;
 387         struct nct7904_data *data = dev_get_drvdata(dev);
 388         unsigned long val;
 389         int ret;
 390
 391         if (kstrtoul(buf, 10, &val) < 0)
 392                 return -EINVAL;
 393         if (val > 255)
 394                 return -EINVAL;
 395
 396         ret = nct7904_write_reg(data, BANK_3, FANCTL1_OUT_REG + index, val);
 397
 398         return ret ? ret : count;
 399 }
 400
 401 static ssize_t show_pwm(struct device *dev,
 402                         struct device_attribute *devattr, char *buf)
 403 {
 404         int index = to_sensor_dev_attr(devattr)->index;
 405         struct nct7904_data *data = dev_get_drvdata(dev);
 406         int val;
 407
 408         val = nct7904_read_reg(data, BANK_3, FANCTL1_OUT_REG + index);
 409         if (val < 0)
 410                 return val;
 411
 412         return sprintf(buf, "%d\n", val);
 413 }
 414
 415 static ssize_t store_enable(struct device *dev,
 416                             struct device_attribute *devattr,
 417                             const char *buf, size_t count)
 418 {
 419         int index = to_sensor_dev_attr(devattr)->index;
 420         struct nct7904_data *data = dev_get_drvdata(dev);
 421         unsigned long val;
 422         int ret;
 423
 424         if (kstrtoul(buf, 10, &val) < 0)
 425                 return -EINVAL;
 426         if (val < 1 || val > 2 || (val == 2 && !data->fan_mode[index]))
 427                 return -EINVAL;
 428
 429         ret = nct7904_write_reg(data, BANK_3, FANCTL1_FMR_REG + index,
 430                                 val == 2 ? data->fan_mode[index] : 0);
 431
 432         return ret ? ret : count;
 433 }
 434
 435 /* Return 1 for manual mode or 2 for SmartFan mode */
 436 static ssize_t show_enable(struct device *dev,
 437                            struct device_attribute *devattr, char *buf)
 438 {
 439         int index = to_sensor_dev_attr(devattr)->index;
 440         struct nct7904_data *data = dev_get_drvdata(dev);
 441         int val;
 442
 443         val = nct7904_read_reg(data, BANK_3, FANCTL1_FMR_REG + index);
 444         if (val < 0)
 445                 return val;
 446
 447         return sprintf(buf, "%d\n", val ? 2 : 1);
 448 }
 449
 450 /* 2 attributes per channel: pwm and mode */
 451 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR,
 452                         show_pwm, store_pwm, 0);
 453 static SENSOR_DEVICE_ATTR(pwm1_enable, S_IRUGO | S_IWUSR,
 454                         show_enable, store_enable, 0);
 455 static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR,
 456                         show_pwm, store_pwm, 1);
 457 static SENSOR_DEVICE_ATTR(pwm2_enable, S_IRUGO | S_IWUSR,
 458                         show_enable, store_enable, 1);
 459 static SENSOR_DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR,
 460                         show_pwm, store_pwm, 2);
 461 static SENSOR_DEVICE_ATTR(pwm3_enable, S_IRUGO | S_IWUSR,
 462                         show_enable, store_enable, 2);
 463 static SENSOR_DEVICE_ATTR(pwm4, S_IRUGO | S_IWUSR,
 464                         show_pwm, store_pwm, 3);
 465 static SENSOR_DEVICE_ATTR(pwm4_enable, S_IRUGO | S_IWUSR,
 466                         show_enable, store_enable, 3);
 467
 468 static struct attribute *nct7904_fanctl_attrs[] = {
 469         &sensor_dev_attr_pwm1.dev_attr.attr,
 470         &sensor_dev_attr_pwm1_enable.dev_attr.attr,
 471         &sensor_dev_attr_pwm2.dev_attr.attr,
 472         &sensor_dev_attr_pwm2_enable.dev_attr.attr,
 473         &sensor_dev_attr_pwm3.dev_attr.attr,
 474         &sensor_dev_attr_pwm3_enable.dev_attr.attr,
 475         &sensor_dev_attr_pwm4.dev_attr.attr,
 476         &sensor_dev_attr_pwm4_enable.dev_attr.attr,
 477         NULL
 478 };
 479
 480 static const struct attribute_group nct7904_fanctl_group = {
 481         .attrs = nct7904_fanctl_attrs,
 482 };
 483
 484 static const struct attribute_group *nct7904_groups[] = {
 485         &nct7904_fanin_group,
 486         &nct7904_vsen_group,
 487         &nct7904_tcpu_group,
 488         &nct7904_fanctl_group,
 489         NULL
 490 };
 491
 492 /* Return 0 if detection is successful, -ENODEV otherwise */
 493 static int nct7904_detect(struct i2c_client *client,
 494                           struct i2c_board_info *info)
 495 {
 496         struct i2c_adapter *adapter = client->adapter;
 497
 498         if (!i2c_check_functionality(adapter,
 499                                      I2C_FUNC_SMBUS_READ_BYTE |
 500                                      I2C_FUNC_SMBUS_WRITE_BYTE_DATA))
 501                 return -ENODEV;
 502
 503         /* Determine the chip type. */
 504         if (i2c_smbus_read_byte_data(client, VENDOR_ID_REG) != NUVOTON_ID ||
 505             i2c_smbus_read_byte_data(client, CHIP_ID_REG) != NCT7904_ID ||
 506             (i2c_smbus_read_byte_data(client, DEVICE_ID_REG) & 0xf0) != 0x50 ||
 507             (i2c_smbus_read_byte_data(client, BANK_SEL_REG) & 0xf8) != 0x00)
 508                 return -ENODEV;
 509
 510         strlcpy(info->type, "nct7904", I2C_NAME_SIZE);
 511
 512         return 0;
 513 }
 514
 515 static int nct7904_probe(struct i2c_client *client,
 516                          const struct i2c_device_id *id)
 517 {
 518         struct nct7904_data *data;
 519         struct device *hwmon_dev;
 520         struct device *dev = &client->dev;
 521         int ret, i;
 522         u32 mask;
 523
 524         data = devm_kzalloc(dev, sizeof(struct nct7904_data), GFP_KERNEL);
 525         if (!data)
 526                 return -ENOMEM;
 527
 528         data->client = client;
 529         mutex_init(&data->bank_lock);
 530         data->bank_sel = -1;
 531
 532         /* Setup sensor groups. */
 533         /* FANIN attributes */
 534         ret = nct7904_read_reg16(data, BANK_0, FANIN_CTRL0_REG);
 535         if (ret < 0)
 536                 return ret;
 537         data->fanin_mask = (ret >> 8) | ((ret & 0xff) << 8);
 538
 539         /*
 540          * VSEN attributes
 541          *
 542          * Note: voltage sensors overlap with external temperature
 543          * sensors. So, if we ever decide to support the latter
 544          * we will have to adjust 'vsen_mask' accordingly.
 545          */
 546         mask = 0;
 547         ret = nct7904_read_reg16(data, BANK_0, VT_ADC_CTRL0_REG);
 548         if (ret >= 0)
 549                 mask = (ret >> 8) | ((ret & 0xff) << 8);
 550         ret = nct7904_read_reg(data, BANK_0, VT_ADC_CTRL2_REG);
 551         if (ret >= 0)
 552                 mask |= (ret << 16);
 553         data->vsen_mask = mask;
 554
 555         /* CPU_TEMP attributes */
 556         ret = nct7904_read_reg16(data, BANK_0, DTS_T_CTRL0_REG);
 557         if (ret < 0)
 558                 return ret;
 559         data->tcpu_mask = ((ret >> 8) & 0xf) | ((ret & 0xf) << 4);
 560
 561         for (i = 0; i < FANCTL_MAX; i++) {
 562                 ret = nct7904_read_reg(data, BANK_3, FANCTL1_FMR_REG + i);
 563                 if (ret < 0)
 564                         return ret;
 565                 data->fan_mode[i] = ret;
 566         }
 567
 568         hwmon_dev =
 569                 devm_hwmon_device_register_with_groups(dev, client->name, data,
 570                                                        nct7904_groups);
 571         return PTR_ERR_OR_ZERO(hwmon_dev);
 572 }
 573
 574 static const struct i2c_device_id nct7904_id[] = {
 575         {"nct7904", 0},
 576         {}
 577 };
 578 MODULE_DEVICE_TABLE(i2c, nct7904_id);
 579
 580 static struct i2c_driver nct7904_driver = {
 581         .class = I2C_CLASS_HWMON,
 582         .driver = {
 583                 .name = "nct7904",
 584         },
 585         .probe = nct7904_probe,
 586         .id_table = nct7904_id,
 587         .detect = nct7904_detect,
 588         .address_list = normal_i2c,
 589 };
 590
 591 module_i2c_driver(nct7904_driver);
 592
 593 MODULE_AUTHOR("Vadim V. Vlasov <vvlasov@dev.rtsoft.ru>");
 594 MODULE_DESCRIPTION("Hwmon driver for NUVOTON NCT7904");
 595 MODULE_LICENSE("GPL");