SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/hwmon/sis5595.c

   1 /*
   2     sis5595.c - Part of lm_sensors, Linux kernel modules
   3                 for hardware monitoring
   4
   5     Copyright (C) 1998 - 2001 Frodo Looijaard <frodol@dds.nl>,
   6                         Kyösti Mälkki <kmalkki@cc.hut.fi>, and
   7                         Mark D. Studebaker <mdsxyz123@yahoo.com>
   8     Ported to Linux 2.6 by Aurelien Jarno <aurelien@aurel32.net> with
   9     the help of Jean Delvare <khali@linux-fr.org>
  10
  11     This program is free software; you can redistribute it and/or modify
  12     it under the terms of the GNU General Public License as published by
  13     the Free Software Foundation; either version 2 of the License, or
  14     (at your option) any later version.
  15
  16     This program is distributed in the hope that it will be useful,
  17     but WITHOUT ANY WARRANTY; without even the implied warranty of
  18     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19     GNU General Public License for more details.
  20
  21     You should have received a copy of the GNU General Public License
  22     along with this program; if not, write to the Free Software
  23     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24 */
  25
  26 /*
  27    SiS southbridge has a LM78-like chip integrated on the same IC.
  28    This driver is a customized copy of lm78.c
  29
  30    Supports following revisions:
  31         Version         PCI ID          PCI Revision
  32         1               1039/0008       AF or less
  33         2               1039/0008       B0 or greater
  34
  35    Note: these chips contain a 0008 device which is incompatible with the
  36          5595. We recognize these by the presence of the listed
  37          "blacklist" PCI ID and refuse to load.
  38
  39    NOT SUPPORTED        PCI ID          BLACKLIST PCI ID
  40          540            0008            0540
  41          550            0008            0550
  42         5513            0008            5511
  43         5581            0008            5597
  44         5582            0008            5597
  45         5597            0008            5597
  46         5598            0008            5597/5598
  47          630            0008            0630
  48          645            0008            0645
  49          730            0008            0730
  50          735            0008            0735
  51 */
  52
  53 #include <linux/module.h>
  54 #include <linux/slab.h>
  55 #include <linux/ioport.h>
  56 #include <linux/pci.h>
  57 #include <linux/i2c.h>
  58 #include <linux/i2c-isa.h>
  59 #include <linux/i2c-sensor.h>
  60 #include <linux/hwmon.h>
  61 #include <linux/err.h>
  62 #include <linux/init.h>
  63 #include <linux/jiffies.h>
  64 #include <asm/io.h>
  65
  66
  67 /* If force_addr is set to anything different from 0, we forcibly enable
  68    the device at the given address. */
  69 static u16 force_addr;
  70 module_param(force_addr, ushort, 0);
  71 MODULE_PARM_DESC(force_addr,
  72                  "Initialize the base address of the sensors");
  73
  74 /* Device address
  75    Note that we can't determine the ISA address until we have initialized
  76    our module */
  77 static unsigned short address;
  78
  79 /* Many SIS5595 constants specified below */
  80
  81 /* Length of ISA address segment */
  82 #define SIS5595_EXTENT 8
  83 /* PCI Config Registers */
  84 #define SIS5595_REVISION_REG 0x08
  85 #define SIS5595_BASE_REG 0x68
  86 #define SIS5595_PIN_REG 0x7A
  87 #define SIS5595_ENABLE_REG 0x7B
  88
  89 /* Where are the ISA address/data registers relative to the base address */
  90 #define SIS5595_ADDR_REG_OFFSET 5
  91 #define SIS5595_DATA_REG_OFFSET 6
  92
  93 /* The SIS5595 registers */
  94 #define SIS5595_REG_IN_MAX(nr) (0x2b + (nr) * 2)
  95 #define SIS5595_REG_IN_MIN(nr) (0x2c + (nr) * 2)
  96 #define SIS5595_REG_IN(nr) (0x20 + (nr))
  97
  98 #define SIS5595_REG_FAN_MIN(nr) (0x3b + (nr))
  99 #define SIS5595_REG_FAN(nr) (0x28 + (nr))
 100
 101 /* On the first version of the chip, the temp registers are separate.
 102    On the second version,
 103    TEMP pin is shared with IN4, configured in PCI register 0x7A.
 104    The registers are the same as well.
 105    OVER and HYST are really MAX and MIN. */
 106
 107 #define REV2MIN 0xb0
 108 #define SIS5595_REG_TEMP        (( data->revision) >= REV2MIN) ? \
 109                                         SIS5595_REG_IN(4) : 0x27
 110 #define SIS5595_REG_TEMP_OVER   (( data->revision) >= REV2MIN) ? \
 111                                         SIS5595_REG_IN_MAX(4) : 0x39
 112 #define SIS5595_REG_TEMP_HYST   (( data->revision) >= REV2MIN) ? \
 113                                         SIS5595_REG_IN_MIN(4) : 0x3a
 114
 115 #define SIS5595_REG_CONFIG 0x40
 116 #define SIS5595_REG_ALARM1 0x41
 117 #define SIS5595_REG_ALARM2 0x42
 118 #define SIS5595_REG_FANDIV 0x47
 119
 120 /* Conversions. Limit checking is only done on the TO_REG
 121    variants. */
 122
 123 /* IN: mV, (0V to 4.08V)
 124    REG: 16mV/bit */
 125 static inline u8 IN_TO_REG(unsigned long val)
 126 {
 127         unsigned long nval = SENSORS_LIMIT(val, 0, 4080);
 128         return (nval + 8) / 16;
 129 }
 130 #define IN_FROM_REG(val) ((val) *  16)
 131
 132 static inline u8 FAN_TO_REG(long rpm, int div)
 133 {
 134         if (rpm <= 0)
 135                 return 255;
 136         return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
 137 }
 138
 139 static inline int FAN_FROM_REG(u8 val, int div)
 140 {
 141         return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
 142 }
 143
 144 /* TEMP: mC (-54.12C to +157.53C)
 145    REG: 0.83C/bit + 52.12, two's complement  */
 146 static inline int TEMP_FROM_REG(s8 val)
 147 {
 148         return val * 830 + 52120;
 149 }
 150 static inline s8 TEMP_TO_REG(int val)
 151 {
 152         int nval = SENSORS_LIMIT(val, -54120, 157530) ;
 153         return nval<0 ? (nval-5212-415)/830 : (nval-5212+415)/830;
 154 }
 155
 156 /* FAN DIV: 1, 2, 4, or 8 (defaults to 2)
 157    REG: 0, 1, 2, or 3 (respectively) (defaults to 1) */
 158 static inline u8 DIV_TO_REG(int val)
 159 {
 160         return val==8 ? 3 : val==4 ? 2 : val==1 ? 0 : 1;
 161 }
 162 #define DIV_FROM_REG(val) (1 << (val))
 163
 164 /* For the SIS5595, we need to keep some data in memory. That
 165    data is pointed to by sis5595_list[NR]->data. The structure itself is
 166    dynamically allocated, at the time when the new sis5595 client is
 167    allocated. */
 168 struct sis5595_data {
 169         struct i2c_client client;
 170         struct class_device *class_dev;
 171         struct semaphore lock;
 172
 173         struct semaphore update_lock;
 174         char valid;             /* !=0 if following fields are valid */
 175         unsigned long last_updated;     /* In jiffies */
 176         char maxins;            /* == 3 if temp enabled, otherwise == 4 */
 177         u8 revision;            /* Reg. value */
 178
 179         u8 in[5];               /* Register value */
 180         u8 in_max[5];           /* Register value */
 181         u8 in_min[5];           /* Register value */
 182         u8 fan[2];              /* Register value */
 183         u8 fan_min[2];          /* Register value */
 184         s8 temp;                /* Register value */
 185         s8 temp_over;           /* Register value */
 186         s8 temp_hyst;           /* Register value */
 187         u8 fan_div[2];          /* Register encoding, shifted right */
 188         u16 alarms;             /* Register encoding, combined */
 189 };
 190
 191 static struct pci_dev *s_bridge;        /* pointer to the (only) sis5595 */
 192
 193 static int sis5595_detect(struct i2c_adapter *adapter);
 194 static int sis5595_detach_client(struct i2c_client *client);
 195
 196 static int sis5595_read_value(struct i2c_client *client, u8 register);
 197 static int sis5595_write_value(struct i2c_client *client, u8 register, u8 value);
 198 static struct sis5595_data *sis5595_update_device(struct device *dev);
 199 static void sis5595_init_client(struct i2c_client *client);
 200
 201 static struct i2c_driver sis5595_driver = {
 202         .owner          = THIS_MODULE,
 203         .name           = "sis5595",
 204         .attach_adapter = sis5595_detect,
 205         .detach_client  = sis5595_detach_client,
 206 };
 207
 208 /* 4 Voltages */
 209 static ssize_t show_in(struct device *dev, char *buf, int nr)
 210 {
 211         struct sis5595_data *data = sis5595_update_device(dev);
 212         return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr]));
 213 }
 214
 215 static ssize_t show_in_min(struct device *dev, char *buf, int nr)
 216 {
 217         struct sis5595_data *data = sis5595_update_device(dev);
 218         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[nr]));
 219 }
 220
 221 static ssize_t show_in_max(struct device *dev, char *buf, int nr)
 222 {
 223         struct sis5595_data *data = sis5595_update_device(dev);
 224         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[nr]));
 225 }
 226
 227 static ssize_t set_in_min(struct device *dev, const char *buf,
 228                size_t count, int nr)
 229 {
 230         struct i2c_client *client = to_i2c_client(dev);
 231         struct sis5595_data *data = i2c_get_clientdata(client);
 232         unsigned long val = simple_strtoul(buf, NULL, 10);
 233
 234         down(&data->update_lock);
 235         data->in_min[nr] = IN_TO_REG(val);
 236         sis5595_write_value(client, SIS5595_REG_IN_MIN(nr), data->in_min[nr]);
 237         up(&data->update_lock);
 238         return count;
 239 }
 240
 241 static ssize_t set_in_max(struct device *dev, const char *buf,
 242                size_t count, int nr)
 243 {
 244         struct i2c_client *client = to_i2c_client(dev);
 245         struct sis5595_data *data = i2c_get_clientdata(client);
 246         unsigned long val = simple_strtoul(buf, NULL, 10);
 247
 248         down(&data->update_lock);
 249         data->in_max[nr] = IN_TO_REG(val);
 250         sis5595_write_value(client, SIS5595_REG_IN_MAX(nr), data->in_max[nr]);
 251         up(&data->update_lock);
 252         return count;
 253 }
 254
 255 #define show_in_offset(offset)                                  \
 256 static ssize_t                                                  \
 257         show_in##offset (struct device *dev, struct device_attribute *attr, char *buf)          \
 258 {                                                               \
 259         return show_in(dev, buf, offset);                       \
 260 }                                                               \
 261 static DEVICE_ATTR(in##offset##_input, S_IRUGO,                 \
 262                 show_in##offset, NULL);                         \
 263 static ssize_t                                                  \
 264         show_in##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)    \
 265 {                                                               \
 266         return show_in_min(dev, buf, offset);                   \
 267 }                                                               \
 268 static ssize_t                                                  \
 269         show_in##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)    \
 270 {                                                               \
 271         return show_in_max(dev, buf, offset);                   \
 272 }                                                               \
 273 static ssize_t set_in##offset##_min (struct device *dev, struct device_attribute *attr, \
 274                 const char *buf, size_t count)                  \
 275 {                                                               \
 276         return set_in_min(dev, buf, count, offset);             \
 277 }                                                               \
 278 static ssize_t set_in##offset##_max (struct device *dev, struct device_attribute *attr, \
 279                 const char *buf, size_t count)                  \
 280 {                                                               \
 281         return set_in_max(dev, buf, count, offset);             \
 282 }                                                               \
 283 static DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR,         \
 284                 show_in##offset##_min, set_in##offset##_min);   \
 285 static DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR,         \
 286                 show_in##offset##_max, set_in##offset##_max);
 287
 288 show_in_offset(0);
 289 show_in_offset(1);
 290 show_in_offset(2);
 291 show_in_offset(3);
 292 show_in_offset(4);
 293
 294 /* Temperature */
 295 static ssize_t show_temp(struct device *dev, struct device_attribute *attr, char *buf)
 296 {
 297         struct sis5595_data *data = sis5595_update_device(dev);
 298         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
 299 }
 300
 301 static ssize_t show_temp_over(struct device *dev, struct device_attribute *attr, char *buf)
 302 {
 303         struct sis5595_data *data = sis5595_update_device(dev);
 304         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
 305 }
 306
 307 static ssize_t set_temp_over(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
 308 {
 309         struct i2c_client *client = to_i2c_client(dev);
 310         struct sis5595_data *data = i2c_get_clientdata(client);
 311         long val = simple_strtol(buf, NULL, 10);
 312
 313         down(&data->update_lock);
 314         data->temp_over = TEMP_TO_REG(val);
 315         sis5595_write_value(client, SIS5595_REG_TEMP_OVER, data->temp_over);
 316         up(&data->update_lock);
 317         return count;
 318 }
 319
 320 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *attr, char *buf)
 321 {
 322         struct sis5595_data *data = sis5595_update_device(dev);
 323         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
 324 }
 325
 326 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
 327 {
 328         struct i2c_client *client = to_i2c_client(dev);
 329         struct sis5595_data *data = i2c_get_clientdata(client);
 330         long val = simple_strtol(buf, NULL, 10);
 331
 332         down(&data->update_lock);
 333         data->temp_hyst = TEMP_TO_REG(val);
 334         sis5595_write_value(client, SIS5595_REG_TEMP_HYST, data->temp_hyst);
 335         up(&data->update_lock);
 336         return count;
 337 }
 338
 339 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
 340 static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
 341                 show_temp_over, set_temp_over);
 342 static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
 343                 show_temp_hyst, set_temp_hyst);
 344
 345 /* 2 Fans */
 346 static ssize_t show_fan(struct device *dev, char *buf, int nr)
 347 {
 348         struct sis5595_data *data = sis5595_update_device(dev);
 349         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
 350                 DIV_FROM_REG(data->fan_div[nr])) );
 351 }
 352
 353 static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
 354 {
 355         struct sis5595_data *data = sis5595_update_device(dev);
 356         return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan_min[nr],
 357                 DIV_FROM_REG(data->fan_div[nr])) );
 358 }
 359
 360 static ssize_t set_fan_min(struct device *dev, const char *buf,
 361                 size_t count, int nr)
 362 {
 363         struct i2c_client *client = to_i2c_client(dev);
 364         struct sis5595_data *data = i2c_get_clientdata(client);
 365         unsigned long val = simple_strtoul(buf, NULL, 10);
 366
 367         down(&data->update_lock);
 368         data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
 369         sis5595_write_value(client, SIS5595_REG_FAN_MIN(nr), data->fan_min[nr]);
 370         up(&data->update_lock);
 371         return count;
 372 }
 373
 374 static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
 375 {
 376         struct sis5595_data *data = sis5595_update_device(dev);
 377         return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]) );
 378 }
 379
 380 /* Note: we save and restore the fan minimum here, because its value is
 381    determined in part by the fan divisor.  This follows the principle of
 382    least suprise; the user doesn't expect the fan minimum to change just
 383    because the divisor changed. */
 384 static ssize_t set_fan_div(struct device *dev, const char *buf,
 385         size_t count, int nr)
 386 {
 387         struct i2c_client *client = to_i2c_client(dev);
 388         struct sis5595_data *data = i2c_get_clientdata(client);
 389         unsigned long min;
 390         unsigned long val = simple_strtoul(buf, NULL, 10);
 391         int reg;
 392
 393         down(&data->update_lock);
 394         min = FAN_FROM_REG(data->fan_min[nr],
 395                         DIV_FROM_REG(data->fan_div[nr]));
 396         reg = sis5595_read_value(client, SIS5595_REG_FANDIV);
 397
 398         switch (val) {
 399         case 1: data->fan_div[nr] = 0; break;
 400         case 2: data->fan_div[nr] = 1; break;
 401         case 4: data->fan_div[nr] = 2; break;
 402         case 8: data->fan_div[nr] = 3; break;
 403         default:
 404                 dev_err(&client->dev, "fan_div value %ld not "
 405                         "supported. Choose one of 1, 2, 4 or 8!\n", val);
 406                 up(&data->update_lock);
 407                 return -EINVAL;
 408         }
 409
 410         switch (nr) {
 411         case 0:
 412                 reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
 413                 break;
 414         case 1:
 415                 reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
 416                 break;
 417         }
 418         sis5595_write_value(client, SIS5595_REG_FANDIV, reg);
 419         data->fan_min[nr] =
 420                 FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
 421         sis5595_write_value(client, SIS5595_REG_FAN_MIN(nr), data->fan_min[nr]);
 422         up(&data->update_lock);
 423         return count;
 424 }
 425
 426 #define show_fan_offset(offset)                                         \
 427 static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
 428 {                                                                       \
 429         return show_fan(dev, buf, offset - 1);                  \
 430 }                                                                       \
 431 static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)   \
 432 {                                                                       \
 433         return show_fan_min(dev, buf, offset - 1);                      \
 434 }                                                                       \
 435 static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf)   \
 436 {                                                                       \
 437         return show_fan_div(dev, buf, offset - 1);                      \
 438 }                                                                       \
 439 static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr,               \
 440                 const char *buf, size_t count)                          \
 441 {                                                                       \
 442         return set_fan_min(dev, buf, count, offset - 1);                \
 443 }                                                                       \
 444 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset, NULL);\
 445 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,                \
 446                 show_fan_##offset##_min, set_fan_##offset##_min);
 447
 448 show_fan_offset(1);
 449 show_fan_offset(2);
 450
 451 static ssize_t set_fan_1_div(struct device *dev, struct device_attribute *attr, const char *buf,
 452                 size_t count)
 453 {
 454         return set_fan_div(dev, buf, count, 0) ;
 455 }
 456
 457 static ssize_t set_fan_2_div(struct device *dev, struct device_attribute *attr, const char *buf,
 458                 size_t count)
 459 {
 460         return set_fan_div(dev, buf, count, 1) ;
 461 }
 462 static DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
 463                 show_fan_1_div, set_fan_1_div);
 464 static DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
 465                 show_fan_2_div, set_fan_2_div);
 466
 467 /* Alarms */
 468 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
 469 {
 470         struct sis5595_data *data = sis5595_update_device(dev);
 471         return sprintf(buf, "%d\n", data->alarms);
 472 }
 473 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
 474
 475 /* This is called when the module is loaded */
 476 static int sis5595_detect(struct i2c_adapter *adapter)
 477 {
 478         int err = 0;
 479         int i;
 480         struct i2c_client *new_client;
 481         struct sis5595_data *data;
 482         char val;
 483         u16 a;
 484
 485         if (force_addr)
 486                 address = force_addr & ~(SIS5595_EXTENT - 1);
 487         /* Reserve the ISA region */
 488         if (!request_region(address, SIS5595_EXTENT, sis5595_driver.name)) {
 489                 err = -EBUSY;
 490                 goto exit;
 491         }
 492         if (force_addr) {
 493                 dev_warn(&adapter->dev, "forcing ISA address 0x%04X\n", address);
 494                 if (PCIBIOS_SUCCESSFUL !=
 495                     pci_write_config_word(s_bridge, SIS5595_BASE_REG, address))
 496                         goto exit_release;
 497                 if (PCIBIOS_SUCCESSFUL !=
 498                     pci_read_config_word(s_bridge, SIS5595_BASE_REG, &a))
 499                         goto exit_release;
 500                 if ((a & ~(SIS5595_EXTENT - 1)) != address)
 501                         /* doesn't work for some chips? */
 502                         goto exit_release;
 503         }
 504
 505         if (PCIBIOS_SUCCESSFUL !=
 506             pci_read_config_byte(s_bridge, SIS5595_ENABLE_REG, &val)) {
 507                 goto exit_release;
 508         }
 509         if ((val & 0x80) == 0) {
 510                 if (PCIBIOS_SUCCESSFUL !=
 511                     pci_write_config_byte(s_bridge, SIS5595_ENABLE_REG,
 512                                           val | 0x80))
 513                         goto exit_release;
 514                 if (PCIBIOS_SUCCESSFUL !=
 515                     pci_read_config_byte(s_bridge, SIS5595_ENABLE_REG, &val))
 516                         goto exit_release;
 517                 if ((val & 0x80) == 0)
 518                         /* doesn't work for some chips! */
 519                         goto exit_release;
 520         }
 521
 522         if (!(data = kmalloc(sizeof(struct sis5595_data), GFP_KERNEL))) {
 523                 err = -ENOMEM;
 524                 goto exit_release;
 525         }
 526         memset(data, 0, sizeof(struct sis5595_data));
 527
 528         new_client = &data->client;
 529         new_client->addr = address;
 530         init_MUTEX(&data->lock);
 531         i2c_set_clientdata(new_client, data);
 532         new_client->adapter = adapter;
 533         new_client->driver = &sis5595_driver;
 534         new_client->flags = 0;
 535
 536         /* Check revision and pin registers to determine whether 4 or 5 voltages */
 537         pci_read_config_byte(s_bridge, SIS5595_REVISION_REG, &(data->revision));
 538         /* 4 voltages, 1 temp */
 539         data->maxins = 3;
 540         if (data->revision >= REV2MIN) {
 541                 pci_read_config_byte(s_bridge, SIS5595_PIN_REG, &val);
 542                 if (!(val & 0x80))
 543                         /* 5 voltages, no temps */
 544                         data->maxins = 4;
 545         }
 546
 547         /* Fill in the remaining client fields and put it into the global list */
 548         strlcpy(new_client->name, "sis5595", I2C_NAME_SIZE);
 549
 550         data->valid = 0;
 551         init_MUTEX(&data->update_lock);
 552
 553         /* Tell the I2C layer a new client has arrived */
 554         if ((err = i2c_attach_client(new_client)))
 555                 goto exit_free;
 556
 557         /* Initialize the SIS5595 chip */
 558         sis5595_init_client(new_client);
 559
 560         /* A few vars need to be filled upon startup */
 561         for (i = 0; i < 2; i++) {
 562                 data->fan_min[i] = sis5595_read_value(new_client,
 563                                         SIS5595_REG_FAN_MIN(i));
 564         }
 565
 566         /* Register sysfs hooks */
 567         data->class_dev = hwmon_device_register(&new_client->dev);
 568         if (IS_ERR(data->class_dev)) {
 569                 err = PTR_ERR(data->class_dev);
 570                 goto exit_detach;
 571         }
 572
 573         device_create_file(&new_client->dev, &dev_attr_in0_input);
 574         device_create_file(&new_client->dev, &dev_attr_in0_min);
 575         device_create_file(&new_client->dev, &dev_attr_in0_max);
 576         device_create_file(&new_client->dev, &dev_attr_in1_input);
 577         device_create_file(&new_client->dev, &dev_attr_in1_min);
 578         device_create_file(&new_client->dev, &dev_attr_in1_max);
 579         device_create_file(&new_client->dev, &dev_attr_in2_input);
 580         device_create_file(&new_client->dev, &dev_attr_in2_min);
 581         device_create_file(&new_client->dev, &dev_attr_in2_max);
 582         device_create_file(&new_client->dev, &dev_attr_in3_input);
 583         device_create_file(&new_client->dev, &dev_attr_in3_min);
 584         device_create_file(&new_client->dev, &dev_attr_in3_max);
 585         if (data->maxins == 4) {
 586                 device_create_file(&new_client->dev, &dev_attr_in4_input);
 587                 device_create_file(&new_client->dev, &dev_attr_in4_min);
 588                 device_create_file(&new_client->dev, &dev_attr_in4_max);
 589         }
 590         device_create_file(&new_client->dev, &dev_attr_fan1_input);
 591         device_create_file(&new_client->dev, &dev_attr_fan1_min);
 592         device_create_file(&new_client->dev, &dev_attr_fan1_div);
 593         device_create_file(&new_client->dev, &dev_attr_fan2_input);
 594         device_create_file(&new_client->dev, &dev_attr_fan2_min);
 595         device_create_file(&new_client->dev, &dev_attr_fan2_div);
 596         device_create_file(&new_client->dev, &dev_attr_alarms);
 597         if (data->maxins == 3) {
 598                 device_create_file(&new_client->dev, &dev_attr_temp1_input);
 599                 device_create_file(&new_client->dev, &dev_attr_temp1_max);
 600                 device_create_file(&new_client->dev, &dev_attr_temp1_max_hyst);
 601         }
 602         return 0;
 603
 604 exit_detach:
 605         i2c_detach_client(new_client);
 606 exit_free:
 607         kfree(data);
 608 exit_release:
 609         release_region(address, SIS5595_EXTENT);
 610 exit:
 611         return err;
 612 }
 613
 614 static int sis5595_detach_client(struct i2c_client *client)
 615 {
 616         struct sis5595_data *data = i2c_get_clientdata(client);
 617         int err;
 618
 619         hwmon_device_unregister(data->class_dev);
 620
 621         if ((err = i2c_detach_client(client)))
 622                 return err;
 623
 624         release_region(client->addr, SIS5595_EXTENT);
 625
 626         kfree(data);
 627
 628         return 0;
 629 }
 630
 631
 632 /* ISA access must be locked explicitly. */
 633 static int sis5595_read_value(struct i2c_client *client, u8 reg)
 634 {
 635         int res;
 636
 637         struct sis5595_data *data = i2c_get_clientdata(client);
 638         down(&data->lock);
 639         outb_p(reg, client->addr + SIS5595_ADDR_REG_OFFSET);
 640         res = inb_p(client->addr + SIS5595_DATA_REG_OFFSET);
 641         up(&data->lock);
 642         return res;
 643 }
 644
 645 static int sis5595_write_value(struct i2c_client *client, u8 reg, u8 value)
 646 {
 647         struct sis5595_data *data = i2c_get_clientdata(client);
 648         down(&data->lock);
 649         outb_p(reg, client->addr + SIS5595_ADDR_REG_OFFSET);
 650         outb_p(value, client->addr + SIS5595_DATA_REG_OFFSET);
 651         up(&data->lock);
 652         return 0;
 653 }
 654
 655 /* Called when we have found a new SIS5595. */
 656 static void sis5595_init_client(struct i2c_client *client)
 657 {
 658         u8 config = sis5595_read_value(client, SIS5595_REG_CONFIG);
 659         if (!(config & 0x01))
 660                 sis5595_write_value(client, SIS5595_REG_CONFIG,
 661                                 (config & 0xf7) | 0x01);
 662 }
 663
 664 static struct sis5595_data *sis5595_update_device(struct device *dev)
 665 {
 666         struct i2c_client *client = to_i2c_client(dev);
 667         struct sis5595_data *data = i2c_get_clientdata(client);
 668         int i;
 669
 670         down(&data->update_lock);
 671
 672         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 673             || !data->valid) {
 674
 675                 for (i = 0; i <= data->maxins; i++) {
 676                         data->in[i] =
 677                             sis5595_read_value(client, SIS5595_REG_IN(i));
 678                         data->in_min[i] =
 679                             sis5595_read_value(client,
 680                                                SIS5595_REG_IN_MIN(i));
 681                         data->in_max[i] =
 682                             sis5595_read_value(client,
 683                                                SIS5595_REG_IN_MAX(i));
 684                 }
 685                 for (i = 0; i < 2; i++) {
 686                         data->fan[i] =
 687                             sis5595_read_value(client, SIS5595_REG_FAN(i));
 688                         data->fan_min[i] =
 689                             sis5595_read_value(client,
 690                                                SIS5595_REG_FAN_MIN(i));
 691                 }
 692                 if (data->maxins == 3) {
 693                         data->temp =
 694                             sis5595_read_value(client, SIS5595_REG_TEMP);
 695                         data->temp_over =
 696                             sis5595_read_value(client, SIS5595_REG_TEMP_OVER);
 697                         data->temp_hyst =
 698                             sis5595_read_value(client, SIS5595_REG_TEMP_HYST);
 699                 }
 700                 i = sis5595_read_value(client, SIS5595_REG_FANDIV);
 701                 data->fan_div[0] = (i >> 4) & 0x03;
 702                 data->fan_div[1] = i >> 6;
 703                 data->alarms =
 704                     sis5595_read_value(client, SIS5595_REG_ALARM1) |
 705                     (sis5595_read_value(client, SIS5595_REG_ALARM2) << 8);
 706                 data->last_updated = jiffies;
 707                 data->valid = 1;
 708         }
 709
 710         up(&data->update_lock);
 711
 712         return data;
 713 }
 714
 715 static struct pci_device_id sis5595_pci_ids[] = {
 716         { PCI_DEVICE(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_503) },
 717         { 0, }
 718 };
 719
 720 MODULE_DEVICE_TABLE(pci, sis5595_pci_ids);
 721
 722 static int blacklist[] __devinitdata = {
 723         PCI_DEVICE_ID_SI_540,
 724         PCI_DEVICE_ID_SI_550,
 725         PCI_DEVICE_ID_SI_630,
 726         PCI_DEVICE_ID_SI_645,
 727         PCI_DEVICE_ID_SI_730,
 728         PCI_DEVICE_ID_SI_735,
 729         PCI_DEVICE_ID_SI_5511, /* 5513 chip has the 0008 device but
 730                                   that ID shows up in other chips so we
 731                                   use the 5511 ID for recognition */
 732         PCI_DEVICE_ID_SI_5597,
 733         PCI_DEVICE_ID_SI_5598,
 734         0 };
 735
 736 static int __devinit sis5595_pci_probe(struct pci_dev *dev,
 737                                        const struct pci_device_id *id)
 738 {
 739         u16 val;
 740         int *i;
 741
 742         for (i = blacklist; *i != 0; i++) {
 743                 struct pci_dev *dev;
 744                 dev = pci_get_device(PCI_VENDOR_ID_SI, *i, NULL);
 745                 if (dev) {
 746                         dev_err(&dev->dev, "Looked for SIS5595 but found unsupported device %.4x\n", *i);
 747                         pci_dev_put(dev);
 748                         return -ENODEV;
 749                 }
 750         }
 751
 752         if (PCIBIOS_SUCCESSFUL !=
 753             pci_read_config_word(dev, SIS5595_BASE_REG, &val))
 754                 return -ENODEV;
 755
 756         address = val & ~(SIS5595_EXTENT - 1);
 757         if (address == 0 && force_addr == 0) {
 758                 dev_err(&dev->dev, "Base address not set - upgrade BIOS or use force_addr=0xaddr\n");
 759                 return -ENODEV;
 760         }
 761
 762         if (!address) {
 763                 dev_err(&dev->dev,"No SiS 5595 sensors found.\n");
 764                 return -ENODEV;
 765         }
 766
 767         s_bridge = pci_dev_get(dev);
 768         if (i2c_isa_add_driver(&sis5595_driver)) {
 769                 pci_dev_put(s_bridge);
 770                 s_bridge = NULL;
 771         }
 772
 773         /* Always return failure here.  This is to allow other drivers to bind
 774          * to this pci device.  We don't really want to have control over the
 775          * pci device, we only wanted to read as few register values from it.
 776          */
 777         return -ENODEV;
 778 }
 779
 780 static struct pci_driver sis5595_pci_driver = {
 781         .name            = "sis5595",
 782         .id_table        = sis5595_pci_ids,
 783         .probe           = sis5595_pci_probe,
 784 };
 785
 786 static int __init sm_sis5595_init(void)
 787 {
 788         return pci_register_driver(&sis5595_pci_driver);
 789 }
 790
 791 static void __exit sm_sis5595_exit(void)
 792 {
 793         pci_unregister_driver(&sis5595_pci_driver);
 794         if (s_bridge != NULL) {
 795                 i2c_isa_del_driver(&sis5595_driver);
 796                 pci_dev_put(s_bridge);
 797                 s_bridge = NULL;
 798         }
 799 }
 800
 801 MODULE_AUTHOR("Aurelien Jarno <aurelien@aurel32.net>");
 802 MODULE_DESCRIPTION("SiS 5595 Sensor device");
 803 MODULE_LICENSE("GPL");
 804
 805 module_init(sm_sis5595_init);
 806 module_exit(sm_sis5595_exit);