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