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 <linux/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 via686a_update_fan_div(struct via686a_data *data)
 691 {
 692         int reg = via686a_read_value(data, VIA686A_REG_FANDIV);
 693         data->fan_div[0] = (reg >> 4) & 0x03;
 694         data->fan_div[1] = reg >> 6;
 695 }
 696
 697 static void __devinit via686a_init_device(struct via686a_data *data)
 698 {
 699         u8 reg;
 700
 701         /* Start monitoring */
 702         reg = via686a_read_value(data, VIA686A_REG_CONFIG);
 703         via686a_write_value(data, VIA686A_REG_CONFIG, (reg | 0x01) & 0x7F);
 704
 705         /* Configure temp interrupt mode for continuous-interrupt operation */
 706         reg = via686a_read_value(data, VIA686A_REG_TEMP_MODE);
 707         via686a_write_value(data, VIA686A_REG_TEMP_MODE,
 708                             (reg & ~VIA686A_TEMP_MODE_MASK)
 709                             | VIA686A_TEMP_MODE_CONTINUOUS);
 710
 711         /* Pre-read fan clock divisor values */
 712         via686a_update_fan_div(data);
 713 }
 714
 715 static struct via686a_data *via686a_update_device(struct device *dev)
 716 {
 717         struct via686a_data *data = dev_get_drvdata(dev);
 718         int i;
 719
 720         mutex_lock(&data->update_lock);
 721
 722         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 723             || !data->valid) {
 724                 for (i = 0; i <= 4; i++) {
 725                         data->in[i] =
 726                             via686a_read_value(data, VIA686A_REG_IN(i));
 727                         data->in_min[i] = via686a_read_value(data,
 728                                                              VIA686A_REG_IN_MIN
 729                                                              (i));
 730                         data->in_max[i] =
 731                             via686a_read_value(data, VIA686A_REG_IN_MAX(i));
 732                 }
 733                 for (i = 1; i <= 2; i++) {
 734                         data->fan[i - 1] =
 735                             via686a_read_value(data, VIA686A_REG_FAN(i));
 736                         data->fan_min[i - 1] = via686a_read_value(data,
 737                                                      VIA686A_REG_FAN_MIN(i));
 738                 }
 739                 for (i = 0; i <= 2; i++) {
 740                         data->temp[i] = via686a_read_value(data,
 741                                                  VIA686A_REG_TEMP[i]) << 2;
 742                         data->temp_over[i] =
 743                             via686a_read_value(data,
 744                                                VIA686A_REG_TEMP_OVER[i]);
 745                         data->temp_hyst[i] =
 746                             via686a_read_value(data,
 747                                                VIA686A_REG_TEMP_HYST[i]);
 748                 }
 749                 /* add in lower 2 bits
 750                    temp1 uses bits 7-6 of VIA686A_REG_TEMP_LOW1
 751                    temp2 uses bits 5-4 of VIA686A_REG_TEMP_LOW23
 752                    temp3 uses bits 7-6 of VIA686A_REG_TEMP_LOW23
 753                  */
 754                 data->temp[0] |= (via686a_read_value(data,
 755                                                      VIA686A_REG_TEMP_LOW1)
 756                                   & 0xc0) >> 6;
 757                 data->temp[1] |=
 758                     (via686a_read_value(data, VIA686A_REG_TEMP_LOW23) &
 759                      0x30) >> 4;
 760                 data->temp[2] |=
 761                     (via686a_read_value(data, VIA686A_REG_TEMP_LOW23) &
 762                      0xc0) >> 6;
 763
 764                 via686a_update_fan_div(data);
 765                 data->alarms =
 766                     via686a_read_value(data,
 767                                        VIA686A_REG_ALARM1) |
 768                     (via686a_read_value(data, VIA686A_REG_ALARM2) << 8);
 769                 data->last_updated = jiffies;
 770                 data->valid = 1;
 771         }
 772
 773         mutex_unlock(&data->update_lock);
 774
 775         return data;
 776 }
 777
 778 static struct pci_device_id via686a_pci_ids[] = {
 779         { PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686_4) },
 780         { 0, }
 781 };
 782
 783 MODULE_DEVICE_TABLE(pci, via686a_pci_ids);
 784
 785 static int __devinit via686a_device_add(unsigned short address)
 786 {
 787         struct resource res = {
 788                 .start  = address,
 789                 .end    = address + VIA686A_EXTENT - 1,
 790                 .name   = "via686a",
 791                 .flags  = IORESOURCE_IO,
 792         };
 793         int err;
 794
 795         err = acpi_check_resource_conflict(&res);
 796         if (err)
 797                 goto exit;
 798
 799         pdev = platform_device_alloc("via686a", address);
 800         if (!pdev) {
 801                 err = -ENOMEM;
 802                 printk(KERN_ERR "via686a: Device allocation failed\n");
 803                 goto exit;
 804         }
 805
 806         err = platform_device_add_resources(pdev, &res, 1);
 807         if (err) {
 808                 printk(KERN_ERR "via686a: Device resource addition failed "
 809                        "(%d)\n", err);
 810                 goto exit_device_put;
 811         }
 812
 813         err = platform_device_add(pdev);
 814         if (err) {
 815                 printk(KERN_ERR "via686a: Device addition failed (%d)\n",
 816                        err);
 817                 goto exit_device_put;
 818         }
 819
 820         return 0;
 821
 822 exit_device_put:
 823         platform_device_put(pdev);
 824 exit:
 825         return err;
 826 }
 827
 828 static int __devinit via686a_pci_probe(struct pci_dev *dev,
 829                                        const struct pci_device_id *id)
 830 {
 831         u16 address, val;
 832
 833         if (force_addr) {
 834                 address = force_addr & ~(VIA686A_EXTENT - 1);
 835                 dev_warn(&dev->dev, "Forcing ISA address 0x%x\n", address);
 836                 if (PCIBIOS_SUCCESSFUL !=
 837                     pci_write_config_word(dev, VIA686A_BASE_REG, address | 1))
 838                         return -ENODEV;
 839         }
 840         if (PCIBIOS_SUCCESSFUL !=
 841             pci_read_config_word(dev, VIA686A_BASE_REG, &val))
 842                 return -ENODEV;
 843
 844         address = val & ~(VIA686A_EXTENT - 1);
 845         if (address == 0) {
 846                 dev_err(&dev->dev, "base address not set - upgrade BIOS "
 847                         "or use force_addr=0xaddr\n");
 848                 return -ENODEV;
 849         }
 850
 851         if (PCIBIOS_SUCCESSFUL !=
 852             pci_read_config_word(dev, VIA686A_ENABLE_REG, &val))
 853                 return -ENODEV;
 854         if (!(val & 0x0001)) {
 855                 if (!force_addr) {
 856                         dev_warn(&dev->dev, "Sensors disabled, enable "
 857                                  "with force_addr=0x%x\n", address);
 858                         return -ENODEV;
 859                 }
 860
 861                 dev_warn(&dev->dev, "Enabling sensors\n");
 862                 if (PCIBIOS_SUCCESSFUL !=
 863                     pci_write_config_word(dev, VIA686A_ENABLE_REG,
 864                                           val | 0x0001))
 865                         return -ENODEV;
 866         }
 867
 868         if (platform_driver_register(&via686a_driver))
 869                 goto exit;
 870
 871         /* Sets global pdev as a side effect */
 872         if (via686a_device_add(address))
 873                 goto exit_unregister;
 874
 875         /* Always return failure here.  This is to allow other drivers to bind
 876          * to this pci device.  We don't really want to have control over the
 877          * pci device, we only wanted to read as few register values from it.
 878          */
 879         s_bridge = pci_dev_get(dev);
 880         return -ENODEV;
 881
 882 exit_unregister:
 883         platform_driver_unregister(&via686a_driver);
 884 exit:
 885         return -ENODEV;
 886 }
 887
 888 static struct pci_driver via686a_pci_driver = {
 889         .name           = "via686a",
 890         .id_table       = via686a_pci_ids,
 891         .probe          = via686a_pci_probe,
 892 };
 893
 894 static int __init sm_via686a_init(void)
 895 {
 896         return pci_register_driver(&via686a_pci_driver);
 897 }
 898
 899 static void __exit sm_via686a_exit(void)
 900 {
 901         pci_unregister_driver(&via686a_pci_driver);
 902         if (s_bridge != NULL) {
 903                 platform_device_unregister(pdev);
 904                 platform_driver_unregister(&via686a_driver);
 905                 pci_dev_put(s_bridge);
 906                 s_bridge = NULL;
 907         }
 908 }
 909
 910 MODULE_AUTHOR("Kyösti Mälkki <kmalkki@cc.hut.fi>, "
 911               "Mark Studebaker <mdsxyz123@yahoo.com> "
 912               "and Bob Dougherty <bobd@stanford.edu>");
 913 MODULE_DESCRIPTION("VIA 686A Sensor device");
 914 MODULE_LICENSE("GPL");
 915
 916 module_init(sm_via686a_init);
 917 module_exit(sm_via686a_exit);