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