drivers/hwmon/adm1031.c

   1 /*
   2   adm1031.c - Part of lm_sensors, Linux kernel modules for hardware
   3   monitoring
   4   Based on lm75.c and lm85.c
   5   Supports adm1030 / adm1031
   6   Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org>
   7   Reworked by Jean Delvare <khali@linux-fr.org>
   8
   9   This program is free software; you can redistribute it and/or modify
  10   it under the terms of the GNU General Public License as published by
  11   the Free Software Foundation; either version 2 of the License, or
  12   (at your option) any later version.
  13
  14   This program is distributed in the hope that it will be useful,
  15   but WITHOUT ANY WARRANTY; without even the implied warranty of
  16   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17   GNU General Public License for more details.
  18
  19   You should have received a copy of the GNU General Public License
  20   along with this program; if not, write to the Free Software
  21   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22 */
  23
  24 #include <linux/module.h>
  25 #include <linux/init.h>
  26 #include <linux/slab.h>
  27 #include <linux/jiffies.h>
  28 #include <linux/i2c.h>
  29 #include <linux/hwmon.h>
  30 #include <linux/err.h>
  31 #include <linux/mutex.h>
  32
  33 /* Following macros takes channel parameter starting from 0 to 2 */
  34 #define ADM1031_REG_FAN_SPEED(nr)       (0x08 + (nr))
  35 #define ADM1031_REG_FAN_DIV(nr)         (0x20  + (nr))
  36 #define ADM1031_REG_PWM                 (0x22)
  37 #define ADM1031_REG_FAN_MIN(nr)         (0x10 + (nr))
  38
  39 #define ADM1031_REG_TEMP_MAX(nr)        (0x14  + 4*(nr))
  40 #define ADM1031_REG_TEMP_MIN(nr)        (0x15  + 4*(nr))
  41 #define ADM1031_REG_TEMP_CRIT(nr)       (0x16  + 4*(nr))
  42
  43 #define ADM1031_REG_TEMP(nr)            (0xa + (nr))
  44 #define ADM1031_REG_AUTO_TEMP(nr)       (0x24 + (nr))
  45
  46 #define ADM1031_REG_STATUS(nr)          (0x2 + (nr))
  47
  48 #define ADM1031_REG_CONF1               0x0
  49 #define ADM1031_REG_CONF2               0x1
  50 #define ADM1031_REG_EXT_TEMP            0x6
  51
  52 #define ADM1031_CONF1_MONITOR_ENABLE    0x01    /* Monitoring enable */
  53 #define ADM1031_CONF1_PWM_INVERT        0x08    /* PWM Invert */
  54 #define ADM1031_CONF1_AUTO_MODE         0x80    /* Auto FAN */
  55
  56 #define ADM1031_CONF2_PWM1_ENABLE       0x01
  57 #define ADM1031_CONF2_PWM2_ENABLE       0x02
  58 #define ADM1031_CONF2_TACH1_ENABLE      0x04
  59 #define ADM1031_CONF2_TACH2_ENABLE      0x08
  60 #define ADM1031_CONF2_TEMP_ENABLE(chan) (0x10 << (chan))
  61
  62 /* Addresses to scan */
  63 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
  64
  65 /* Insmod parameters */
  66 I2C_CLIENT_INSMOD_2(adm1030, adm1031);
  67
  68 typedef u8 auto_chan_table_t[8][2];
  69
  70 /* Each client has this additional data */
  71 struct adm1031_data {
  72         struct i2c_client client;
  73         struct device *hwmon_dev;
  74         struct mutex update_lock;
  75         int chip_type;
  76         char valid;             /* !=0 if following fields are valid */
  77         unsigned long last_updated;     /* In jiffies */
  78         /* The chan_select_table contains the possible configurations for
  79          * auto fan control.
  80          */
  81         auto_chan_table_t *chan_select_table;
  82         u16 alarm;
  83         u8 conf1;
  84         u8 conf2;
  85         u8 fan[2];
  86         u8 fan_div[2];
  87         u8 fan_min[2];
  88         u8 pwm[2];
  89         u8 old_pwm[2];
  90         s8 temp[3];
  91         u8 ext_temp[3];
  92         u8 auto_temp[3];
  93         u8 auto_temp_min[3];
  94         u8 auto_temp_off[3];
  95         u8 auto_temp_max[3];
  96         s8 temp_min[3];
  97         s8 temp_max[3];
  98         s8 temp_crit[3];
  99 };
 100
 101 static int adm1031_attach_adapter(struct i2c_adapter *adapter);
 102 static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind);
 103 static void adm1031_init_client(struct i2c_client *client);
 104 static int adm1031_detach_client(struct i2c_client *client);
 105 static struct adm1031_data *adm1031_update_device(struct device *dev);
 106
 107 /* This is the driver that will be inserted */
 108 static struct i2c_driver adm1031_driver = {
 109         .driver = {
 110                 .name = "adm1031",
 111         },
 112         .attach_adapter = adm1031_attach_adapter,
 113         .detach_client = adm1031_detach_client,
 114 };
 115
 116 static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg)
 117 {
 118         return i2c_smbus_read_byte_data(client, reg);
 119 }
 120
 121 static inline int
 122 adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value)
 123 {
 124         return i2c_smbus_write_byte_data(client, reg, value);
 125 }
 126
 127
 128 #define TEMP_TO_REG(val)                (((val) < 0 ? ((val - 500) / 1000) : \
 129                                         ((val + 500) / 1000)))
 130
 131 #define TEMP_FROM_REG(val)              ((val) * 1000)
 132
 133 #define TEMP_FROM_REG_EXT(val, ext)     (TEMP_FROM_REG(val) + (ext) * 125)
 134
 135 #define FAN_FROM_REG(reg, div)          ((reg) ? (11250 * 60) / ((reg) * (div)) : 0)
 136
 137 static int FAN_TO_REG(int reg, int div)
 138 {
 139         int tmp;
 140         tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div);
 141         return tmp > 255 ? 255 : tmp;
 142 }
 143
 144 #define FAN_DIV_FROM_REG(reg)           (1<<(((reg)&0xc0)>>6))
 145
 146 #define PWM_TO_REG(val)                 (SENSORS_LIMIT((val), 0, 255) >> 4)
 147 #define PWM_FROM_REG(val)               ((val) << 4)
 148
 149 #define FAN_CHAN_FROM_REG(reg)          (((reg) >> 5) & 7)
 150 #define FAN_CHAN_TO_REG(val, reg)       \
 151         (((reg) & 0x1F) | (((val) << 5) & 0xe0))
 152
 153 #define AUTO_TEMP_MIN_TO_REG(val, reg)  \
 154         ((((val)/500) & 0xf8)|((reg) & 0x7))
 155 #define AUTO_TEMP_RANGE_FROM_REG(reg)   (5000 * (1<< ((reg)&0x7)))
 156 #define AUTO_TEMP_MIN_FROM_REG(reg)     (1000 * ((((reg) >> 3) & 0x1f) << 2))
 157
 158 #define AUTO_TEMP_MIN_FROM_REG_DEG(reg) ((((reg) >> 3) & 0x1f) << 2)
 159
 160 #define AUTO_TEMP_OFF_FROM_REG(reg)             \
 161         (AUTO_TEMP_MIN_FROM_REG(reg) - 5000)
 162
 163 #define AUTO_TEMP_MAX_FROM_REG(reg)             \
 164         (AUTO_TEMP_RANGE_FROM_REG(reg) +        \
 165         AUTO_TEMP_MIN_FROM_REG(reg))
 166
 167 static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm)
 168 {
 169         int ret;
 170         int range = val - AUTO_TEMP_MIN_FROM_REG(reg);
 171
 172         range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm);
 173         ret = ((reg & 0xf8) |
 174                (range < 10000 ? 0 :
 175                 range < 20000 ? 1 :
 176                 range < 40000 ? 2 : range < 80000 ? 3 : 4));
 177         return ret;
 178 }
 179
 180 /* FAN auto control */
 181 #define GET_FAN_AUTO_BITFIELD(data, idx)        \
 182         (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2]
 183
 184 /* The tables below contains the possible values for the auto fan
 185  * control bitfields. the index in the table is the register value.
 186  * MSb is the auto fan control enable bit, so the four first entries
 187  * in the table disables auto fan control when both bitfields are zero.
 188  */
 189 static auto_chan_table_t auto_channel_select_table_adm1031 = {
 190         {0, 0}, {0, 0}, {0, 0}, {0, 0},
 191         {2 /*0b010 */ , 4 /*0b100 */ },
 192         {2 /*0b010 */ , 2 /*0b010 */ },
 193         {4 /*0b100 */ , 4 /*0b100 */ },
 194         {7 /*0b111 */ , 7 /*0b111 */ },
 195 };
 196
 197 static auto_chan_table_t auto_channel_select_table_adm1030 = {
 198         {0, 0}, {0, 0}, {0, 0}, {0, 0},
 199         {2 /*0b10 */            , 0},
 200         {0xff /*invalid */      , 0},
 201         {0xff /*invalid */      , 0},
 202         {3 /*0b11 */            , 0},
 203 };
 204
 205 /* That function checks if a bitfield is valid and returns the other bitfield
 206  * nearest match if no exact match where found.
 207  */
 208 static int
 209 get_fan_auto_nearest(struct adm1031_data *data,
 210                      int chan, u8 val, u8 reg, u8 * new_reg)
 211 {
 212         int i;
 213         int first_match = -1, exact_match = -1;
 214         u8 other_reg_val =
 215             (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1];
 216
 217         if (val == 0) {
 218                 *new_reg = 0;
 219                 return 0;
 220         }
 221
 222         for (i = 0; i < 8; i++) {
 223                 if ((val == (*data->chan_select_table)[i][chan]) &&
 224                     ((*data->chan_select_table)[i][chan ? 0 : 1] ==
 225                      other_reg_val)) {
 226                         /* We found an exact match */
 227                         exact_match = i;
 228                         break;
 229                 } else if (val == (*data->chan_select_table)[i][chan] &&
 230                            first_match == -1) {
 231                         /* Save the first match in case of an exact match has not been
 232                          * found
 233                          */
 234                         first_match = i;
 235                 }
 236         }
 237
 238         if (exact_match >= 0) {
 239                 *new_reg = exact_match;
 240         } else if (first_match >= 0) {
 241                 *new_reg = first_match;
 242         } else {
 243                 return -EINVAL;
 244         }
 245         return 0;
 246 }
 247
 248 static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr)
 249 {
 250         struct adm1031_data *data = adm1031_update_device(dev);
 251         return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr));
 252 }
 253
 254 static ssize_t
 255 set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr)
 256 {
 257         struct i2c_client *client = to_i2c_client(dev);
 258         struct adm1031_data *data = i2c_get_clientdata(client);
 259         int val = simple_strtol(buf, NULL, 10);
 260         u8 reg;
 261         int ret;
 262         u8 old_fan_mode;
 263
 264         old_fan_mode = data->conf1;
 265
 266         mutex_lock(&data->update_lock);
 267
 268         if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, &reg))) {
 269                 mutex_unlock(&data->update_lock);
 270                 return ret;
 271         }
 272         if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^
 273             (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) {
 274                 if (data->conf1 & ADM1031_CONF1_AUTO_MODE){
 275                         /* Switch to Auto Fan Mode
 276                          * Save PWM registers
 277                          * Set PWM registers to 33% Both */
 278                         data->old_pwm[0] = data->pwm[0];
 279                         data->old_pwm[1] = data->pwm[1];
 280                         adm1031_write_value(client, ADM1031_REG_PWM, 0x55);
 281                 } else {
 282                         /* Switch to Manual Mode */
 283                         data->pwm[0] = data->old_pwm[0];
 284                         data->pwm[1] = data->old_pwm[1];
 285                         /* Restore PWM registers */
 286                         adm1031_write_value(client, ADM1031_REG_PWM,
 287                                             data->pwm[0] | (data->pwm[1] << 4));
 288                 }
 289         }
 290         data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
 291         adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1);
 292         mutex_unlock(&data->update_lock);
 293         return count;
 294 }
 295
 296 #define fan_auto_channel_offset(offset)                                         \
 297 static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf)    \
 298 {                                                                               \
 299         return show_fan_auto_channel(dev, buf, offset - 1);                     \
 300 }                                                                               \
 301 static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr,                \
 302         const char *buf, size_t count)                                          \
 303 {                                                                               \
 304         return set_fan_auto_channel(dev, buf, count, offset - 1);               \
 305 }                                                                               \
 306 static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR,               \
 307                    show_fan_auto_channel_##offset,                              \
 308                    set_fan_auto_channel_##offset)
 309
 310 fan_auto_channel_offset(1);
 311 fan_auto_channel_offset(2);
 312
 313 /* Auto Temps */
 314 static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr)
 315 {
 316         struct adm1031_data *data = adm1031_update_device(dev);
 317         return sprintf(buf, "%d\n",
 318                        AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr]));
 319 }
 320 static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr)
 321 {
 322         struct adm1031_data *data = adm1031_update_device(dev);
 323         return sprintf(buf, "%d\n",
 324                        AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr]));
 325 }
 326 static ssize_t
 327 set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr)
 328 {
 329         struct i2c_client *client = to_i2c_client(dev);
 330         struct adm1031_data *data = i2c_get_clientdata(client);
 331         int val = simple_strtol(buf, NULL, 10);
 332
 333         mutex_lock(&data->update_lock);
 334         data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]);
 335         adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
 336                             data->auto_temp[nr]);
 337         mutex_unlock(&data->update_lock);
 338         return count;
 339 }
 340 static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr)
 341 {
 342         struct adm1031_data *data = adm1031_update_device(dev);
 343         return sprintf(buf, "%d\n",
 344                        AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr]));
 345 }
 346 static ssize_t
 347 set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr)
 348 {
 349         struct i2c_client *client = to_i2c_client(dev);
 350         struct adm1031_data *data = i2c_get_clientdata(client);
 351         int val = simple_strtol(buf, NULL, 10);
 352
 353         mutex_lock(&data->update_lock);
 354         data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]);
 355         adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
 356                             data->temp_max[nr]);
 357         mutex_unlock(&data->update_lock);
 358         return count;
 359 }
 360
 361 #define auto_temp_reg(offset)                                                   \
 362 static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf)     \
 363 {                                                                               \
 364         return show_auto_temp_off(dev, buf, offset - 1);                        \
 365 }                                                                               \
 366 static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)     \
 367 {                                                                               \
 368         return show_auto_temp_min(dev, buf, offset - 1);                        \
 369 }                                                                               \
 370 static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)     \
 371 {                                                                               \
 372         return show_auto_temp_max(dev, buf, offset - 1);                        \
 373 }                                                                               \
 374 static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr,         \
 375                                              const char *buf, size_t count)     \
 376 {                                                                               \
 377         return set_auto_temp_min(dev, buf, count, offset - 1);          \
 378 }                                                                               \
 379 static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr,         \
 380                                              const char *buf, size_t count)     \
 381 {                                                                               \
 382         return set_auto_temp_max(dev, buf, count, offset - 1);          \
 383 }                                                                               \
 384 static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO,                            \
 385                    show_auto_temp_##offset##_off, NULL);                        \
 386 static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR,                  \
 387                    show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\
 388 static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR,                  \
 389                    show_auto_temp_##offset##_max, set_auto_temp_##offset##_max)
 390
 391 auto_temp_reg(1);
 392 auto_temp_reg(2);
 393 auto_temp_reg(3);
 394
 395 /* pwm */
 396 static ssize_t show_pwm(struct device *dev, char *buf, int nr)
 397 {
 398         struct adm1031_data *data = adm1031_update_device(dev);
 399         return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr]));
 400 }
 401 static ssize_t
 402 set_pwm(struct device *dev, const char *buf, size_t count, int nr)
 403 {
 404         struct i2c_client *client = to_i2c_client(dev);
 405         struct adm1031_data *data = i2c_get_clientdata(client);
 406         int val = simple_strtol(buf, NULL, 10);
 407         int reg;
 408
 409         mutex_lock(&data->update_lock);
 410         if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) &&
 411             (((val>>4) & 0xf) != 5)) {
 412                 /* In automatic mode, the only PWM accepted is 33% */
 413                 mutex_unlock(&data->update_lock);
 414                 return -EINVAL;
 415         }
 416         data->pwm[nr] = PWM_TO_REG(val);
 417         reg = adm1031_read_value(client, ADM1031_REG_PWM);
 418         adm1031_write_value(client, ADM1031_REG_PWM,
 419                             nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf)
 420                             : (data->pwm[nr] & 0xf) | (reg & 0xf0));
 421         mutex_unlock(&data->update_lock);
 422         return count;
 423 }
 424
 425 #define pwm_reg(offset)                                                 \
 426 static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
 427 {                                                                       \
 428         return show_pwm(dev, buf, offset - 1);                  \
 429 }                                                                       \
 430 static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr,                     \
 431                                  const char *buf, size_t count)         \
 432 {                                                                       \
 433         return set_pwm(dev, buf, count, offset - 1);            \
 434 }                                                                       \
 435 static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR,                      \
 436                    show_pwm_##offset, set_pwm_##offset)
 437
 438 pwm_reg(1);
 439 pwm_reg(2);
 440
 441 /* Fans */
 442
 443 /*
 444  * That function checks the cases where the fan reading is not
 445  * relevant.  It is used to provide 0 as fan reading when the fan is
 446  * not supposed to run
 447  */
 448 static int trust_fan_readings(struct adm1031_data *data, int chan)
 449 {
 450         int res = 0;
 451
 452         if (data->conf1 & ADM1031_CONF1_AUTO_MODE) {
 453                 switch (data->conf1 & 0x60) {
 454                 case 0x00:      /* remote temp1 controls fan1 remote temp2 controls fan2 */
 455                         res = data->temp[chan+1] >=
 456                               AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]);
 457                         break;
 458                 case 0x20:      /* remote temp1 controls both fans */
 459                         res =
 460                             data->temp[1] >=
 461                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]);
 462                         break;
 463                 case 0x40:      /* remote temp2 controls both fans */
 464                         res =
 465                             data->temp[2] >=
 466                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]);
 467                         break;
 468                 case 0x60:      /* max controls both fans */
 469                         res =
 470                             data->temp[0] >=
 471                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0])
 472                             || data->temp[1] >=
 473                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1])
 474                             || (data->chip_type == adm1031
 475                                 && data->temp[2] >=
 476                                 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]));
 477                         break;
 478                 }
 479         } else {
 480                 res = data->pwm[chan] > 0;
 481         }
 482         return res;
 483 }
 484
 485
 486 static ssize_t show_fan(struct device *dev, char *buf, int nr)
 487 {
 488         struct adm1031_data *data = adm1031_update_device(dev);
 489         int value;
 490
 491         value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr],
 492                                  FAN_DIV_FROM_REG(data->fan_div[nr])) : 0;
 493         return sprintf(buf, "%d\n", value);
 494 }
 495
 496 static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
 497 {
 498         struct adm1031_data *data = adm1031_update_device(dev);
 499         return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr]));
 500 }
 501 static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
 502 {
 503         struct adm1031_data *data = adm1031_update_device(dev);
 504         return sprintf(buf, "%d\n",
 505                        FAN_FROM_REG(data->fan_min[nr],
 506                                     FAN_DIV_FROM_REG(data->fan_div[nr])));
 507 }
 508 static ssize_t
 509 set_fan_min(struct device *dev, const char *buf, size_t count, int nr)
 510 {
 511         struct i2c_client *client = to_i2c_client(dev);
 512         struct adm1031_data *data = i2c_get_clientdata(client);
 513         int val = simple_strtol(buf, NULL, 10);
 514
 515         mutex_lock(&data->update_lock);
 516         if (val) {
 517                 data->fan_min[nr] =
 518                         FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr]));
 519         } else {
 520                 data->fan_min[nr] = 0xff;
 521         }
 522         adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]);
 523         mutex_unlock(&data->update_lock);
 524         return count;
 525 }
 526 static ssize_t
 527 set_fan_div(struct device *dev, const char *buf, size_t count, int nr)
 528 {
 529         struct i2c_client *client = to_i2c_client(dev);
 530         struct adm1031_data *data = i2c_get_clientdata(client);
 531         int val = simple_strtol(buf, NULL, 10);
 532         u8 tmp;
 533         int old_div;
 534         int new_min;
 535
 536         tmp = val == 8 ? 0xc0 :
 537               val == 4 ? 0x80 :
 538               val == 2 ? 0x40 :
 539               val == 1 ? 0x00 :
 540               0xff;
 541         if (tmp == 0xff)
 542                 return -EINVAL;
 543
 544         mutex_lock(&data->update_lock);
 545         /* Get fresh readings */
 546         data->fan_div[nr] = adm1031_read_value(client,
 547                                                ADM1031_REG_FAN_DIV(nr));
 548         data->fan_min[nr] = adm1031_read_value(client,
 549                                                ADM1031_REG_FAN_MIN(nr));
 550
 551         /* Write the new clock divider and fan min */
 552         old_div = FAN_DIV_FROM_REG(data->fan_div[nr]);
 553         data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]);
 554         new_min = data->fan_min[nr] * old_div /
 555                 FAN_DIV_FROM_REG(data->fan_div[nr]);
 556         data->fan_min[nr] = new_min > 0xff ? 0xff : new_min;
 557
 558         adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr),
 559                             data->fan_div[nr]);
 560         adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr),
 561                             data->fan_min[nr]);
 562
 563         /* Invalidate the cache: fan speed is no longer valid */
 564         data->valid = 0;
 565         mutex_unlock(&data->update_lock);
 566         return count;
 567 }
 568
 569 #define fan_offset(offset)                                              \
 570 static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
 571 {                                                                       \
 572         return show_fan(dev, buf, offset - 1);                  \
 573 }                                                                       \
 574 static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)   \
 575 {                                                                       \
 576         return show_fan_min(dev, buf, offset - 1);                      \
 577 }                                                                       \
 578 static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf)   \
 579 {                                                                       \
 580         return show_fan_div(dev, buf, offset - 1);                      \
 581 }                                                                       \
 582 static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr,               \
 583         const char *buf, size_t count)                                  \
 584 {                                                                       \
 585         return set_fan_min(dev, buf, count, offset - 1);                \
 586 }                                                                       \
 587 static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr,               \
 588         const char *buf, size_t count)                                  \
 589 {                                                                       \
 590         return set_fan_div(dev, buf, count, offset - 1);                \
 591 }                                                                       \
 592 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset,     \
 593                    NULL);                                               \
 594 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,                \
 595                    show_fan_##offset##_min, set_fan_##offset##_min);    \
 596 static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,                \
 597                    show_fan_##offset##_div, set_fan_##offset##_div);    \
 598 static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR,       \
 599                    show_pwm_##offset, set_pwm_##offset)
 600
 601 fan_offset(1);
 602 fan_offset(2);
 603
 604
 605 /* Temps */
 606 static ssize_t show_temp(struct device *dev, char *buf, int nr)
 607 {
 608         struct adm1031_data *data = adm1031_update_device(dev);
 609         int ext;
 610         ext = nr == 0 ?
 611             ((data->ext_temp[nr] >> 6) & 0x3) * 2 :
 612             (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7));
 613         return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext));
 614 }
 615 static ssize_t show_temp_min(struct device *dev, char *buf, int nr)
 616 {
 617         struct adm1031_data *data = adm1031_update_device(dev);
 618         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
 619 }
 620 static ssize_t show_temp_max(struct device *dev, char *buf, int nr)
 621 {
 622         struct adm1031_data *data = adm1031_update_device(dev);
 623         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
 624 }
 625 static ssize_t show_temp_crit(struct device *dev, char *buf, int nr)
 626 {
 627         struct adm1031_data *data = adm1031_update_device(dev);
 628         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr]));
 629 }
 630 static ssize_t
 631 set_temp_min(struct device *dev, const char *buf, size_t count, int nr)
 632 {
 633         struct i2c_client *client = to_i2c_client(dev);
 634         struct adm1031_data *data = i2c_get_clientdata(client);
 635         int val;
 636
 637         val = simple_strtol(buf, NULL, 10);
 638         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
 639         mutex_lock(&data->update_lock);
 640         data->temp_min[nr] = TEMP_TO_REG(val);
 641         adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr),
 642                             data->temp_min[nr]);
 643         mutex_unlock(&data->update_lock);
 644         return count;
 645 }
 646 static ssize_t
 647 set_temp_max(struct device *dev, const char *buf, size_t count, int nr)
 648 {
 649         struct i2c_client *client = to_i2c_client(dev);
 650         struct adm1031_data *data = i2c_get_clientdata(client);
 651         int val;
 652
 653         val = simple_strtol(buf, NULL, 10);
 654         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
 655         mutex_lock(&data->update_lock);
 656         data->temp_max[nr] = TEMP_TO_REG(val);
 657         adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr),
 658                             data->temp_max[nr]);
 659         mutex_unlock(&data->update_lock);
 660         return count;
 661 }
 662 static ssize_t
 663 set_temp_crit(struct device *dev, const char *buf, size_t count, int nr)
 664 {
 665         struct i2c_client *client = to_i2c_client(dev);
 666         struct adm1031_data *data = i2c_get_clientdata(client);
 667         int val;
 668
 669         val = simple_strtol(buf, NULL, 10);
 670         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
 671         mutex_lock(&data->update_lock);
 672         data->temp_crit[nr] = TEMP_TO_REG(val);
 673         adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr),
 674                             data->temp_crit[nr]);
 675         mutex_unlock(&data->update_lock);
 676         return count;
 677 }
 678
 679 #define temp_reg(offset)                                                        \
 680 static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf)                \
 681 {                                                                               \
 682         return show_temp(dev, buf, offset - 1);                         \
 683 }                                                                               \
 684 static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)          \
 685 {                                                                               \
 686         return show_temp_min(dev, buf, offset - 1);                             \
 687 }                                                                               \
 688 static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)          \
 689 {                                                                               \
 690         return show_temp_max(dev, buf, offset - 1);                             \
 691 }                                                                               \
 692 static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf) \
 693 {                                                                               \
 694         return show_temp_crit(dev, buf, offset - 1);                    \
 695 }                                                                               \
 696 static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr,                      \
 697                                         const char *buf, size_t count)          \
 698 {                                                                               \
 699         return set_temp_min(dev, buf, count, offset - 1);                       \
 700 }                                                                               \
 701 static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr,                      \
 702                                         const char *buf, size_t count)          \
 703 {                                                                               \
 704         return set_temp_max(dev, buf, count, offset - 1);                       \
 705 }                                                                               \
 706 static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr,                     \
 707                                          const char *buf, size_t count)         \
 708 {                                                                               \
 709         return set_temp_crit(dev, buf, count, offset - 1);                      \
 710 }                                                                               \
 711 static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset,           \
 712                    NULL);                                                       \
 713 static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,                       \
 714                    show_temp_##offset##_min, set_temp_##offset##_min);          \
 715 static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,                       \
 716                    show_temp_##offset##_max, set_temp_##offset##_max);          \
 717 static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR,                      \
 718                    show_temp_##offset##_crit, set_temp_##offset##_crit)
 719
 720 temp_reg(1);
 721 temp_reg(2);
 722 temp_reg(3);
 723
 724 /* Alarms */
 725 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
 726 {
 727         struct adm1031_data *data = adm1031_update_device(dev);
 728         return sprintf(buf, "%d\n", data->alarm);
 729 }
 730
 731 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
 732
 733
 734 static int adm1031_attach_adapter(struct i2c_adapter *adapter)
 735 {
 736         if (!(adapter->class & I2C_CLASS_HWMON))
 737                 return 0;
 738         return i2c_probe(adapter, &addr_data, adm1031_detect);
 739 }
 740
 741 static struct attribute *adm1031_attributes[] = {
 742         &dev_attr_fan1_input.attr,
 743         &dev_attr_fan1_div.attr,
 744         &dev_attr_fan1_min.attr,
 745         &dev_attr_pwm1.attr,
 746         &dev_attr_auto_fan1_channel.attr,
 747         &dev_attr_temp1_input.attr,
 748         &dev_attr_temp1_min.attr,
 749         &dev_attr_temp1_max.attr,
 750         &dev_attr_temp1_crit.attr,
 751         &dev_attr_temp2_input.attr,
 752         &dev_attr_temp2_min.attr,
 753         &dev_attr_temp2_max.attr,
 754         &dev_attr_temp2_crit.attr,
 755
 756         &dev_attr_auto_temp1_off.attr,
 757         &dev_attr_auto_temp1_min.attr,
 758         &dev_attr_auto_temp1_max.attr,
 759
 760         &dev_attr_auto_temp2_off.attr,
 761         &dev_attr_auto_temp2_min.attr,
 762         &dev_attr_auto_temp2_max.attr,
 763
 764         &dev_attr_auto_fan1_min_pwm.attr,
 765
 766         &dev_attr_alarms.attr,
 767
 768         NULL
 769 };
 770
 771 static const struct attribute_group adm1031_group = {
 772         .attrs = adm1031_attributes,
 773 };
 774
 775 static struct attribute *adm1031_attributes_opt[] = {
 776         &dev_attr_fan2_input.attr,
 777         &dev_attr_fan2_div.attr,
 778         &dev_attr_fan2_min.attr,
 779         &dev_attr_pwm2.attr,
 780         &dev_attr_auto_fan2_channel.attr,
 781         &dev_attr_temp3_input.attr,
 782         &dev_attr_temp3_min.attr,
 783         &dev_attr_temp3_max.attr,
 784         &dev_attr_temp3_crit.attr,
 785         &dev_attr_auto_temp3_off.attr,
 786         &dev_attr_auto_temp3_min.attr,
 787         &dev_attr_auto_temp3_max.attr,
 788         &dev_attr_auto_fan2_min_pwm.attr,
 789         NULL
 790 };
 791
 792 static const struct attribute_group adm1031_group_opt = {
 793         .attrs = adm1031_attributes_opt,
 794 };
 795
 796 /* This function is called by i2c_probe */
 797 static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind)
 798 {
 799         struct i2c_client *new_client;
 800         struct adm1031_data *data;
 801         int err = 0;
 802         const char *name = "";
 803
 804         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 805                 goto exit;
 806
 807         if (!(data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL))) {
 808                 err = -ENOMEM;
 809                 goto exit;
 810         }
 811
 812         new_client = &data->client;
 813         i2c_set_clientdata(new_client, data);
 814         new_client->addr = address;
 815         new_client->adapter = adapter;
 816         new_client->driver = &adm1031_driver;
 817         new_client->flags = 0;
 818
 819         if (kind < 0) {
 820                 int id, co;
 821                 id = i2c_smbus_read_byte_data(new_client, 0x3d);
 822                 co = i2c_smbus_read_byte_data(new_client, 0x3e);
 823
 824                 if (!((id == 0x31 || id == 0x30) && co == 0x41))
 825                         goto exit_free;
 826                 kind = (id == 0x30) ? adm1030 : adm1031;
 827         }
 828
 829         if (kind <= 0)
 830                 kind = adm1031;
 831
 832         /* Given the detected chip type, set the chip name and the
 833          * auto fan control helper table. */
 834         if (kind == adm1030) {
 835                 name = "adm1030";
 836                 data->chan_select_table = &auto_channel_select_table_adm1030;
 837         } else if (kind == adm1031) {
 838                 name = "adm1031";
 839                 data->chan_select_table = &auto_channel_select_table_adm1031;
 840         }
 841         data->chip_type = kind;
 842
 843         strlcpy(new_client->name, name, I2C_NAME_SIZE);
 844         data->valid = 0;
 845         mutex_init(&data->update_lock);
 846
 847         /* Tell the I2C layer a new client has arrived */
 848         if ((err = i2c_attach_client(new_client)))
 849                 goto exit_free;
 850
 851         /* Initialize the ADM1031 chip */
 852         adm1031_init_client(new_client);
 853
 854         /* Register sysfs hooks */
 855         if ((err = sysfs_create_group(&new_client->dev.kobj, &adm1031_group)))
 856                 goto exit_detach;
 857
 858         if (kind == adm1031) {
 859                 if ((err = sysfs_create_group(&new_client->dev.kobj,
 860                                                 &adm1031_group_opt)))
 861                         goto exit_remove;
 862         }
 863
 864         data->hwmon_dev = hwmon_device_register(&new_client->dev);
 865         if (IS_ERR(data->hwmon_dev)) {
 866                 err = PTR_ERR(data->hwmon_dev);
 867                 goto exit_remove;
 868         }
 869
 870         return 0;
 871
 872 exit_remove:
 873         sysfs_remove_group(&new_client->dev.kobj, &adm1031_group);
 874         sysfs_remove_group(&new_client->dev.kobj, &adm1031_group_opt);
 875 exit_detach:
 876         i2c_detach_client(new_client);
 877 exit_free:
 878         kfree(data);
 879 exit:
 880         return err;
 881 }
 882
 883 static int adm1031_detach_client(struct i2c_client *client)
 884 {
 885         struct adm1031_data *data = i2c_get_clientdata(client);
 886         int ret;
 887
 888         hwmon_device_unregister(data->hwmon_dev);
 889         sysfs_remove_group(&client->dev.kobj, &adm1031_group);
 890         sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt);
 891         if ((ret = i2c_detach_client(client)) != 0) {
 892                 return ret;
 893         }
 894         kfree(data);
 895         return 0;
 896 }
 897
 898 static void adm1031_init_client(struct i2c_client *client)
 899 {
 900         unsigned int read_val;
 901         unsigned int mask;
 902         struct adm1031_data *data = i2c_get_clientdata(client);
 903
 904         mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE);
 905         if (data->chip_type == adm1031) {
 906                 mask |= (ADM1031_CONF2_PWM2_ENABLE |
 907                         ADM1031_CONF2_TACH2_ENABLE);
 908         }
 909         /* Initialize the ADM1031 chip (enables fan speed reading ) */
 910         read_val = adm1031_read_value(client, ADM1031_REG_CONF2);
 911         if ((read_val | mask) != read_val) {
 912             adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask);
 913         }
 914
 915         read_val = adm1031_read_value(client, ADM1031_REG_CONF1);
 916         if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) {
 917             adm1031_write_value(client, ADM1031_REG_CONF1, read_val |
 918                                 ADM1031_CONF1_MONITOR_ENABLE);
 919         }
 920
 921 }
 922
 923 static struct adm1031_data *adm1031_update_device(struct device *dev)
 924 {
 925         struct i2c_client *client = to_i2c_client(dev);
 926         struct adm1031_data *data = i2c_get_clientdata(client);
 927         int chan;
 928
 929         mutex_lock(&data->update_lock);
 930
 931         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 932             || !data->valid) {
 933
 934                 dev_dbg(&client->dev, "Starting adm1031 update\n");
 935                 for (chan = 0;
 936                      chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) {
 937                         u8 oldh, newh;
 938
 939                         oldh =
 940                             adm1031_read_value(client, ADM1031_REG_TEMP(chan));
 941                         data->ext_temp[chan] =
 942                             adm1031_read_value(client, ADM1031_REG_EXT_TEMP);
 943                         newh =
 944                             adm1031_read_value(client, ADM1031_REG_TEMP(chan));
 945                         if (newh != oldh) {
 946                                 data->ext_temp[chan] =
 947                                     adm1031_read_value(client,
 948                                                        ADM1031_REG_EXT_TEMP);
 949 #ifdef DEBUG
 950                                 oldh =
 951                                     adm1031_read_value(client,
 952                                                        ADM1031_REG_TEMP(chan));
 953
 954                                 /* oldh is actually newer */
 955                                 if (newh != oldh)
 956                                         dev_warn(&client->dev,
 957                                                  "Remote temperature may be "
 958                                                  "wrong.\n");
 959 #endif
 960                         }
 961                         data->temp[chan] = newh;
 962
 963                         data->temp_min[chan] =
 964                             adm1031_read_value(client,
 965                                                ADM1031_REG_TEMP_MIN(chan));
 966                         data->temp_max[chan] =
 967                             adm1031_read_value(client,
 968                                                ADM1031_REG_TEMP_MAX(chan));
 969                         data->temp_crit[chan] =
 970                             adm1031_read_value(client,
 971                                                ADM1031_REG_TEMP_CRIT(chan));
 972                         data->auto_temp[chan] =
 973                             adm1031_read_value(client,
 974                                                ADM1031_REG_AUTO_TEMP(chan));
 975
 976                 }
 977
 978                 data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1);
 979                 data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2);
 980
 981                 data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0))
 982                              | (adm1031_read_value(client, ADM1031_REG_STATUS(1))
 983                                 << 8);
 984                 if (data->chip_type == adm1030) {
 985                         data->alarm &= 0xc0ff;
 986                 }
 987
 988                 for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) {
 989                         data->fan_div[chan] =
 990                             adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan));
 991                         data->fan_min[chan] =
 992                             adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan));
 993                         data->fan[chan] =
 994                             adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan));
 995                         data->pwm[chan] =
 996                             0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >>
 997                                    (4*chan));
 998                 }
 999                 data->last_updated = jiffies;
1000                 data->valid = 1;
1001         }
1002
1003         mutex_unlock(&data->update_lock);
1004
1005         return data;
1006 }
1007
1008 static int __init sensors_adm1031_init(void)
1009 {
1010         return i2c_add_driver(&adm1031_driver);
1011 }
1012
1013 static void __exit sensors_adm1031_exit(void)
1014 {
1015         i2c_del_driver(&adm1031_driver);
1016 }
1017
1018 MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>");
1019 MODULE_DESCRIPTION("ADM1031/ADM1030 driver");
1020 MODULE_LICENSE("GPL");
1021
1022 module_init(sensors_adm1031_init);
1023 module_exit(sensors_adm1031_exit);