git.oblomov.eu Git - linux-2.6/blob - drivers/hwmon/via686a.c

   1 /*
   2     via686a.c - Part of lm_sensors, Linux kernel modules
   3                 for hardware monitoring
   4
   5     Copyright (c) 1998 - 2002  Frodo Looijaard <frodol@dds.nl>,
   6                         Kyösti Mälkki <kmalkki@cc.hut.fi>,
   7                         Mark Studebaker <mdsxyz123@yahoo.com>,
   8                         and Bob Dougherty <bobd@stanford.edu>
   9     (Some conversion-factor data were contributed by Jonathan Teh Soon Yew
  10     <j.teh@iname.com> and Alex van Kaam <darkside@chello.nl>.)
  11
  12     This program is free software; you can redistribute it and/or modify
  13     it under the terms of the GNU General Public License as published by
  14     the Free Software Foundation; either version 2 of the License, or
  15     (at your option) any later version.
  16
  17     This program is distributed in the hope that it will be useful,
  18     but WITHOUT ANY WARRANTY; without even the implied warranty of
  19     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20     GNU General Public License for more details.
  21
  22     You should have received a copy of the GNU General Public License
  23     along with this program; if not, write to the Free Software
  24     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  25 */
  26
  27 /*
  28     Supports the Via VT82C686A, VT82C686B south bridges.
  29     Reports all as a 686A.
  30     Warning - only supports a single device.
  31 */
  32
  33 #include <linux/module.h>
  34 #include <linux/slab.h>
  35 #include <linux/pci.h>
  36 #include <linux/jiffies.h>
  37 #include <linux/platform_device.h>
  38 #include <linux/hwmon.h>
  39 #include <linux/hwmon-sysfs.h>
  40 #include <linux/err.h>
  41 #include <linux/init.h>
  42 #include <linux/mutex.h>
  43 #include <linux/sysfs.h>
  44 #include <linux/acpi.h>
  45 #include <asm/io.h>
  46
  47
  48 /* If force_addr is set to anything different from 0, we forcibly enable
  49    the device at the given address. */
  50 static unsigned short force_addr;
  51 module_param(force_addr, ushort, 0);
  52 MODULE_PARM_DESC(force_addr,
  53                  "Initialize the base address of the sensors");
  54
  55 static struct platform_device *pdev;
  56
  57 /*
  58    The Via 686a southbridge has a LM78-like chip integrated on the same IC.
  59    This driver is a customized copy of lm78.c
  60 */
  61
  62 /* Many VIA686A constants specified below */
  63
  64 /* Length of ISA address segment */
  65 #define VIA686A_EXTENT          0x80
  66 #define VIA686A_BASE_REG        0x70
  67 #define VIA686A_ENABLE_REG      0x74
  68
  69 /* The VIA686A registers */
  70 /* ins numbered 0-4 */
  71 #define VIA686A_REG_IN_MAX(nr)  (0x2b + ((nr) * 2))
  72 #define VIA686A_REG_IN_MIN(nr)  (0x2c + ((nr) * 2))
  73 #define VIA686A_REG_IN(nr)      (0x22 + (nr))
  74
  75 /* fans numbered 1-2 */
  76 #define VIA686A_REG_FAN_MIN(nr) (0x3a + (nr))
  77 #define VIA686A_REG_FAN(nr)     (0x28 + (nr))
  78
  79 /* temps numbered 1-3 */
  80 static const u8 VIA686A_REG_TEMP[]      = { 0x20, 0x21, 0x1f };
  81 static const u8 VIA686A_REG_TEMP_OVER[] = { 0x39, 0x3d, 0x1d };
  82 static const u8 VIA686A_REG_TEMP_HYST[] = { 0x3a, 0x3e, 0x1e };
  83 /* bits 7-6 */
  84 #define VIA686A_REG_TEMP_LOW1   0x4b
  85 /* 2 = bits 5-4, 3 = bits 7-6 */
  86 #define VIA686A_REG_TEMP_LOW23  0x49
  87
  88 #define VIA686A_REG_ALARM1      0x41
  89 #define VIA686A_REG_ALARM2      0x42
  90 #define VIA686A_REG_FANDIV      0x47
  91 #define VIA686A_REG_CONFIG      0x40
  92 /* The following register sets temp interrupt mode (bits 1-0 for temp1,
  93  3-2 for temp2, 5-4 for temp3).  Modes are:
  94     00 interrupt stays as long as value is out-of-range
  95     01 interrupt is cleared once register is read (default)
  96     10 comparator mode- like 00, but ignores hysteresis
  97     11 same as 00 */
  98 #define VIA686A_REG_TEMP_MODE           0x4b
  99 /* We'll just assume that you want to set all 3 simultaneously: */
 100 #define VIA686A_TEMP_MODE_MASK          0x3F
 101 #define VIA686A_TEMP_MODE_CONTINUOUS    0x00
 102
 103 /* Conversions. Limit checking is only done on the TO_REG
 104    variants.
 105
 106 ********* VOLTAGE CONVERSIONS (Bob Dougherty) ********
 107  From HWMon.cpp (Copyright 1998-2000 Jonathan Teh Soon Yew):
 108  voltagefactor[0]=1.25/2628; (2628/1.25=2102.4)   // Vccp
 109  voltagefactor[1]=1.25/2628; (2628/1.25=2102.4)   // +2.5V
 110  voltagefactor[2]=1.67/2628; (2628/1.67=1573.7)   // +3.3V
 111  voltagefactor[3]=2.6/2628;  (2628/2.60=1010.8)   // +5V
 112  voltagefactor[4]=6.3/2628;  (2628/6.30=417.14)   // +12V
 113  in[i]=(data[i+2]*25.0+133)*voltagefactor[i];
 114  That is:
 115  volts = (25*regVal+133)*factor
 116  regVal = (volts/factor-133)/25
 117  (These conversions were contributed by Jonathan Teh Soon Yew
 118  <j.teh@iname.com>) */
 119 static inline u8 IN_TO_REG(long val, int inNum)
 120 {
 121         /* To avoid floating point, we multiply constants by 10 (100 for +12V).
 122            Rounding is done (120500 is actually 133000 - 12500).
 123            Remember that val is expressed in 0.001V/bit, which is why we divide
 124            by an additional 10000 (100000 for +12V): 1000 for val and 10 (100)
 125            for the constants. */
 126         if (inNum <= 1)
 127                 return (u8)
 128                     SENSORS_LIMIT((val * 21024 - 1205000) / 250000, 0, 255);
 129         else if (inNum == 2)
 130                 return (u8)
 131                     SENSORS_LIMIT((val * 15737 - 1205000) / 250000, 0, 255);
 132         else if (inNum == 3)
 133                 return (u8)
 134                     SENSORS_LIMIT((val * 10108 - 1205000) / 250000, 0, 255);
 135         else
 136                 return (u8)
 137                     SENSORS_LIMIT((val * 41714 - 12050000) / 2500000, 0, 255);
 138 }
 139
 140 static inline long IN_FROM_REG(u8 val, int inNum)
 141 {
 142         /* To avoid floating point, we multiply constants by 10 (100 for +12V).
 143            We also multiply them by 1000 because we want 0.001V/bit for the
 144            output value. Rounding is done. */
 145         if (inNum <= 1)
 146                 return (long) ((250000 * val + 1330000 + 21024 / 2) / 21024);
 147         else if (inNum == 2)
 148                 return (long) ((250000 * val + 1330000 + 15737 / 2) / 15737);
 149         else if (inNum == 3)
 150                 return (long) ((250000 * val + 1330000 + 10108 / 2) / 10108);
 151         else
 152                 return (long) ((2500000 * val + 13300000 + 41714 / 2) / 41714);
 153 }
 154
 155 /********* FAN RPM CONVERSIONS ********/
 156 /* Higher register values = slower fans (the fan's strobe gates a counter).
 157  But this chip saturates back at 0, not at 255 like all the other chips.
 158  So, 0 means 0 RPM */
 159 static inline u8 FAN_TO_REG(long rpm, int div)
 160 {
 161         if (rpm == 0)
 162                 return 0;
 163         rpm = SENSORS_LIMIT(rpm, 1, 1000000);
 164         return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 255);
 165 }
 166
 167 #define FAN_FROM_REG(val,div) ((val)==0?0:(val)==255?0:1350000/((val)*(div)))
 168
 169 /******** TEMP CONVERSIONS (Bob Dougherty) *********/
 170 /* linear fits from HWMon.cpp (Copyright 1998-2000 Jonathan Teh Soon Yew)
 171       if(temp<169)
 172               return double(temp)*0.427-32.08;
 173       else if(temp>=169 && temp<=202)
 174               return double(temp)*0.582-58.16;
 175       else
 176               return double(temp)*0.924-127.33;
 177
 178  A fifth-order polynomial fits the unofficial data (provided by Alex van
 179  Kaam <darkside@chello.nl>) a bit better.  It also give more reasonable
 180  numbers on my machine (ie. they agree with what my BIOS tells me).
 181  Here's the fifth-order fit to the 8-bit data:
 182  temp = 1.625093e-10*val^5 - 1.001632e-07*val^4 + 2.457653e-05*val^3 -
 183         2.967619e-03*val^2 + 2.175144e-01*val - 7.090067e+0.
 184
 185  (2000-10-25- RFD: thanks to Uwe Andersen <uandersen@mayah.com> for
 186  finding my typos in this formula!)
 187
 188  Alas, none of the elegant function-fit solutions will work because we
 189  aren't allowed to use floating point in the kernel and doing it with
 190  integers doesn't provide enough precision.  So we'll do boring old
 191  look-up table stuff.  The unofficial data (see below) have effectively
 192  7-bit resolution (they are rounded to the nearest degree).  I'm assuming
 193  that the transfer function of the device is monotonic and smooth, so a
 194  smooth function fit to the data will allow us to get better precision.
 195  I used the 5th-order poly fit described above and solved for
 196  VIA register values 0-255.  I *10 before rounding, so we get tenth-degree
 197  precision.  (I could have done all 1024 values for our 10-bit readings,
 198  but the function is very linear in the useful range (0-80 deg C), so
 199  we'll just use linear interpolation for 10-bit readings.)  So, tempLUT
 200  is the temp at via register values 0-255: */
 201 static const s16 tempLUT[] =
 202 { -709, -688, -667, -646, -627, -607, -589, -570, -553, -536, -519,
 203         -503, -487, -471, -456, -442, -428, -414, -400, -387, -375,
 204         -362, -350, -339, -327, -316, -305, -295, -285, -275, -265,
 205         -255, -246, -237, -229, -220, -212, -204, -196, -188, -180,
 206         -173, -166, -159, -152, -145, -139, -132, -126, -120, -114,
 207         -108, -102, -96, -91, -85, -80, -74, -69, -64, -59, -54, -49,
 208         -44, -39, -34, -29, -25, -20, -15, -11, -6, -2, 3, 7, 12, 16,
 209         20, 25, 29, 33, 37, 42, 46, 50, 54, 59, 63, 67, 71, 75, 79, 84,
 210         88, 92, 96, 100, 104, 109, 113, 117, 121, 125, 130, 134, 138,
 211         142, 146, 151, 155, 159, 163, 168, 172, 176, 181, 185, 189,
 212         193, 198, 202, 206, 211, 215, 219, 224, 228, 232, 237, 241,
 213         245, 250, 254, 259, 263, 267, 272, 276, 281, 285, 290, 294,
 214         299, 303, 307, 312, 316, 321, 325, 330, 334, 339, 344, 348,
 215         353, 357, 362, 366, 371, 376, 380, 385, 390, 395, 399, 404,
 216         409, 414, 419, 423, 428, 433, 438, 443, 449, 454, 459, 464,
 217         469, 475, 480, 486, 491, 497, 502, 508, 514, 520, 526, 532,
 218         538, 544, 551, 557, 564, 571, 578, 584, 592, 599, 606, 614,
 219         621, 629, 637, 645, 654, 662, 671, 680, 689, 698, 708, 718,
 220         728, 738, 749, 759, 770, 782, 793, 805, 818, 830, 843, 856,
 221         870, 883, 898, 912, 927, 943, 958, 975, 991, 1008, 1026, 1044,
 222         1062, 1081, 1101, 1121, 1141, 1162, 1184, 1206, 1229, 1252,
 223         1276, 1301, 1326, 1352, 1378, 1406, 1434, 1462
 224 };
 225
 226 /* the original LUT values from Alex van Kaam <darkside@chello.nl>
 227    (for via register values 12-240):
 228 {-50,-49,-47,-45,-43,-41,-39,-38,-37,-35,-34,-33,-32,-31,
 229 -30,-29,-28,-27,-26,-25,-24,-24,-23,-22,-21,-20,-20,-19,-18,-17,-17,-16,-15,
 230 -15,-14,-14,-13,-12,-12,-11,-11,-10,-9,-9,-8,-8,-7,-7,-6,-6,-5,-5,-4,-4,-3,
 231 -3,-2,-2,-1,-1,0,0,1,1,1,3,3,3,4,4,4,5,5,5,6,6,7,7,8,8,9,9,9,10,10,11,11,12,
 232 12,12,13,13,13,14,14,15,15,16,16,16,17,17,18,18,19,19,20,20,21,21,21,22,22,
 233 22,23,23,24,24,25,25,26,26,26,27,27,27,28,28,29,29,30,30,30,31,31,32,32,33,
 234 33,34,34,35,35,35,36,36,37,37,38,38,39,39,40,40,41,41,42,42,43,43,44,44,45,
 235 45,46,46,47,48,48,49,49,50,51,51,52,52,53,53,54,55,55,56,57,57,58,59,59,60,
 236 61,62,62,63,64,65,66,66,67,68,69,70,71,72,73,74,75,76,77,78,79,80,81,83,84,
 237 85,86,88,89,91,92,94,96,97,99,101,103,105,107,109,110};
 238
 239
 240  Here's the reverse LUT.  I got it by doing a 6-th order poly fit (needed
 241  an extra term for a good fit to these inverse data!) and then
 242  solving for each temp value from -50 to 110 (the useable range for
 243  this chip).  Here's the fit:
 244  viaRegVal = -1.160370e-10*val^6 +3.193693e-08*val^5 - 1.464447e-06*val^4
 245  - 2.525453e-04*val^3 + 1.424593e-02*val^2 + 2.148941e+00*val +7.275808e+01)
 246  Note that n=161: */
 247 static const u8 viaLUT[] =
 248 { 12, 12, 13, 14, 14, 15, 16, 16, 17, 18, 18, 19, 20, 20, 21, 22, 23,
 249         23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 35, 36, 37, 39, 40,
 250         41, 43, 45, 46, 48, 49, 51, 53, 55, 57, 59, 60, 62, 64, 66,
 251         69, 71, 73, 75, 77, 79, 82, 84, 86, 88, 91, 93, 95, 98, 100,
 252         103, 105, 107, 110, 112, 115, 117, 119, 122, 124, 126, 129,
 253         131, 134, 136, 138, 140, 143, 145, 147, 150, 152, 154, 156,
 254         158, 160, 162, 164, 166, 168, 170, 172, 174, 176, 178, 180,
 255         182, 183, 185, 187, 188, 190, 192, 193, 195, 196, 198, 199,
 256         200, 202, 203, 205, 206, 207, 208, 209, 210, 211, 212, 213,
 257         214, 215, 216, 217, 218, 219, 220, 221, 222, 222, 223, 224,
 258         225, 226, 226, 227, 228, 228, 229, 230, 230, 231, 232, 232,
 259         233, 233, 234, 235, 235, 236, 236, 237, 237, 238, 238, 239,
 260         239, 240
 261 };
 262
 263 /* Converting temps to (8-bit) hyst and over registers
 264    No interpolation here.
 265    The +50 is because the temps start at -50 */
 266 static inline u8 TEMP_TO_REG(long val)
 267 {
 268         return viaLUT[val <= -50000 ? 0 : val >= 110000 ? 160 :
 269                       (val < 0 ? val - 500 : val + 500) / 1000 + 50];
 270 }
 271
 272 /* for 8-bit temperature hyst and over registers */
 273 #define TEMP_FROM_REG(val)      ((long)tempLUT[val] * 100)
 274
 275 /* for 10-bit temperature readings */
 276 static inline long TEMP_FROM_REG10(u16 val)
 277 {
 278         u16 eightBits = val >> 2;
 279         u16 twoBits = val & 3;
 280
 281         /* no interpolation for these */
 282         if (twoBits == 0 || eightBits == 255)
 283                 return TEMP_FROM_REG(eightBits);
 284
 285         /* do some linear interpolation */
 286         return (tempLUT[eightBits] * (4 - twoBits) +
 287                 tempLUT[eightBits + 1] * twoBits) * 25;
 288 }
 289
 290 #define DIV_FROM_REG(val) (1 << (val))
 291 #define DIV_TO_REG(val) ((val)==8?3:(val)==4?2:(val)==1?0:1)
 292
 293 /* For each registered chip, we need to keep some data in memory.
 294    The structure is dynamically allocated. */
 295 struct via686a_data {
 296         unsigned short addr;
 297         const char *name;
 298         struct device *hwmon_dev;
 299         struct mutex update_lock;
 300         char valid;             /* !=0 if following fields are valid */
 301         unsigned long last_updated;     /* In jiffies */
 302
 303         u8 in[5];               /* Register value */
 304         u8 in_max[5];           /* Register value */
 305         u8 in_min[5];           /* Register value */
 306         u8 fan[2];              /* Register value */
 307         u8 fan_min[2];          /* Register value */
 308         u16 temp[3];            /* Register value 10 bit */
 309         u8 temp_over[3];        /* Register value */
 310         u8 temp_hyst[3];        /* Register value */
 311         u8 fan_div[2];          /* Register encoding, shifted right */
 312         u16 alarms;             /* Register encoding, combined */
 313 };
 314
 315 static struct pci_dev *s_bridge;        /* pointer to the (only) via686a */
 316
 317 static int via686a_probe(struct platform_device *pdev);
 318 static int __devexit via686a_remove(struct platform_device *pdev);
 319
 320 static inline int via686a_read_value(struct via686a_data *data, u8 reg)
 321 {
 322         return inb_p(data->addr + reg);
 323 }
 324
 325 static inline void via686a_write_value(struct via686a_data *data, u8 reg,
 326                                        u8 value)
 327 {
 328         outb_p(value, data->addr + reg);
 329 }
 330
 331 static struct via686a_data *via686a_update_device(struct device *dev);
 332 static void via686a_init_device(struct via686a_data *data);
 333
 334 /* following are the sysfs callback functions */
 335
 336 /* 7 voltage sensors */
 337 static ssize_t show_in(struct device *dev, struct device_attribute *da,
 338                 char *buf) {
 339         struct via686a_data *data = via686a_update_device(dev);
 340         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 341         int nr = attr->index;
 342         return sprintf(buf, "%ld\n", IN_FROM_REG(data->in[nr], nr));
 343 }
 344
 345 static ssize_t show_in_min(struct device *dev, struct device_attribute *da,
 346                 char *buf) {
 347         struct via686a_data *data = via686a_update_device(dev);
 348         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 349         int nr = attr->index;
 350         return sprintf(buf, "%ld\n", IN_FROM_REG(data->in_min[nr], nr));
 351 }
 352
 353 static ssize_t show_in_max(struct device *dev, struct device_attribute *da,
 354                 char *buf) {
 355         struct via686a_data *data = via686a_update_device(dev);
 356         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 357         int nr = attr->index;
 358         return sprintf(buf, "%ld\n", IN_FROM_REG(data->in_max[nr], nr));
 359 }
 360
 361 static ssize_t set_in_min(struct device *dev, struct device_attribute *da,
 362                 const char *buf, size_t count) {
 363         struct via686a_data *data = dev_get_drvdata(dev);
 364         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 365         int nr = attr->index;
 366         unsigned long val = simple_strtoul(buf, NULL, 10);
 367
 368         mutex_lock(&data->update_lock);
 369         data->in_min[nr] = IN_TO_REG(val, nr);
 370         via686a_write_value(data, VIA686A_REG_IN_MIN(nr),
 371                         data->in_min[nr]);
 372         mutex_unlock(&data->update_lock);
 373         return count;
 374 }
 375 static ssize_t set_in_max(struct device *dev, struct device_attribute *da,
 376                 const char *buf, size_t count) {
 377         struct via686a_data *data = dev_get_drvdata(dev);
 378         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 379         int nr = attr->index;
 380         unsigned long val = simple_strtoul(buf, NULL, 10);
 381
 382         mutex_lock(&data->update_lock);
 383         data->in_max[nr] = IN_TO_REG(val, nr);
 384         via686a_write_value(data, VIA686A_REG_IN_MAX(nr),
 385                         data->in_max[nr]);
 386         mutex_unlock(&data->update_lock);
 387         return count;
 388 }
 389 #define show_in_offset(offset)                                  \
 390 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO,          \
 391                 show_in, NULL, offset);                         \
 392 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR,  \
 393                 show_in_min, set_in_min, offset);               \
 394 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR,  \
 395                 show_in_max, set_in_max, offset);
 396
 397 show_in_offset(0);
 398 show_in_offset(1);
 399 show_in_offset(2);
 400 show_in_offset(3);
 401 show_in_offset(4);
 402
 403 /* 3 temperatures */
 404 static ssize_t show_temp(struct device *dev, struct device_attribute *da,
 405                 char *buf) {
 406         struct via686a_data *data = via686a_update_device(dev);
 407         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 408         int nr = attr->index;
 409         return sprintf(buf, "%ld\n", TEMP_FROM_REG10(data->temp[nr]));
 410 }
 411 static ssize_t show_temp_over(struct device *dev, struct device_attribute *da,
 412                 char *buf) {
 413         struct via686a_data *data = via686a_update_device(dev);
 414         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 415         int nr = attr->index;
 416         return sprintf(buf, "%ld\n", TEMP_FROM_REG(data->temp_over[nr]));
 417 }
 418 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *da,
 419                 char *buf) {
 420         struct via686a_data *data = via686a_update_device(dev);
 421         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 422         int nr = attr->index;
 423         return sprintf(buf, "%ld\n", TEMP_FROM_REG(data->temp_hyst[nr]));
 424 }
 425 static ssize_t set_temp_over(struct device *dev, struct device_attribute *da,
 426                 const char *buf, size_t count) {
 427         struct via686a_data *data = dev_get_drvdata(dev);
 428         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 429         int nr = attr->index;
 430         int val = simple_strtol(buf, NULL, 10);
 431
 432         mutex_lock(&data->update_lock);
 433         data->temp_over[nr] = TEMP_TO_REG(val);
 434         via686a_write_value(data, VIA686A_REG_TEMP_OVER[nr],
 435                             data->temp_over[nr]);
 436         mutex_unlock(&data->update_lock);
 437         return count;
 438 }
 439 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *da,
 440                 const char *buf, size_t count) {
 441         struct via686a_data *data = dev_get_drvdata(dev);
 442         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 443         int nr = attr->index;
 444         int val = simple_strtol(buf, NULL, 10);
 445
 446         mutex_lock(&data->update_lock);
 447         data->temp_hyst[nr] = TEMP_TO_REG(val);
 448         via686a_write_value(data, VIA686A_REG_TEMP_HYST[nr],
 449                             data->temp_hyst[nr]);
 450         mutex_unlock(&data->update_lock);
 451         return count;
 452 }
 453 #define show_temp_offset(offset)                                        \
 454 static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO,                \
 455                 show_temp, NULL, offset - 1);                           \
 456 static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,        \
 457                 show_temp_over, set_temp_over, offset - 1);             \
 458 static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR,   \
 459                 show_temp_hyst, set_temp_hyst, offset - 1);
 460
 461 show_temp_offset(1);
 462 show_temp_offset(2);
 463 show_temp_offset(3);
 464
 465 /* 2 Fans */
 466 static ssize_t show_fan(struct device *dev, struct device_attribute *da,
 467                 char *buf) {
 468         struct via686a_data *data = via686a_update_device(dev);
 469         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 470         int nr = attr->index;
 471         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
 472                                 DIV_FROM_REG(data->fan_div[nr])) );
 473 }
 474 static ssize_t show_fan_min(struct device *dev, struct device_attribute *da,
 475                 char *buf) {
 476         struct via686a_data *data = via686a_update_device(dev);
 477         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 478         int nr = attr->index;
 479         return sprintf(buf, "%d\n",
 480                 FAN_FROM_REG(data->fan_min[nr], DIV_FROM_REG(data->fan_div[nr])) );
 481 }
 482 static ssize_t show_fan_div(struct device *dev, struct device_attribute *da,
 483                 char *buf) {
 484         struct via686a_data *data = via686a_update_device(dev);
 485         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 486         int nr = attr->index;
 487         return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]) );
 488 }
 489 static ssize_t set_fan_min(struct device *dev, struct device_attribute *da,
 490                 const char *buf, size_t count) {
 491         struct via686a_data *data = dev_get_drvdata(dev);
 492         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 493         int nr = attr->index;
 494         int val = simple_strtol(buf, NULL, 10);
 495
 496         mutex_lock(&data->update_lock);
 497         data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
 498         via686a_write_value(data, VIA686A_REG_FAN_MIN(nr+1), data->fan_min[nr]);
 499         mutex_unlock(&data->update_lock);
 500         return count;
 501 }
 502 static ssize_t set_fan_div(struct device *dev, struct device_attribute *da,
 503                 const char *buf, size_t count) {
 504         struct via686a_data *data = dev_get_drvdata(dev);
 505         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
 506         int nr = attr->index;
 507         int val = simple_strtol(buf, NULL, 10);
 508         int old;
 509
 510         mutex_lock(&data->update_lock);
 511         old = via686a_read_value(data, VIA686A_REG_FANDIV);
 512         data->fan_div[nr] = DIV_TO_REG(val);
 513         old = (old & 0x0f) | (data->fan_div[1] << 6) | (data->fan_div[0] << 4);
 514         via686a_write_value(data, VIA686A_REG_FANDIV, old);
 515         mutex_unlock(&data->update_lock);
 516         return count;
 517 }
 518
 519 #define show_fan_offset(offset)                                         \
 520 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO,                 \
 521                 show_fan, NULL, offset - 1);                            \
 522 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,         \
 523                 show_fan_min, set_fan_min, offset - 1);                 \
 524 static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,         \
 525                 show_fan_div, set_fan_div, offset - 1);
 526
 527 show_fan_offset(1);
 528 show_fan_offset(2);
 529
 530 /* Alarms */
 531 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) {
 532         struct via686a_data *data = via686a_update_device(dev);
 533         return sprintf(buf, "%u\n", data->alarms);
 534 }
 535 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
 536
 537 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
 538                           char *buf)
 539 {
 540         int bitnr = to_sensor_dev_attr(attr)->index;
 541         struct via686a_data *data = via686a_update_device(dev);
 542         return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
 543 }
 544 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
 545 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
 546 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
 547 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
 548 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
 549 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
 550 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 11);
 551 static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 15);
 552 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
 553 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
 554
 555 static ssize_t show_name(struct device *dev, struct device_attribute
 556                          *devattr, char *buf)
 557 {
 558         struct via686a_data *data = dev_get_drvdata(dev);
 559         return sprintf(buf, "%s\n", data->name);
 560 }
 561 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
 562
 563 static struct attribute *via686a_attributes[] = {
 564         &sensor_dev_attr_in0_input.dev_attr.attr,
 565         &sensor_dev_attr_in1_input.dev_attr.attr,
 566         &sensor_dev_attr_in2_input.dev_attr.attr,
 567         &sensor_dev_attr_in3_input.dev_attr.attr,
 568         &sensor_dev_attr_in4_input.dev_attr.attr,
 569         &sensor_dev_attr_in0_min.dev_attr.attr,
 570         &sensor_dev_attr_in1_min.dev_attr.attr,
 571         &sensor_dev_attr_in2_min.dev_attr.attr,
 572         &sensor_dev_attr_in3_min.dev_attr.attr,
 573         &sensor_dev_attr_in4_min.dev_attr.attr,
 574         &sensor_dev_attr_in0_max.dev_attr.attr,
 575         &sensor_dev_attr_in1_max.dev_attr.attr,
 576         &sensor_dev_attr_in2_max.dev_attr.attr,
 577         &sensor_dev_attr_in3_max.dev_attr.attr,
 578         &sensor_dev_attr_in4_max.dev_attr.attr,
 579         &sensor_dev_attr_in0_alarm.dev_attr.attr,
 580         &sensor_dev_attr_in1_alarm.dev_attr.attr,
 581         &sensor_dev_attr_in2_alarm.dev_attr.attr,
 582         &sensor_dev_attr_in3_alarm.dev_attr.attr,
 583         &sensor_dev_attr_in4_alarm.dev_attr.attr,
 584
 585         &sensor_dev_attr_temp1_input.dev_attr.attr,
 586         &sensor_dev_attr_temp2_input.dev_attr.attr,
 587         &sensor_dev_attr_temp3_input.dev_attr.attr,
 588         &sensor_dev_attr_temp1_max.dev_attr.attr,
 589         &sensor_dev_attr_temp2_max.dev_attr.attr,
 590         &sensor_dev_attr_temp3_max.dev_attr.attr,
 591         &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
 592         &sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
 593         &sensor_dev_attr_temp3_max_hyst.dev_attr.attr,
 594         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
 595         &sensor_dev_attr_temp2_alarm.dev_attr.attr,
 596         &sensor_dev_attr_temp3_alarm.dev_attr.attr,
 597
 598         &sensor_dev_attr_fan1_input.dev_attr.attr,
 599         &sensor_dev_attr_fan2_input.dev_attr.attr,
 600         &sensor_dev_attr_fan1_min.dev_attr.attr,
 601         &sensor_dev_attr_fan2_min.dev_attr.attr,
 602         &sensor_dev_attr_fan1_div.dev_attr.attr,
 603         &sensor_dev_attr_fan2_div.dev_attr.attr,
 604         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
 605         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
 606
 607         &dev_attr_alarms.attr,
 608         &dev_attr_name.attr,
 609         NULL
 610 };
 611
 612 static const struct attribute_group via686a_group = {
 613         .attrs = via686a_attributes,
 614 };
 615
 616 static struct platform_driver via686a_driver = {
 617         .driver = {
 618                 .owner  = THIS_MODULE,
 619                 .name   = "via686a",
 620         },
 621         .probe          = via686a_probe,
 622         .remove         = __devexit_p(via686a_remove),
 623 };
 624
 625
 626 /* This is called when the module is loaded */
 627 static int __devinit via686a_probe(struct platform_device *pdev)
 628 {
 629         struct via686a_data *data;
 630         struct resource *res;
 631         int err;
 632
 633         /* Reserve the ISA region */
 634         res = platform_get_resource(pdev, IORESOURCE_IO, 0);
 635         if (!request_region(res->start, VIA686A_EXTENT,
 636                             via686a_driver.driver.name)) {
 637                 dev_err(&pdev->dev, "Region 0x%lx-0x%lx already in use!\n",
 638                         (unsigned long)res->start, (unsigned long)res->end);
 639                 return -ENODEV;
 640         }
 641
 642         if (!(data = kzalloc(sizeof(struct via686a_data), GFP_KERNEL))) {
 643                 err = -ENOMEM;
 644                 goto exit_release;
 645         }
 646
 647         platform_set_drvdata(pdev, data);
 648         data->addr = res->start;
 649         data->name = "via686a";
 650         mutex_init(&data->update_lock);
 651
 652         /* Initialize the VIA686A chip */
 653         via686a_init_device(data);
 654
 655         /* Register sysfs hooks */
 656         if ((err = sysfs_create_group(&pdev->dev.kobj, &via686a_group)))
 657                 goto exit_free;
 658
 659         data->hwmon_dev = hwmon_device_register(&pdev->dev);
 660         if (IS_ERR(data->hwmon_dev)) {
 661                 err = PTR_ERR(data->hwmon_dev);
 662                 goto exit_remove_files;
 663         }
 664
 665         return 0;
 666
 667 exit_remove_files:
 668         sysfs_remove_group(&pdev->dev.kobj, &via686a_group);
 669 exit_free:
 670         kfree(data);
 671 exit_release:
 672         release_region(res->start, VIA686A_EXTENT);
 673         return err;
 674 }
 675
 676 static int __devexit via686a_remove(struct platform_device *pdev)
 677 {
 678         struct via686a_data *data = platform_get_drvdata(pdev);
 679
 680         hwmon_device_unregister(data->hwmon_dev);
 681         sysfs_remove_group(&pdev->dev.kobj, &via686a_group);
 682
 683         release_region(data->addr, VIA686A_EXTENT);
 684         platform_set_drvdata(pdev, NULL);
 685         kfree(data);
 686
 687         return 0;
 688 }
 689
 690 static void __devinit via686a_init_device(struct via686a_data *data)
 691 {
 692         u8 reg;
 693
 694         /* Start monitoring */
 695         reg = via686a_read_value(data, VIA686A_REG_CONFIG);
 696         via686a_write_value(data, VIA686A_REG_CONFIG, (reg | 0x01) & 0x7F);
 697
 698         /* Configure temp interrupt mode for continuous-interrupt operation */
 699         reg = via686a_read_value(data, VIA686A_REG_TEMP_MODE);
 700         via686a_write_value(data, VIA686A_REG_TEMP_MODE,
 701                             (reg & ~VIA686A_TEMP_MODE_MASK)
 702                             | VIA686A_TEMP_MODE_CONTINUOUS);
 703 }
 704
 705 static struct via686a_data *via686a_update_device(struct device *dev)
 706 {
 707         struct via686a_data *data = dev_get_drvdata(dev);
 708         int i;
 709
 710         mutex_lock(&data->update_lock);
 711
 712         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 713             || !data->valid) {
 714                 for (i = 0; i <= 4; i++) {
 715                         data->in[i] =
 716                             via686a_read_value(data, VIA686A_REG_IN(i));
 717                         data->in_min[i] = via686a_read_value(data,
 718                                                              VIA686A_REG_IN_MIN
 719                                                              (i));
 720                         data->in_max[i] =
 721                             via686a_read_value(data, VIA686A_REG_IN_MAX(i));
 722                 }
 723                 for (i = 1; i <= 2; i++) {
 724                         data->fan[i - 1] =
 725                             via686a_read_value(data, VIA686A_REG_FAN(i));
 726                         data->fan_min[i - 1] = via686a_read_value(data,
 727                                                      VIA686A_REG_FAN_MIN(i));
 728                 }
 729                 for (i = 0; i <= 2; i++) {
 730                         data->temp[i] = via686a_read_value(data,
 731                                                  VIA686A_REG_TEMP[i]) << 2;
 732                         data->temp_over[i] =
 733                             via686a_read_value(data,
 734                                                VIA686A_REG_TEMP_OVER[i]);
 735                         data->temp_hyst[i] =
 736                             via686a_read_value(data,
 737                                                VIA686A_REG_TEMP_HYST[i]);
 738                 }
 739                 /* add in lower 2 bits
 740                    temp1 uses bits 7-6 of VIA686A_REG_TEMP_LOW1
 741                    temp2 uses bits 5-4 of VIA686A_REG_TEMP_LOW23
 742                    temp3 uses bits 7-6 of VIA686A_REG_TEMP_LOW23
 743                  */
 744                 data->temp[0] |= (via686a_read_value(data,
 745                                                      VIA686A_REG_TEMP_LOW1)
 746                                   & 0xc0) >> 6;
 747                 data->temp[1] |=
 748                     (via686a_read_value(data, VIA686A_REG_TEMP_LOW23) &
 749                      0x30) >> 4;
 750                 data->temp[2] |=
 751                     (via686a_read_value(data, VIA686A_REG_TEMP_LOW23) &
 752                      0xc0) >> 6;
 753
 754                 i = via686a_read_value(data, VIA686A_REG_FANDIV);
 755                 data->fan_div[0] = (i >> 4) & 0x03;
 756                 data->fan_div[1] = i >> 6;
 757                 data->alarms =
 758                     via686a_read_value(data,
 759                                        VIA686A_REG_ALARM1) |
 760                     (via686a_read_value(data, VIA686A_REG_ALARM2) << 8);
 761                 data->last_updated = jiffies;
 762                 data->valid = 1;
 763         }
 764
 765         mutex_unlock(&data->update_lock);
 766
 767         return data;
 768 }
 769
 770 static struct pci_device_id via686a_pci_ids[] = {
 771         { PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686_4) },
 772         { 0, }
 773 };
 774
 775 MODULE_DEVICE_TABLE(pci, via686a_pci_ids);
 776
 777 static int __devinit via686a_device_add(unsigned short address)
 778 {
 779         struct resource res = {
 780                 .start  = address,
 781                 .end    = address + VIA686A_EXTENT - 1,
 782                 .name   = "via686a",
 783                 .flags  = IORESOURCE_IO,
 784         };
 785         int err;
 786
 787         err = acpi_check_resource_conflict(&res);
 788         if (err)
 789                 goto exit;
 790
 791         pdev = platform_device_alloc("via686a", address);
 792         if (!pdev) {
 793                 err = -ENOMEM;
 794                 printk(KERN_ERR "via686a: Device allocation failed\n");
 795                 goto exit;
 796         }
 797
 798         err = platform_device_add_resources(pdev, &res, 1);
 799         if (err) {
 800                 printk(KERN_ERR "via686a: Device resource addition failed "
 801                        "(%d)\n", err);
 802                 goto exit_device_put;
 803         }
 804
 805         err = platform_device_add(pdev);
 806         if (err) {
 807                 printk(KERN_ERR "via686a: Device addition failed (%d)\n",
 808                        err);
 809                 goto exit_device_put;
 810         }
 811
 812         return 0;
 813
 814 exit_device_put:
 815         platform_device_put(pdev);
 816 exit:
 817         return err;
 818 }
 819
 820 static int __devinit via686a_pci_probe(struct pci_dev *dev,
 821                                        const struct pci_device_id *id)
 822 {
 823         u16 address, val;
 824
 825         if (force_addr) {
 826                 address = force_addr & ~(VIA686A_EXTENT - 1);
 827                 dev_warn(&dev->dev, "Forcing ISA address 0x%x\n", address);
 828                 if (PCIBIOS_SUCCESSFUL !=
 829                     pci_write_config_word(dev, VIA686A_BASE_REG, address | 1))
 830                         return -ENODEV;
 831         }
 832         if (PCIBIOS_SUCCESSFUL !=
 833             pci_read_config_word(dev, VIA686A_BASE_REG, &val))
 834                 return -ENODEV;
 835
 836         address = val & ~(VIA686A_EXTENT - 1);
 837         if (address == 0) {
 838                 dev_err(&dev->dev, "base address not set - upgrade BIOS "
 839                         "or use force_addr=0xaddr\n");
 840                 return -ENODEV;
 841         }
 842
 843         if (PCIBIOS_SUCCESSFUL !=
 844             pci_read_config_word(dev, VIA686A_ENABLE_REG, &val))
 845                 return -ENODEV;
 846         if (!(val & 0x0001)) {
 847                 if (!force_addr) {
 848                         dev_warn(&dev->dev, "Sensors disabled, enable "
 849                                  "with force_addr=0x%x\n", address);
 850                         return -ENODEV;
 851                 }
 852
 853                 dev_warn(&dev->dev, "Enabling sensors\n");
 854                 if (PCIBIOS_SUCCESSFUL !=
 855                     pci_write_config_word(dev, VIA686A_ENABLE_REG,
 856                                           val | 0x0001))
 857                         return -ENODEV;
 858         }
 859
 860         if (platform_driver_register(&via686a_driver))
 861                 goto exit;
 862
 863         /* Sets global pdev as a side effect */
 864         if (via686a_device_add(address))
 865                 goto exit_unregister;
 866
 867         /* Always return failure here.  This is to allow other drivers to bind
 868          * to this pci device.  We don't really want to have control over the
 869          * pci device, we only wanted to read as few register values from it.
 870          */
 871         s_bridge = pci_dev_get(dev);
 872         return -ENODEV;
 873
 874 exit_unregister:
 875         platform_driver_unregister(&via686a_driver);
 876 exit:
 877         return -ENODEV;
 878 }
 879
 880 static struct pci_driver via686a_pci_driver = {
 881         .name           = "via686a",
 882         .id_table       = via686a_pci_ids,
 883         .probe          = via686a_pci_probe,
 884 };
 885
 886 static int __init sm_via686a_init(void)
 887 {
 888         return pci_register_driver(&via686a_pci_driver);
 889 }
 890
 891 static void __exit sm_via686a_exit(void)
 892 {
 893         pci_unregister_driver(&via686a_pci_driver);
 894         if (s_bridge != NULL) {
 895                 platform_device_unregister(pdev);
 896                 platform_driver_unregister(&via686a_driver);
 897                 pci_dev_put(s_bridge);
 898                 s_bridge = NULL;
 899         }
 900 }
 901
 902 MODULE_AUTHOR("Kyösti Mälkki <kmalkki@cc.hut.fi>, "
 903               "Mark Studebaker <mdsxyz123@yahoo.com> "
 904               "and Bob Dougherty <bobd@stanford.edu>");
 905 MODULE_DESCRIPTION("VIA 686A Sensor device");
 906 MODULE_LICENSE("GPL");
 907
 908 module_init(sm_via686a_init);
 909 module_exit(sm_via686a_exit);