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