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