?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.27.11
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / hwmon / w83627hf.c
blobb30e5796cb26fcc646096571a994c5ee9b5cd7a8
1 /*
2 w83627hf.c - Part of lm_sensors, Linux kernel modules for hardware
3 monitoring
4 Copyright (c) 1998 - 2003 Frodo Looijaard <frodol@dds.nl>,
5 Philip Edelbrock <phil@netroedge.com>,
6 and Mark Studebaker <mdsxyz123@yahoo.com>
7 Ported to 2.6 by Bernhard C. Schrenk <clemy@clemy.org>
8 Copyright (c) 2007 Jean Delvare <khali@linux-fr.org>
9
10 This program is free software; you can redistribute it and/or modify
11 it under the terms of the GNU General Public License as published by
12 the Free Software Foundation; either version 2 of the License, or
13 (at your option) any later version.
14
15 This program is distributed in the hope that it will be useful,
16 but WITHOUT ANY WARRANTY; without even the implied warranty of
17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 GNU General Public License for more details.
19
20 You should have received a copy of the GNU General Public License
21 along with this program; if not, write to the Free Software
22 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 */
24
25 /*
26 Supports following chips:
27
28 Chip #vin #fanin #pwm #temp wchipid vendid i2c ISA
29 w83627hf 9 3 2 3 0x20 0x5ca3 no yes(LPC)
30 w83627thf 7 3 3 3 0x90 0x5ca3 no yes(LPC)
31 w83637hf 7 3 3 3 0x80 0x5ca3 no yes(LPC)
32 w83687thf 7 3 3 3 0x90 0x5ca3 no yes(LPC)
33 w83697hf 8 2 2 2 0x60 0x5ca3 no yes(LPC)
34
35 For other winbond chips, and for i2c support in the above chips,
36 use w83781d.c.
37
38 Note: automatic ("cruise") fan control for 697, 637 & 627thf not
39 supported yet.
40 */
41
42 #include <linux/module.h>
43 #include <linux/init.h>
44 #include <linux/slab.h>
45 #include <linux/jiffies.h>
46 #include <linux/platform_device.h>
47 #include <linux/hwmon.h>
48 #include <linux/hwmon-sysfs.h>
49 #include <linux/hwmon-vid.h>
50 #include <linux/err.h>
51 #include <linux/mutex.h>
52 #include <linux/ioport.h>
53 #include <asm/io.h>
54 #include "lm75.h"
55
56 static struct platform_device *pdev;
57
58 #define DRVNAME "w83627hf"
59 enum chips { w83627hf, w83627thf, w83697hf, w83637hf, w83687thf };
60
61 static u16 force_addr;
62 module_param(force_addr, ushort, 0);
63 MODULE_PARM_DESC(force_addr,
64 "Initialize the base address of the sensors");
65 static u8 force_i2c = 0x1f;
66 module_param(force_i2c, byte, 0);
67 MODULE_PARM_DESC(force_i2c,
68 "Initialize the i2c address of the sensors");
69
70 static int init = 1;
71 module_param(init, bool, 0);
72 MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");
73
74 static unsigned short force_id;
75 module_param(force_id, ushort, 0);
76 MODULE_PARM_DESC(force_id, "Override the detected device ID");
77
78 /* modified from kernel/include/traps.c */
79 static int REG; /* The register to read/write */
80 #define DEV 0x07 /* Register: Logical device select */
81 static int VAL; /* The value to read/write */
82
83 /* logical device numbers for superio_select (below) */
84 #define W83627HF_LD_FDC 0x00
85 #define W83627HF_LD_PRT 0x01
86 #define W83627HF_LD_UART1 0x02
87 #define W83627HF_LD_UART2 0x03
88 #define W83627HF_LD_KBC 0x05
89 #define W83627HF_LD_CIR 0x06 /* w83627hf only */
90 #define W83627HF_LD_GAME 0x07
91 #define W83627HF_LD_MIDI 0x07
92 #define W83627HF_LD_GPIO1 0x07
93 #define W83627HF_LD_GPIO5 0x07 /* w83627thf only */
94 #define W83627HF_LD_GPIO2 0x08
95 #define W83627HF_LD_GPIO3 0x09
96 #define W83627HF_LD_GPIO4 0x09 /* w83627thf only */
97 #define W83627HF_LD_ACPI 0x0a
98 #define W83627HF_LD_HWM 0x0b
99
100 #define DEVID 0x20 /* Register: Device ID */
101
102 #define W83627THF_GPIO5_EN 0x30 /* w83627thf only */
103 #define W83627THF_GPIO5_IOSR 0xf3 /* w83627thf only */
104 #define W83627THF_GPIO5_DR 0xf4 /* w83627thf only */
105
106 #define W83687THF_VID_EN 0x29 /* w83687thf only */
107 #define W83687THF_VID_CFG 0xF0 /* w83687thf only */
108 #define W83687THF_VID_DATA 0xF1 /* w83687thf only */
109
110 static inline void
111 superio_outb(int reg, int val)
112 {
113 outb(reg, REG);
114 outb(val, VAL);
115 }
116
117 static inline int
118 superio_inb(int reg)
119 {
120 outb(reg, REG);
121 return inb(VAL);
122 }
123
124 static inline void
125 superio_select(int ld)
126 {
127 outb(DEV, REG);
128 outb(ld, VAL);
129 }
130
131 static inline void
132 superio_enter(void)
133 {
134 outb(0x87, REG);
135 outb(0x87, REG);
136 }
137
138 static inline void
139 superio_exit(void)
140 {
141 outb(0xAA, REG);
142 }
143
144 #define W627_DEVID 0x52
145 #define W627THF_DEVID 0x82
146 #define W697_DEVID 0x60
147 #define W637_DEVID 0x70
148 #define W687THF_DEVID 0x85
149 #define WINB_ACT_REG 0x30
150 #define WINB_BASE_REG 0x60
151 /* Constants specified below */
152
153 /* Alignment of the base address */
154 #define WINB_ALIGNMENT ~7
155
156 /* Offset & size of I/O region we are interested in */
157 #define WINB_REGION_OFFSET 5
158 #define WINB_REGION_SIZE 2
159
160 /* Where are the sensors address/data registers relative to the region offset */
161 #define W83781D_ADDR_REG_OFFSET 0
162 #define W83781D_DATA_REG_OFFSET 1
163
164 /* The W83781D registers */
165 /* The W83782D registers for nr=7,8 are in bank 5 */
166 #define W83781D_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
167 (0x554 + (((nr) - 7) * 2)))
168 #define W83781D_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
169 (0x555 + (((nr) - 7) * 2)))
170 #define W83781D_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \
171 (0x550 + (nr) - 7))
172
173 /* nr:0-2 for fans:1-3 */
174 #define W83627HF_REG_FAN_MIN(nr) (0x3b + (nr))
175 #define W83627HF_REG_FAN(nr) (0x28 + (nr))
176
177 #define W83627HF_REG_TEMP2_CONFIG 0x152
178 #define W83627HF_REG_TEMP3_CONFIG 0x252
179 /* these are zero-based, unlike config constants above */
180 static const u16 w83627hf_reg_temp[] = { 0x27, 0x150, 0x250 };
181 static const u16 w83627hf_reg_temp_hyst[] = { 0x3A, 0x153, 0x253 };
182 static const u16 w83627hf_reg_temp_over[] = { 0x39, 0x155, 0x255 };
183
184 #define W83781D_REG_BANK 0x4E
185
186 #define W83781D_REG_CONFIG 0x40
187 #define W83781D_REG_ALARM1 0x459
188 #define W83781D_REG_ALARM2 0x45A
189 #define W83781D_REG_ALARM3 0x45B
190
191 #define W83781D_REG_BEEP_CONFIG 0x4D
192 #define W83781D_REG_BEEP_INTS1 0x56
193 #define W83781D_REG_BEEP_INTS2 0x57
194 #define W83781D_REG_BEEP_INTS3 0x453
195
196 #define W83781D_REG_VID_FANDIV 0x47
197
198 #define W83781D_REG_CHIPID 0x49
199 #define W83781D_REG_WCHIPID 0x58
200 #define W83781D_REG_CHIPMAN 0x4F
201 #define W83781D_REG_PIN 0x4B
202
203 #define W83781D_REG_VBAT 0x5D
204
205 #define W83627HF_REG_PWM1 0x5A
206 #define W83627HF_REG_PWM2 0x5B
207
208 static const u8 W83627THF_REG_PWM_ENABLE[] = {
209 0x04, /* FAN 1 mode */
210 0x04, /* FAN 2 mode */
211 0x12, /* FAN AUX mode */
212 };
213 static const u8 W83627THF_PWM_ENABLE_SHIFT[] = { 2, 4, 1 };
214
215 #define W83627THF_REG_PWM1 0x01 /* 697HF/637HF/687THF too */
216 #define W83627THF_REG_PWM2 0x03 /* 697HF/637HF/687THF too */
217 #define W83627THF_REG_PWM3 0x11 /* 637HF/687THF too */
218
219 #define W83627THF_REG_VRM_OVT_CFG 0x18 /* 637HF/687THF too */
220
221 static const u8 regpwm_627hf[] = { W83627HF_REG_PWM1, W83627HF_REG_PWM2 };
222 static const u8 regpwm[] = { W83627THF_REG_PWM1, W83627THF_REG_PWM2,
223 W83627THF_REG_PWM3 };
224 #define W836X7HF_REG_PWM(type, nr) (((type) == w83627hf) ? \
225 regpwm_627hf[nr] : regpwm[nr])
226
227 #define W83627HF_REG_PWM_FREQ 0x5C /* Only for the 627HF */
228
229 #define W83637HF_REG_PWM_FREQ1 0x00 /* 697HF/687THF too */
230 #define W83637HF_REG_PWM_FREQ2 0x02 /* 697HF/687THF too */
231 #define W83637HF_REG_PWM_FREQ3 0x10 /* 687THF too */
232
233 static const u8 W83637HF_REG_PWM_FREQ[] = { W83637HF_REG_PWM_FREQ1,
234 W83637HF_REG_PWM_FREQ2,
235 W83637HF_REG_PWM_FREQ3 };
236
237 #define W83627HF_BASE_PWM_FREQ 46870
238
239 #define W83781D_REG_I2C_ADDR 0x48
240 #define W83781D_REG_I2C_SUBADDR 0x4A
241
242 /* Sensor selection */
243 #define W83781D_REG_SCFG1 0x5D
244 static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };
245 #define W83781D_REG_SCFG2 0x59
246 static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 };
247 #define W83781D_DEFAULT_BETA 3435
248
249 /* Conversions. Limit checking is only done on the TO_REG
250 variants. Note that you should be a bit careful with which arguments
251 these macros are called: arguments may be evaluated more than once.
252 Fixing this is just not worth it. */
253 #define IN_TO_REG(val) (SENSORS_LIMIT((((val) + 8)/16),0,255))
254 #define IN_FROM_REG(val) ((val) * 16)
255
256 static inline u8 FAN_TO_REG(long rpm, int div)
257 {
258 if (rpm == 0)
259 return 255;
260 rpm = SENSORS_LIMIT(rpm, 1, 1000000);
261 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1,
262 254);
263 }
264
265 #define TEMP_MIN (-128000)
266 #define TEMP_MAX ( 127000)
267
268 /* TEMP: 0.001C/bit (-128C to +127C)
269 REG: 1C/bit, two's complement */
270 static u8 TEMP_TO_REG(long temp)
271 {
272 int ntemp = SENSORS_LIMIT(temp, TEMP_MIN, TEMP_MAX);
273 ntemp += (ntemp<0 ? -500 : 500);
274 return (u8)(ntemp / 1000);
275 }
276
277 static int TEMP_FROM_REG(u8 reg)
278 {
279 return (s8)reg * 1000;
280 }
281
282 #define FAN_FROM_REG(val,div) ((val)==0?-1:(val)==255?0:1350000/((val)*(div)))
283
284 #define PWM_TO_REG(val) (SENSORS_LIMIT((val),0,255))
285
286 static inline unsigned long pwm_freq_from_reg_627hf(u8 reg)
287 {
288 unsigned long freq;
289 freq = W83627HF_BASE_PWM_FREQ >> reg;
290 return freq;
291 }
292 static inline u8 pwm_freq_to_reg_627hf(unsigned long val)
293 {
294 u8 i;
295 /* Only 5 dividers (1 2 4 8 16)
296 Search for the nearest available frequency */
297 for (i = 0; i < 4; i++) {
298 if (val > (((W83627HF_BASE_PWM_FREQ >> i) +
299 (W83627HF_BASE_PWM_FREQ >> (i+1))) / 2))
300 break;
301 }
302 return i;
303 }
304
305 static inline unsigned long pwm_freq_from_reg(u8 reg)
306 {
307 /* Clock bit 8 -> 180 kHz or 24 MHz */
308 unsigned long clock = (reg & 0x80) ? 180000UL : 24000000UL;
309
310 reg &= 0x7f;
311 /* This should not happen but anyway... */
312 if (reg == 0)
313 reg++;
314 return (clock / (reg << 8));
315 }
316 static inline u8 pwm_freq_to_reg(unsigned long val)
317 {
318 /* Minimum divider value is 0x01 and maximum is 0x7F */
319 if (val >= 93750) /* The highest we can do */
320 return 0x01;
321 if (val >= 720) /* Use 24 MHz clock */
322 return (24000000UL / (val << 8));
323 if (val < 6) /* The lowest we can do */
324 return 0xFF;
325 else /* Use 180 kHz clock */
326 return (0x80 | (180000UL / (val << 8)));
327 }
328
329 #define BEEP_MASK_FROM_REG(val) ((val) & 0xff7fff)
330 #define BEEP_MASK_TO_REG(val) ((val) & 0xff7fff)
331
332 #define DIV_FROM_REG(val) (1 << (val))
333
334 static inline u8 DIV_TO_REG(long val)
335 {
336 int i;
337 val = SENSORS_LIMIT(val, 1, 128) >> 1;
338 for (i = 0; i < 7; i++) {
339 if (val == 0)
340 break;
341 val >>= 1;
342 }
343 return ((u8) i);
344 }
345
346 /* For each registered chip, we need to keep some data in memory.
347 The structure is dynamically allocated. */
348 struct w83627hf_data {
349 unsigned short addr;
350 const char *name;
351 struct device *hwmon_dev;
352 struct mutex lock;
353 enum chips type;
354
355 struct mutex update_lock;
356 char valid; /* !=0 if following fields are valid */
357 unsigned long last_updated; /* In jiffies */
358
359 u8 in[9]; /* Register value */
360 u8 in_max[9]; /* Register value */
361 u8 in_min[9]; /* Register value */
362 u8 fan[3]; /* Register value */
363 u8 fan_min[3]; /* Register value */
364 u16 temp[3]; /* Register value */
365 u16 temp_max[3]; /* Register value */
366 u16 temp_max_hyst[3]; /* Register value */
367 u8 fan_div[3]; /* Register encoding, shifted right */
368 u8 vid; /* Register encoding, combined */
369 u32 alarms; /* Register encoding, combined */
370 u32 beep_mask; /* Register encoding, combined */
371 u8 pwm[3]; /* Register value */
372 u8 pwm_enable[3]; /* 1 = manual
373 2 = thermal cruise (also called SmartFan I)
374 3 = fan speed cruise */
375 u8 pwm_freq[3]; /* Register value */
376 u16 sens[3]; /* 1 = pentium diode; 2 = 3904 diode;
377 4 = thermistor */
378 u8 vrm;
379 u8 vrm_ovt; /* Register value, 627THF/637HF/687THF only */
380 };
381
382 struct w83627hf_sio_data {
383 enum chips type;
384 };
385
386
387 static int w83627hf_probe(struct platform_device *pdev);
388 static int __devexit w83627hf_remove(struct platform_device *pdev);
389
390 static int w83627hf_read_value(struct w83627hf_data *data, u16 reg);
391 static int w83627hf_write_value(struct w83627hf_data *data, u16 reg, u16 value);
392 static void w83627hf_update_fan_div(struct w83627hf_data *data);
393 static struct w83627hf_data *w83627hf_update_device(struct device *dev);
394 static void w83627hf_init_device(struct platform_device *pdev);
395
396 static struct platform_driver w83627hf_driver = {
397 .driver = {
398 .owner = THIS_MODULE,
399 .name = DRVNAME,
400 },
401 .probe = w83627hf_probe,
402 .remove = __devexit_p(w83627hf_remove),
403 };
404
405 static ssize_t
406 show_in_input(struct device *dev, struct device_attribute *devattr, char *buf)
407 {
408 int nr = to_sensor_dev_attr(devattr)->index;
409 struct w83627hf_data *data = w83627hf_update_device(dev);
410 return sprintf(buf, "%ld\n", (long)IN_FROM_REG(data->in[nr]));
411 }
412 static ssize_t
413 show_in_min(struct device *dev, struct device_attribute *devattr, char *buf)
414 {
415 int nr = to_sensor_dev_attr(devattr)->index;
416 struct w83627hf_data *data = w83627hf_update_device(dev);
417 return sprintf(buf, "%ld\n", (long)IN_FROM_REG(data->in_min[nr]));
418 }
419 static ssize_t
420 show_in_max(struct device *dev, struct device_attribute *devattr, char *buf)
421 {
422 int nr = to_sensor_dev_attr(devattr)->index;
423 struct w83627hf_data *data = w83627hf_update_device(dev);
424 return sprintf(buf, "%ld\n", (long)IN_FROM_REG(data->in_max[nr]));
425 }
426 static ssize_t
427 store_in_min(struct device *dev, struct device_attribute *devattr,
428 const char *buf, size_t count)
429 {
430 int nr = to_sensor_dev_attr(devattr)->index;
431 struct w83627hf_data *data = dev_get_drvdata(dev);
432 long val = simple_strtol(buf, NULL, 10);
433
434 mutex_lock(&data->update_lock);
435 data->in_min[nr] = IN_TO_REG(val);
436 w83627hf_write_value(data, W83781D_REG_IN_MIN(nr), data->in_min[nr]);
437 mutex_unlock(&data->update_lock);
438 return count;
439 }
440 static ssize_t
441 store_in_max(struct device *dev, struct device_attribute *devattr,
442 const char *buf, size_t count)
443 {
444 int nr = to_sensor_dev_attr(devattr)->index;
445 struct w83627hf_data *data = dev_get_drvdata(dev);
446 long val = simple_strtol(buf, NULL, 10);
447
448 mutex_lock(&data->update_lock);
449 data->in_max[nr] = IN_TO_REG(val);
450 w83627hf_write_value(data, W83781D_REG_IN_MAX(nr), data->in_max[nr]);
451 mutex_unlock(&data->update_lock);
452 return count;
453 }
454 #define sysfs_vin_decl(offset) \
455 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
456 show_in_input, NULL, offset); \
457 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO|S_IWUSR, \
458 show_in_min, store_in_min, offset); \
459 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO|S_IWUSR, \
460 show_in_max, store_in_max, offset);
461
462 sysfs_vin_decl(1);
463 sysfs_vin_decl(2);
464 sysfs_vin_decl(3);
465 sysfs_vin_decl(4);
466 sysfs_vin_decl(5);
467 sysfs_vin_decl(6);
468 sysfs_vin_decl(7);
469 sysfs_vin_decl(8);
470
471 /* use a different set of functions for in0 */
472 static ssize_t show_in_0(struct w83627hf_data *data, char *buf, u8 reg)
473 {
474 long in0;
475
476 if ((data->vrm_ovt & 0x01) &&
477 (w83627thf == data->type || w83637hf == data->type
478 || w83687thf == data->type))
479
480 /* use VRM9 calculation */
481 in0 = (long)((reg * 488 + 70000 + 50) / 100);
482 else
483 /* use VRM8 (standard) calculation */
484 in0 = (long)IN_FROM_REG(reg);
485
486 return sprintf(buf,"%ld\n", in0);
487 }
488
489 static ssize_t show_regs_in_0(struct device *dev, struct device_attribute *attr, char *buf)
490 {
491 struct w83627hf_data *data = w83627hf_update_device(dev);
492 return show_in_0(data, buf, data->in[0]);
493 }
494
495 static ssize_t show_regs_in_min0(struct device *dev, struct device_attribute *attr, char *buf)
496 {
497 struct w83627hf_data *data = w83627hf_update_device(dev);
498 return show_in_0(data, buf, data->in_min[0]);
499 }
500
501 static ssize_t show_regs_in_max0(struct device *dev, struct device_attribute *attr, char *buf)
502 {
503 struct w83627hf_data *data = w83627hf_update_device(dev);
504 return show_in_0(data, buf, data->in_max[0]);
505 }
506
507 static ssize_t store_regs_in_min0(struct device *dev, struct device_attribute *attr,
508 const char *buf, size_t count)
509 {
510 struct w83627hf_data *data = dev_get_drvdata(dev);
511 u32 val;
512
513 val = simple_strtoul(buf, NULL, 10);
514
515 mutex_lock(&data->update_lock);
516
517 if ((data->vrm_ovt & 0x01) &&
518 (w83627thf == data->type || w83637hf == data->type
519 || w83687thf == data->type))
520
521 /* use VRM9 calculation */
522 data->in_min[0] =
523 SENSORS_LIMIT(((val * 100) - 70000 + 244) / 488, 0,
524 255);
525 else
526 /* use VRM8 (standard) calculation */
527 data->in_min[0] = IN_TO_REG(val);
528
529 w83627hf_write_value(data, W83781D_REG_IN_MIN(0), data->in_min[0]);
530 mutex_unlock(&data->update_lock);
531 return count;
532 }
533
534 static ssize_t store_regs_in_max0(struct device *dev, struct device_attribute *attr,
535 const char *buf, size_t count)
536 {
537 struct w83627hf_data *data = dev_get_drvdata(dev);
538 u32 val;
539
540 val = simple_strtoul(buf, NULL, 10);
541
542 mutex_lock(&data->update_lock);
543
544 if ((data->vrm_ovt & 0x01) &&
545 (w83627thf == data->type || w83637hf == data->type
546 || w83687thf == data->type))
547
548 /* use VRM9 calculation */
549 data->in_max[0] =
550 SENSORS_LIMIT(((val * 100) - 70000 + 244) / 488, 0,
551 255);
552 else
553 /* use VRM8 (standard) calculation */
554 data->in_max[0] = IN_TO_REG(val);
555
556 w83627hf_write_value(data, W83781D_REG_IN_MAX(0), data->in_max[0]);
557 mutex_unlock(&data->update_lock);
558 return count;
559 }
560
561 static DEVICE_ATTR(in0_input, S_IRUGO, show_regs_in_0, NULL);
562 static DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR,
563 show_regs_in_min0, store_regs_in_min0);
564 static DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR,
565 show_regs_in_max0, store_regs_in_max0);
566
567 static ssize_t
568 show_fan_input(struct device *dev, struct device_attribute *devattr, char *buf)
569 {
570 int nr = to_sensor_dev_attr(devattr)->index;
571 struct w83627hf_data *data = w83627hf_update_device(dev);
572 return sprintf(buf, "%ld\n", FAN_FROM_REG(data->fan[nr],
573 (long)DIV_FROM_REG(data->fan_div[nr])));
574 }
575 static ssize_t
576 show_fan_min(struct device *dev, struct device_attribute *devattr, char *buf)
577 {
578 int nr = to_sensor_dev_attr(devattr)->index;
579 struct w83627hf_data *data = w83627hf_update_device(dev);
580 return sprintf(buf, "%ld\n", FAN_FROM_REG(data->fan_min[nr],
581 (long)DIV_FROM_REG(data->fan_div[nr])));
582 }
583 static ssize_t
584 store_fan_min(struct device *dev, struct device_attribute *devattr,
585 const char *buf, size_t count)
586 {
587 int nr = to_sensor_dev_attr(devattr)->index;
588 struct w83627hf_data *data = dev_get_drvdata(dev);
589 u32 val = simple_strtoul(buf, NULL, 10);
590
591 mutex_lock(&data->update_lock);
592 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
593 w83627hf_write_value(data, W83627HF_REG_FAN_MIN(nr),
594 data->fan_min[nr]);
595
596 mutex_unlock(&data->update_lock);
597 return count;
598 }
599 #define sysfs_fan_decl(offset) \
600 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
601 show_fan_input, NULL, offset - 1); \
602 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
603 show_fan_min, store_fan_min, offset - 1);
604
605 sysfs_fan_decl(1);
606 sysfs_fan_decl(2);
607 sysfs_fan_decl(3);
608
609 static ssize_t
610 show_temp(struct device *dev, struct device_attribute *devattr, char *buf)
611 {
612 int nr = to_sensor_dev_attr(devattr)->index;
613 struct w83627hf_data *data = w83627hf_update_device(dev);
614
615 u16 tmp = data->temp[nr];
616 return sprintf(buf, "%ld\n", (nr) ? (long) LM75_TEMP_FROM_REG(tmp)
617 : (long) TEMP_FROM_REG(tmp));
618 }
619
620 static ssize_t
621 show_temp_max(struct device *dev, struct device_attribute *devattr,
622 char *buf)
623 {
624 int nr = to_sensor_dev_attr(devattr)->index;
625 struct w83627hf_data *data = w83627hf_update_device(dev);
626
627 u16 tmp = data->temp_max[nr];
628 return sprintf(buf, "%ld\n", (nr) ? (long) LM75_TEMP_FROM_REG(tmp)
629 : (long) TEMP_FROM_REG(tmp));
630 }
631
632 static ssize_t
633 show_temp_max_hyst(struct device *dev, struct device_attribute *devattr,
634 char *buf)
635 {
636 int nr = to_sensor_dev_attr(devattr)->index;
637 struct w83627hf_data *data = w83627hf_update_device(dev);
638
639 u16 tmp = data->temp_max_hyst[nr];
640 return sprintf(buf, "%ld\n", (nr) ? (long) LM75_TEMP_FROM_REG(tmp)
641 : (long) TEMP_FROM_REG(tmp));
642 }
643
644 static ssize_t
645 store_temp_max(struct device *dev, struct device_attribute *devattr,
646 const char *buf, size_t count)
647 {
648 int nr = to_sensor_dev_attr(devattr)->index;
649 struct w83627hf_data *data = dev_get_drvdata(dev);
650 long val = simple_strtol(buf, NULL, 10);
651 u16 tmp = (nr) ? LM75_TEMP_TO_REG(val) : TEMP_TO_REG(val);
652
653 mutex_lock(&data->update_lock);
654 data->temp_max[nr] = tmp;
655 w83627hf_write_value(data, w83627hf_reg_temp_over[nr], tmp);
656 mutex_unlock(&data->update_lock);
657 return count;
658 }
659
660 static ssize_t
661 store_temp_max_hyst(struct device *dev, struct device_attribute *devattr,
662 const char *buf, size_t count)
663 {
664 int nr = to_sensor_dev_attr(devattr)->index;
665 struct w83627hf_data *data = dev_get_drvdata(dev);
666 long val = simple_strtol(buf, NULL, 10);
667 u16 tmp = (nr) ? LM75_TEMP_TO_REG(val) : TEMP_TO_REG(val);
668
669 mutex_lock(&data->update_lock);
670 data->temp_max_hyst[nr] = tmp;
671 w83627hf_write_value(data, w83627hf_reg_temp_hyst[nr], tmp);
672 mutex_unlock(&data->update_lock);
673 return count;
674 }
675
676 #define sysfs_temp_decl(offset) \
677 static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
678 show_temp, NULL, offset - 1); \
679 static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO|S_IWUSR, \
680 show_temp_max, store_temp_max, offset - 1); \
681 static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO|S_IWUSR, \
682 show_temp_max_hyst, store_temp_max_hyst, offset - 1);
683
684 sysfs_temp_decl(1);
685 sysfs_temp_decl(2);
686 sysfs_temp_decl(3);
687
688 static ssize_t
689 show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf)
690 {
691 struct w83627hf_data *data = w83627hf_update_device(dev);
692 return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
693 }
694 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);
695
696 static ssize_t
697 show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf)
698 {
699 struct w83627hf_data *data = dev_get_drvdata(dev);
700 return sprintf(buf, "%ld\n", (long) data->vrm);
701 }
702 static ssize_t
703 store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
704 {
705 struct w83627hf_data *data = dev_get_drvdata(dev);
706 u32 val;
707
708 val = simple_strtoul(buf, NULL, 10);
709 data->vrm = val;
710
711 return count;
712 }
713 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);
714
715 static ssize_t
716 show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf)
717 {
718 struct w83627hf_data *data = w83627hf_update_device(dev);
719 return sprintf(buf, "%ld\n", (long) data->alarms);
720 }
721 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);
722
723 static ssize_t
724 show_alarm(struct device *dev, struct device_attribute *attr, char *buf)
725 {
726 struct w83627hf_data *data = w83627hf_update_device(dev);
727 int bitnr = to_sensor_dev_attr(attr)->index;
728 return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
729 }
730 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
731 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
732 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
733 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
734 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
735 static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
736 static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
737 static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16);
738 static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17);
739 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
740 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
741 static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
742 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
743 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
744 static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13);
745
746 static ssize_t
747 show_beep_mask(struct device *dev, struct device_attribute *attr, char *buf)
748 {
749 struct w83627hf_data *data = w83627hf_update_device(dev);
750 return sprintf(buf, "%ld\n",
751 (long)BEEP_MASK_FROM_REG(data->beep_mask));
752 }
753
754 static ssize_t
755 store_beep_mask(struct device *dev, struct device_attribute *attr,
756 const char *buf, size_t count)
757 {
758 struct w83627hf_data *data = dev_get_drvdata(dev);
759 unsigned long val;
760
761 val = simple_strtoul(buf, NULL, 10);
762
763 mutex_lock(&data->update_lock);
764
765 /* preserve beep enable */
766 data->beep_mask = (data->beep_mask & 0x8000)
767 | BEEP_MASK_TO_REG(val);
768 w83627hf_write_value(data, W83781D_REG_BEEP_INTS1,
769 data->beep_mask & 0xff);
770 w83627hf_write_value(data, W83781D_REG_BEEP_INTS3,
771 ((data->beep_mask) >> 16) & 0xff);
772 w83627hf_write_value(data, W83781D_REG_BEEP_INTS2,
773 (data->beep_mask >> 8) & 0xff);
774
775 mutex_unlock(&data->update_lock);
776 return count;
777 }
778
779 static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR,
780 show_beep_mask, store_beep_mask);
781
782 static ssize_t
783 show_beep(struct device *dev, struct device_attribute *attr, char *buf)
784 {
785 struct w83627hf_data *data = w83627hf_update_device(dev);
786 int bitnr = to_sensor_dev_attr(attr)->index;
787 return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
788 }
789
790 static ssize_t
791 store_beep(struct device *dev, struct device_attribute *attr,
792 const char *buf, size_t count)
793 {
794 struct w83627hf_data *data = dev_get_drvdata(dev);
795 int bitnr = to_sensor_dev_attr(attr)->index;
796 unsigned long bit;
797 u8 reg;
798
799 bit = simple_strtoul(buf, NULL, 10);
800 if (bit & ~1)
801 return -EINVAL;
802
803 mutex_lock(&data->update_lock);
804 if (bit)
805 data->beep_mask |= (1 << bitnr);
806 else
807 data->beep_mask &= ~(1 << bitnr);
808
809 if (bitnr < 8) {
810 reg = w83627hf_read_value(data, W83781D_REG_BEEP_INTS1);
811 if (bit)
812 reg |= (1 << bitnr);
813 else
814 reg &= ~(1 << bitnr);
815 w83627hf_write_value(data, W83781D_REG_BEEP_INTS1, reg);
816 } else if (bitnr < 16) {
817 reg = w83627hf_read_value(data, W83781D_REG_BEEP_INTS2);
818 if (bit)
819 reg |= (1 << (bitnr - 8));
820 else
821 reg &= ~(1 << (bitnr - 8));
822 w83627hf_write_value(data, W83781D_REG_BEEP_INTS2, reg);
823 } else {
824 reg = w83627hf_read_value(data, W83781D_REG_BEEP_INTS3);
825 if (bit)
826 reg |= (1 << (bitnr - 16));
827 else
828 reg &= ~(1 << (bitnr - 16));
829 w83627hf_write_value(data, W83781D_REG_BEEP_INTS3, reg);
830 }
831 mutex_unlock(&data->update_lock);
832
833 return count;
834 }
835
836 static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR,
837 show_beep, store_beep, 0);
838 static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR,
839 show_beep, store_beep, 1);
840 static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR,
841 show_beep, store_beep, 2);
842 static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR,
843 show_beep, store_beep, 3);
844 static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR,
845 show_beep, store_beep, 8);
846 static SENSOR_DEVICE_ATTR(in5_beep, S_IRUGO | S_IWUSR,
847 show_beep, store_beep, 9);
848 static SENSOR_DEVICE_ATTR(in6_beep, S_IRUGO | S_IWUSR,
849 show_beep, store_beep, 10);
850 static SENSOR_DEVICE_ATTR(in7_beep, S_IRUGO | S_IWUSR,
851 show_beep, store_beep, 16);
852 static SENSOR_DEVICE_ATTR(in8_beep, S_IRUGO | S_IWUSR,
853 show_beep, store_beep, 17);
854 static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR,
855 show_beep, store_beep, 6);
856 static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR,
857 show_beep, store_beep, 7);
858 static SENSOR_DEVICE_ATTR(fan3_beep, S_IRUGO | S_IWUSR,
859 show_beep, store_beep, 11);
860 static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR,
861 show_beep, store_beep, 4);
862 static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR,
863 show_beep, store_beep, 5);
864 static SENSOR_DEVICE_ATTR(temp3_beep, S_IRUGO | S_IWUSR,
865 show_beep, store_beep, 13);
866 static SENSOR_DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR,
867 show_beep, store_beep, 15);
868
869 static ssize_t
870 show_fan_div(struct device *dev, struct device_attribute *devattr, char *buf)
871 {
872 int nr = to_sensor_dev_attr(devattr)->index;
873 struct w83627hf_data *data = w83627hf_update_device(dev);
874 return sprintf(buf, "%ld\n",
875 (long) DIV_FROM_REG(data->fan_div[nr]));
876 }
877 /* Note: we save and restore the fan minimum here, because its value is
878 determined in part by the fan divisor. This follows the principle of
879 least surprise; the user doesn't expect the fan minimum to change just
880 because the divisor changed. */
881 static ssize_t
882 store_fan_div(struct device *dev, struct device_attribute *devattr,
883 const char *buf, size_t count)
884 {
885 int nr = to_sensor_dev_attr(devattr)->index;
886 struct w83627hf_data *data = dev_get_drvdata(dev);
887 unsigned long min;
888 u8 reg;
889 unsigned long val = simple_strtoul(buf, NULL, 10);
890
891 mutex_lock(&data->update_lock);
892
893 /* Save fan_min */
894 min = FAN_FROM_REG(data->fan_min[nr],
895 DIV_FROM_REG(data->fan_div[nr]));
896
897 data->fan_div[nr] = DIV_TO_REG(val);
898
899 reg = (w83627hf_read_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
900 & (nr==0 ? 0xcf : 0x3f))
901 | ((data->fan_div[nr] & 0x03) << (nr==0 ? 4 : 6));
902 w83627hf_write_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
903
904 reg = (w83627hf_read_value(data, W83781D_REG_VBAT)
905 & ~(1 << (5 + nr)))
906 | ((data->fan_div[nr] & 0x04) << (3 + nr));
907 w83627hf_write_value(data, W83781D_REG_VBAT, reg);
908
909 /* Restore fan_min */
910 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
911 w83627hf_write_value(data, W83627HF_REG_FAN_MIN(nr), data->fan_min[nr]);
912
913 mutex_unlock(&data->update_lock);
914 return count;
915 }
916
917 static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO|S_IWUSR,
918 show_fan_div, store_fan_div, 0);
919 static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO|S_IWUSR,
920 show_fan_div, store_fan_div, 1);
921 static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO|S_IWUSR,
922 show_fan_div, store_fan_div, 2);
923
924 static ssize_t
925 show_pwm(struct device *dev, struct device_attribute *devattr, char *buf)
926 {
927 int nr = to_sensor_dev_attr(devattr)->index;
928 struct w83627hf_data *data = w83627hf_update_device(dev);
929 return sprintf(buf, "%ld\n", (long) data->pwm[nr]);
930 }
931
932 static ssize_t
933 store_pwm(struct device *dev, struct device_attribute *devattr,
934 const char *buf, size_t count)
935 {
936 int nr = to_sensor_dev_attr(devattr)->index;
937 struct w83627hf_data *data = dev_get_drvdata(dev);
938 u32 val = simple_strtoul(buf, NULL, 10);
939
940 mutex_lock(&data->update_lock);
941
942 if (data->type == w83627thf) {
943 /* bits 0-3 are reserved in 627THF */
944 data->pwm[nr] = PWM_TO_REG(val) & 0xf0;
945 w83627hf_write_value(data,
946 W836X7HF_REG_PWM(data->type, nr),
947 data->pwm[nr] |
948 (w83627hf_read_value(data,
949 W836X7HF_REG_PWM(data->type, nr)) & 0x0f));
950 } else {
951 data->pwm[nr] = PWM_TO_REG(val);
952 w83627hf_write_value(data,
953 W836X7HF_REG_PWM(data->type, nr),
954 data->pwm[nr]);
955 }
956
957 mutex_unlock(&data->update_lock);
958 return count;
959 }
960
961 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0);
962 static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 1);
963 static SENSOR_DEVICE_ATTR(pwm3, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 2);
964
965 static ssize_t
966 show_pwm_enable(struct device *dev, struct device_attribute *devattr, char *buf)
967 {
968 int nr = to_sensor_dev_attr(devattr)->index;
969 struct w83627hf_data *data = w83627hf_update_device(dev);
970 return sprintf(buf, "%d\n", data->pwm_enable[nr]);
971 }
972
973 static ssize_t
974 store_pwm_enable(struct device *dev, struct device_attribute *devattr,
975 const char *buf, size_t count)
976 {
977 int nr = to_sensor_dev_attr(devattr)->index;
978 struct w83627hf_data *data = dev_get_drvdata(dev);
979 unsigned long val = simple_strtoul(buf, NULL, 10);
980 u8 reg;
981
982 if (!val || (val > 3)) /* modes 1, 2 and 3 are supported */
983 return -EINVAL;
984 mutex_lock(&data->update_lock);
985 data->pwm_enable[nr] = val;
986 reg = w83627hf_read_value(data, W83627THF_REG_PWM_ENABLE[nr]);
987 reg &= ~(0x03 << W83627THF_PWM_ENABLE_SHIFT[nr]);
988 reg |= (val - 1) << W83627THF_PWM_ENABLE_SHIFT[nr];
989 w83627hf_write_value(data, W83627THF_REG_PWM_ENABLE[nr], reg);
990 mutex_unlock(&data->update_lock);
991 return count;
992 }
993
994 static SENSOR_DEVICE_ATTR(pwm1_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
995 store_pwm_enable, 0);
996 static SENSOR_DEVICE_ATTR(pwm2_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
997 store_pwm_enable, 1);
998 static SENSOR_DEVICE_ATTR(pwm3_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
999 store_pwm_enable, 2);
1000
1001 static ssize_t
1002 show_pwm_freq(struct device *dev, struct device_attribute *devattr, char *buf)
1003 {
1004 int nr = to_sensor_dev_attr(devattr)->index;
1005 struct w83627hf_data *data = w83627hf_update_device(dev);
1006 if (data->type == w83627hf)
1007 return sprintf(buf, "%ld\n",
1008 pwm_freq_from_reg_627hf(data->pwm_freq[nr]));
1009 else
1010 return sprintf(buf, "%ld\n",
1011 pwm_freq_from_reg(data->pwm_freq[nr]));
1012 }
1013
1014 static ssize_t
1015 store_pwm_freq(struct device *dev, struct device_attribute *devattr,
1016 const char *buf, size_t count)
1017 {
1018 int nr = to_sensor_dev_attr(devattr)->index;
1019 struct w83627hf_data *data = dev_get_drvdata(dev);
1020 static const u8 mask[]={0xF8, 0x8F};
1021 u32 val;
1022
1023 val = simple_strtoul(buf, NULL, 10);
1024
1025 mutex_lock(&data->update_lock);
1026
1027 if (data->type == w83627hf) {
1028 data->pwm_freq[nr] = pwm_freq_to_reg_627hf(val);
1029 w83627hf_write_value(data, W83627HF_REG_PWM_FREQ,
1030 (data->pwm_freq[nr] << (nr*4)) |
1031 (w83627hf_read_value(data,
1032 W83627HF_REG_PWM_FREQ) & mask[nr]));
1033 } else {
1034 data->pwm_freq[nr] = pwm_freq_to_reg(val);
1035 w83627hf_write_value(data, W83637HF_REG_PWM_FREQ[nr],
1036 data->pwm_freq[nr]);
1037 }
1038
1039 mutex_unlock(&data->update_lock);
1040 return count;
1041 }
1042
1043 static SENSOR_DEVICE_ATTR(pwm1_freq, S_IRUGO|S_IWUSR,
1044 show_pwm_freq, store_pwm_freq, 0);
1045 static SENSOR_DEVICE_ATTR(pwm2_freq, S_IRUGO|S_IWUSR,
1046 show_pwm_freq, store_pwm_freq, 1);
1047 static SENSOR_DEVICE_ATTR(pwm3_freq, S_IRUGO|S_IWUSR,
1048 show_pwm_freq, store_pwm_freq, 2);
1049
1050 static ssize_t
1051 show_temp_type(struct device *dev, struct device_attribute *devattr,
1052 char *buf)
1053 {
1054 int nr = to_sensor_dev_attr(devattr)->index;
1055 struct w83627hf_data *data = w83627hf_update_device(dev);
1056 return sprintf(buf, "%ld\n", (long) data->sens[nr]);
1057 }
1058
1059 static ssize_t
1060 store_temp_type(struct device *dev, struct device_attribute *devattr,
1061 const char *buf, size_t count)
1062 {
1063 int nr = to_sensor_dev_attr(devattr)->index;
1064 struct w83627hf_data *data = dev_get_drvdata(dev);
1065 u32 val, tmp;
1066
1067 val = simple_strtoul(buf, NULL, 10);
1068
1069 mutex_lock(&data->update_lock);
1070
1071 switch (val) {
1072 case 1: /* PII/Celeron diode */
1073 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1074 w83627hf_write_value(data, W83781D_REG_SCFG1,
1075 tmp | BIT_SCFG1[nr]);
1076 tmp = w83627hf_read_value(data, W83781D_REG_SCFG2);
1077 w83627hf_write_value(data, W83781D_REG_SCFG2,
1078 tmp | BIT_SCFG2[nr]);
1079 data->sens[nr] = val;
1080 break;
1081 case 2: /* 3904 */
1082 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1083 w83627hf_write_value(data, W83781D_REG_SCFG1,
1084 tmp | BIT_SCFG1[nr]);
1085 tmp = w83627hf_read_value(data, W83781D_REG_SCFG2);
1086 w83627hf_write_value(data, W83781D_REG_SCFG2,
1087 tmp & ~BIT_SCFG2[nr]);
1088 data->sens[nr] = val;
1089 break;
1090 case W83781D_DEFAULT_BETA:
1091 dev_warn(dev, "Sensor type %d is deprecated, please use 4 "
1092 "instead\n", W83781D_DEFAULT_BETA);
1093 /* fall through */
1094 case 4: /* thermistor */
1095 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1096 w83627hf_write_value(data, W83781D_REG_SCFG1,
1097 tmp & ~BIT_SCFG1[nr]);
1098 data->sens[nr] = val;
1099 break;
1100 default:
1101 dev_err(dev,
1102 "Invalid sensor type %ld; must be 1, 2, or 4\n",
1103 (long) val);
1104 break;
1105 }
1106
1107 mutex_unlock(&data->update_lock);
1108 return count;
1109 }
1110
1111 #define sysfs_temp_type(offset) \
1112 static SENSOR_DEVICE_ATTR(temp##offset##_type, S_IRUGO | S_IWUSR, \
1113 show_temp_type, store_temp_type, offset - 1);
1114
1115 sysfs_temp_type(1);
1116 sysfs_temp_type(2);
1117 sysfs_temp_type(3);
1118
1119 static ssize_t
1120 show_name(struct device *dev, struct device_attribute *devattr, char *buf)
1121 {
1122 struct w83627hf_data *data = dev_get_drvdata(dev);
1123
1124 return sprintf(buf, "%s\n", data->name);
1125 }
1126 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1127
1128 static int __init w83627hf_find(int sioaddr, unsigned short *addr,
1129 struct w83627hf_sio_data *sio_data)
1130 {
1131 int err = -ENODEV;
1132 u16 val;
1133
1134 static const __initdata char *names[] = {
1135 "W83627HF",
1136 "W83627THF",
1137 "W83697HF",
1138 "W83637HF",
1139 "W83687THF",
1140 };
1141
1142 REG = sioaddr;
1143 VAL = sioaddr + 1;
1144
1145 superio_enter();
1146 val = force_id ? force_id : superio_inb(DEVID);
1147 switch (val) {
1148 case W627_DEVID:
1149 sio_data->type = w83627hf;
1150 break;
1151 case W627THF_DEVID:
1152 sio_data->type = w83627thf;
1153 break;
1154 case W697_DEVID:
1155 sio_data->type = w83697hf;
1156 break;
1157 case W637_DEVID:
1158 sio_data->type = w83637hf;
1159 break;
1160 case W687THF_DEVID:
1161 sio_data->type = w83687thf;
1162 break;
1163 case 0xff: /* No device at all */
1164 goto exit;
1165 default:
1166 pr_debug(DRVNAME ": Unsupported chip (DEVID=0x%02x)\n", val);
1167 goto exit;
1168 }
1169
1170 superio_select(W83627HF_LD_HWM);
1171 force_addr &= WINB_ALIGNMENT;
1172 if (force_addr) {
1173 printk(KERN_WARNING DRVNAME ": Forcing address 0x%x\n",
1174 force_addr);
1175 superio_outb(WINB_BASE_REG, force_addr >> 8);
1176 superio_outb(WINB_BASE_REG + 1, force_addr & 0xff);
1177 }
1178 val = (superio_inb(WINB_BASE_REG) << 8) |
1179 superio_inb(WINB_BASE_REG + 1);
1180 *addr = val & WINB_ALIGNMENT;
1181 if (*addr == 0) {
1182 printk(KERN_WARNING DRVNAME ": Base address not set, "
1183 "skipping\n");
1184 goto exit;
1185 }
1186
1187 val = superio_inb(WINB_ACT_REG);
1188 if (!(val & 0x01)) {
1189 printk(KERN_WARNING DRVNAME ": Enabling HWM logical device\n");
1190 superio_outb(WINB_ACT_REG, val | 0x01);
1191 }
1192
1193 err = 0;
1194 pr_info(DRVNAME ": Found %s chip at %#x\n",
1195 names[sio_data->type], *addr);
1196
1197 exit:
1198 superio_exit();
1199 return err;
1200 }
1201
1202 #define VIN_UNIT_ATTRS(_X_) \
1203 &sensor_dev_attr_in##_X_##_input.dev_attr.attr, \
1204 &sensor_dev_attr_in##_X_##_min.dev_attr.attr, \
1205 &sensor_dev_attr_in##_X_##_max.dev_attr.attr, \
1206 &sensor_dev_attr_in##_X_##_alarm.dev_attr.attr, \
1207 &sensor_dev_attr_in##_X_##_beep.dev_attr.attr
1208
1209 #define FAN_UNIT_ATTRS(_X_) \
1210 &sensor_dev_attr_fan##_X_##_input.dev_attr.attr, \
1211 &sensor_dev_attr_fan##_X_##_min.dev_attr.attr, \
1212 &sensor_dev_attr_fan##_X_##_div.dev_attr.attr, \
1213 &sensor_dev_attr_fan##_X_##_alarm.dev_attr.attr, \
1214 &sensor_dev_attr_fan##_X_##_beep.dev_attr.attr
1215
1216 #define TEMP_UNIT_ATTRS(_X_) \
1217 &sensor_dev_attr_temp##_X_##_input.dev_attr.attr, \
1218 &sensor_dev_attr_temp##_X_##_max.dev_attr.attr, \
1219 &sensor_dev_attr_temp##_X_##_max_hyst.dev_attr.attr, \
1220 &sensor_dev_attr_temp##_X_##_type.dev_attr.attr, \
1221 &sensor_dev_attr_temp##_X_##_alarm.dev_attr.attr, \
1222 &sensor_dev_attr_temp##_X_##_beep.dev_attr.attr
1223
1224 static struct attribute *w83627hf_attributes[] = {
1225 &dev_attr_in0_input.attr,
1226 &dev_attr_in0_min.attr,
1227 &dev_attr_in0_max.attr,
1228 &sensor_dev_attr_in0_alarm.dev_attr.attr,
1229 &sensor_dev_attr_in0_beep.dev_attr.attr,
1230 VIN_UNIT_ATTRS(2),
1231 VIN_UNIT_ATTRS(3),
1232 VIN_UNIT_ATTRS(4),
1233 VIN_UNIT_ATTRS(7),
1234 VIN_UNIT_ATTRS(8),
1235
1236 FAN_UNIT_ATTRS(1),
1237 FAN_UNIT_ATTRS(2),
1238
1239 TEMP_UNIT_ATTRS(1),
1240 TEMP_UNIT_ATTRS(2),
1241
1242 &dev_attr_alarms.attr,
1243 &sensor_dev_attr_beep_enable.dev_attr.attr,
1244 &dev_attr_beep_mask.attr,
1245
1246 &sensor_dev_attr_pwm1.dev_attr.attr,
1247 &sensor_dev_attr_pwm2.dev_attr.attr,
1248 &dev_attr_name.attr,
1249 NULL
1250 };
1251
1252 static const struct attribute_group w83627hf_group = {
1253 .attrs = w83627hf_attributes,
1254 };
1255
1256 static struct attribute *w83627hf_attributes_opt[] = {
1257 VIN_UNIT_ATTRS(1),
1258 VIN_UNIT_ATTRS(5),
1259 VIN_UNIT_ATTRS(6),
1260
1261 FAN_UNIT_ATTRS(3),
1262 TEMP_UNIT_ATTRS(3),
1263 &sensor_dev_attr_pwm3.dev_attr.attr,
1264
1265 &sensor_dev_attr_pwm1_freq.dev_attr.attr,
1266 &sensor_dev_attr_pwm2_freq.dev_attr.attr,
1267 &sensor_dev_attr_pwm3_freq.dev_attr.attr,
1268
1269 &sensor_dev_attr_pwm1_enable.dev_attr.attr,
1270 &sensor_dev_attr_pwm2_enable.dev_attr.attr,
1271 &sensor_dev_attr_pwm3_enable.dev_attr.attr,
1272
1273 NULL
1274 };
1275
1276 static const struct attribute_group w83627hf_group_opt = {
1277 .attrs = w83627hf_attributes_opt,
1278 };
1279
1280 static int __devinit w83627hf_probe(struct platform_device *pdev)
1281 {
1282 struct device *dev = &pdev->dev;
1283 struct w83627hf_sio_data *sio_data = dev->platform_data;
1284 struct w83627hf_data *data;
1285 struct resource *res;
1286 int err, i;
1287
1288 static const char *names[] = {
1289 "w83627hf",
1290 "w83627thf",
1291 "w83697hf",
1292 "w83637hf",
1293 "w83687thf",
1294 };
1295
1296 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1297 if (!request_region(res->start, WINB_REGION_SIZE, DRVNAME)) {
1298 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1299 (unsigned long)res->start,
1300 (unsigned long)(res->start + WINB_REGION_SIZE - 1));
1301 err = -EBUSY;
1302 goto ERROR0;
1303 }
1304
1305 if (!(data = kzalloc(sizeof(struct w83627hf_data), GFP_KERNEL))) {
1306 err = -ENOMEM;
1307 goto ERROR1;
1308 }
1309 data->addr = res->start;
1310 data->type = sio_data->type;
1311 data->name = names[sio_data->type];
1312 mutex_init(&data->lock);
1313 mutex_init(&data->update_lock);
1314 platform_set_drvdata(pdev, data);
1315
1316 /* Initialize the chip */
1317 w83627hf_init_device(pdev);
1318
1319 /* A few vars need to be filled upon startup */
1320 for (i = 0; i <= 2; i++)
1321 data->fan_min[i] = w83627hf_read_value(
1322 data, W83627HF_REG_FAN_MIN(i));
1323 w83627hf_update_fan_div(data);
1324
1325 /* Register common device attributes */
1326 if ((err = sysfs_create_group(&dev->kobj, &w83627hf_group)))
1327 goto ERROR3;
1328
1329 /* Register chip-specific device attributes */
1330 if (data->type == w83627hf || data->type == w83697hf)
1331 if ((err = device_create_file(dev,
1332 &sensor_dev_attr_in5_input.dev_attr))
1333 || (err = device_create_file(dev,
1334 &sensor_dev_attr_in5_min.dev_attr))
1335 || (err = device_create_file(dev,
1336 &sensor_dev_attr_in5_max.dev_attr))
1337 || (err = device_create_file(dev,
1338 &sensor_dev_attr_in5_alarm.dev_attr))
1339 || (err = device_create_file(dev,
1340 &sensor_dev_attr_in5_beep.dev_attr))
1341 || (err = device_create_file(dev,
1342 &sensor_dev_attr_in6_input.dev_attr))
1343 || (err = device_create_file(dev,
1344 &sensor_dev_attr_in6_min.dev_attr))
1345 || (err = device_create_file(dev,
1346 &sensor_dev_attr_in6_max.dev_attr))
1347 || (err = device_create_file(dev,
1348 &sensor_dev_attr_in6_alarm.dev_attr))
1349 || (err = device_create_file(dev,
1350 &sensor_dev_attr_in6_beep.dev_attr))
1351 || (err = device_create_file(dev,
1352 &sensor_dev_attr_pwm1_freq.dev_attr))
1353 || (err = device_create_file(dev,
1354 &sensor_dev_attr_pwm2_freq.dev_attr)))
1355 goto ERROR4;
1356
1357 if (data->type != w83697hf)
1358 if ((err = device_create_file(dev,
1359 &sensor_dev_attr_in1_input.dev_attr))
1360 || (err = device_create_file(dev,
1361 &sensor_dev_attr_in1_min.dev_attr))
1362 || (err = device_create_file(dev,
1363 &sensor_dev_attr_in1_max.dev_attr))
1364 || (err = device_create_file(dev,
1365 &sensor_dev_attr_in1_alarm.dev_attr))
1366 || (err = device_create_file(dev,
1367 &sensor_dev_attr_in1_beep.dev_attr))
1368 || (err = device_create_file(dev,
1369 &sensor_dev_attr_fan3_input.dev_attr))
1370 || (err = device_create_file(dev,
1371 &sensor_dev_attr_fan3_min.dev_attr))
1372 || (err = device_create_file(dev,
1373 &sensor_dev_attr_fan3_div.dev_attr))
1374 || (err = device_create_file(dev,
1375 &sensor_dev_attr_fan3_alarm.dev_attr))
1376 || (err = device_create_file(dev,
1377 &sensor_dev_attr_fan3_beep.dev_attr))
1378 || (err = device_create_file(dev,
1379 &sensor_dev_attr_temp3_input.dev_attr))
1380 || (err = device_create_file(dev,
1381 &sensor_dev_attr_temp3_max.dev_attr))
1382 || (err = device_create_file(dev,
1383 &sensor_dev_attr_temp3_max_hyst.dev_attr))
1384 || (err = device_create_file(dev,
1385 &sensor_dev_attr_temp3_alarm.dev_attr))
1386 || (err = device_create_file(dev,
1387 &sensor_dev_attr_temp3_beep.dev_attr))
1388 || (err = device_create_file(dev,
1389 &sensor_dev_attr_temp3_type.dev_attr)))
1390 goto ERROR4;
1391
1392 if (data->type != w83697hf && data->vid != 0xff) {
1393 /* Convert VID to voltage based on VRM */
1394 data->vrm = vid_which_vrm();
1395
1396 if ((err = device_create_file(dev, &dev_attr_cpu0_vid))
1397 || (err = device_create_file(dev, &dev_attr_vrm)))
1398 goto ERROR4;
1399 }
1400
1401 if (data->type == w83627thf || data->type == w83637hf
1402 || data->type == w83687thf)
1403 if ((err = device_create_file(dev,
1404 &sensor_dev_attr_pwm3.dev_attr)))
1405 goto ERROR4;
1406
1407 if (data->type == w83637hf || data->type == w83687thf)
1408 if ((err = device_create_file(dev,
1409 &sensor_dev_attr_pwm1_freq.dev_attr))
1410 || (err = device_create_file(dev,
1411 &sensor_dev_attr_pwm2_freq.dev_attr))
1412 || (err = device_create_file(dev,
1413 &sensor_dev_attr_pwm3_freq.dev_attr)))
1414 goto ERROR4;
1415
1416 if (data->type != w83627hf)
1417 if ((err = device_create_file(dev,
1418 &sensor_dev_attr_pwm1_enable.dev_attr))
1419 || (err = device_create_file(dev,
1420 &sensor_dev_attr_pwm2_enable.dev_attr)))
1421 goto ERROR4;
1422
1423 if (data->type == w83627thf || data->type == w83637hf
1424 || data->type == w83687thf)
1425 if ((err = device_create_file(dev,
1426 &sensor_dev_attr_pwm3_enable.dev_attr)))
1427 goto ERROR4;
1428
1429 data->hwmon_dev = hwmon_device_register(dev);
1430 if (IS_ERR(data->hwmon_dev)) {
1431 err = PTR_ERR(data->hwmon_dev);
1432 goto ERROR4;
1433 }
1434
1435 return 0;
1436
1437 ERROR4:
1438 sysfs_remove_group(&dev->kobj, &w83627hf_group);
1439 sysfs_remove_group(&dev->kobj, &w83627hf_group_opt);
1440 ERROR3:
1441 platform_set_drvdata(pdev, NULL);
1442 kfree(data);
1443 ERROR1:
1444 release_region(res->start, WINB_REGION_SIZE);
1445 ERROR0:
1446 return err;
1447 }
1448
1449 static int __devexit w83627hf_remove(struct platform_device *pdev)
1450 {
1451 struct w83627hf_data *data = platform_get_drvdata(pdev);
1452 struct resource *res;
1453
1454 hwmon_device_unregister(data->hwmon_dev);
1455
1456 sysfs_remove_group(&pdev->dev.kobj, &w83627hf_group);
1457 sysfs_remove_group(&pdev->dev.kobj, &w83627hf_group_opt);
1458 platform_set_drvdata(pdev, NULL);
1459 kfree(data);
1460
1461 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1462 release_region(res->start, WINB_REGION_SIZE);
1463
1464 return 0;
1465 }
1466
1467
1468 /* Registers 0x50-0x5f are banked */
1469 static inline void w83627hf_set_bank(struct w83627hf_data *data, u16 reg)
1470 {
1471 if ((reg & 0x00f0) == 0x50) {
1472 outb_p(W83781D_REG_BANK, data->addr + W83781D_ADDR_REG_OFFSET);
1473 outb_p(reg >> 8, data->addr + W83781D_DATA_REG_OFFSET);
1474 }
1475 }
1476
1477 /* Not strictly necessary, but play it safe for now */
1478 static inline void w83627hf_reset_bank(struct w83627hf_data *data, u16 reg)
1479 {
1480 if (reg & 0xff00) {
1481 outb_p(W83781D_REG_BANK, data->addr + W83781D_ADDR_REG_OFFSET);
1482 outb_p(0, data->addr + W83781D_DATA_REG_OFFSET);
1483 }
1484 }
1485
1486 static int w83627hf_read_value(struct w83627hf_data *data, u16 reg)
1487 {
1488 int res, word_sized;
1489
1490 mutex_lock(&data->lock);
1491 word_sized = (((reg & 0xff00) == 0x100)
1492 || ((reg & 0xff00) == 0x200))
1493 && (((reg & 0x00ff) == 0x50)
1494 || ((reg & 0x00ff) == 0x53)
1495 || ((reg & 0x00ff) == 0x55));
1496 w83627hf_set_bank(data, reg);
1497 outb_p(reg & 0xff, data->addr + W83781D_ADDR_REG_OFFSET);
1498 res = inb_p(data->addr + W83781D_DATA_REG_OFFSET);
1499 if (word_sized) {
1500 outb_p((reg & 0xff) + 1,
1501 data->addr + W83781D_ADDR_REG_OFFSET);
1502 res =
1503 (res << 8) + inb_p(data->addr +
1504 W83781D_DATA_REG_OFFSET);
1505 }
1506 w83627hf_reset_bank(data, reg);
1507 mutex_unlock(&data->lock);
1508 return res;
1509 }
1510
1511 static int __devinit w83627thf_read_gpio5(struct platform_device *pdev)
1512 {
1513 int res = 0xff, sel;
1514
1515 superio_enter();
1516 superio_select(W83627HF_LD_GPIO5);
1517
1518 /* Make sure these GPIO pins are enabled */
1519 if (!(superio_inb(W83627THF_GPIO5_EN) & (1<<3))) {
1520 dev_dbg(&pdev->dev, "GPIO5 disabled, no VID function\n");
1521 goto exit;
1522 }
1523
1524 /* Make sure the pins are configured for input
1525 There must be at least five (VRM 9), and possibly 6 (VRM 10) */
1526 sel = superio_inb(W83627THF_GPIO5_IOSR) & 0x3f;
1527 if ((sel & 0x1f) != 0x1f) {
1528 dev_dbg(&pdev->dev, "GPIO5 not configured for VID "
1529 "function\n");
1530 goto exit;
1531 }
1532
1533 dev_info(&pdev->dev, "Reading VID from GPIO5\n");
1534 res = superio_inb(W83627THF_GPIO5_DR) & sel;
1535
1536 exit:
1537 superio_exit();
1538 return res;
1539 }
1540
1541 static int __devinit w83687thf_read_vid(struct platform_device *pdev)
1542 {
1543 int res = 0xff;
1544
1545 superio_enter();
1546 superio_select(W83627HF_LD_HWM);
1547
1548 /* Make sure these GPIO pins are enabled */
1549 if (!(superio_inb(W83687THF_VID_EN) & (1 << 2))) {
1550 dev_dbg(&pdev->dev, "VID disabled, no VID function\n");
1551 goto exit;
1552 }
1553
1554 /* Make sure the pins are configured for input */
1555 if (!(superio_inb(W83687THF_VID_CFG) & (1 << 4))) {
1556 dev_dbg(&pdev->dev, "VID configured as output, "
1557 "no VID function\n");
1558 goto exit;
1559 }
1560
1561 res = superio_inb(W83687THF_VID_DATA) & 0x3f;
1562
1563 exit:
1564 superio_exit();
1565 return res;
1566 }
1567
1568 static int w83627hf_write_value(struct w83627hf_data *data, u16 reg, u16 value)
1569 {
1570 int word_sized;
1571
1572 mutex_lock(&data->lock);
1573 word_sized = (((reg & 0xff00) == 0x100)
1574 || ((reg & 0xff00) == 0x200))
1575 && (((reg & 0x00ff) == 0x53)
1576 || ((reg & 0x00ff) == 0x55));
1577 w83627hf_set_bank(data, reg);
1578 outb_p(reg & 0xff, data->addr + W83781D_ADDR_REG_OFFSET);
1579 if (word_sized) {
1580 outb_p(value >> 8,
1581 data->addr + W83781D_DATA_REG_OFFSET);
1582 outb_p((reg & 0xff) + 1,
1583 data->addr + W83781D_ADDR_REG_OFFSET);
1584 }
1585 outb_p(value & 0xff,
1586 data->addr + W83781D_DATA_REG_OFFSET);
1587 w83627hf_reset_bank(data, reg);
1588 mutex_unlock(&data->lock);
1589 return 0;
1590 }
1591
1592 static void __devinit w83627hf_init_device(struct platform_device *pdev)
1593 {
1594 struct w83627hf_data *data = platform_get_drvdata(pdev);
1595 int i;
1596 enum chips type = data->type;
1597 u8 tmp;
1598
1599 /* Minimize conflicts with other winbond i2c-only clients... */
1600 /* disable i2c subclients... how to disable main i2c client?? */
1601 /* force i2c address to relatively uncommon address */
1602 w83627hf_write_value(data, W83781D_REG_I2C_SUBADDR, 0x89);
1603 w83627hf_write_value(data, W83781D_REG_I2C_ADDR, force_i2c);
1604
1605 /* Read VID only once */
1606 if (type == w83627hf || type == w83637hf) {
1607 int lo = w83627hf_read_value(data, W83781D_REG_VID_FANDIV);
1608 int hi = w83627hf_read_value(data, W83781D_REG_CHIPID);
1609 data->vid = (lo & 0x0f) | ((hi & 0x01) << 4);
1610 } else if (type == w83627thf) {
1611 data->vid = w83627thf_read_gpio5(pdev);
1612 } else if (type == w83687thf) {
1613 data->vid = w83687thf_read_vid(pdev);
1614 }
1615
1616 /* Read VRM & OVT Config only once */
1617 if (type == w83627thf || type == w83637hf || type == w83687thf) {
1618 data->vrm_ovt =
1619 w83627hf_read_value(data, W83627THF_REG_VRM_OVT_CFG);
1620 }
1621
1622 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1623 for (i = 1; i <= 3; i++) {
1624 if (!(tmp & BIT_SCFG1[i - 1])) {
1625 data->sens[i - 1] = 4;
1626 } else {
1627 if (w83627hf_read_value
1628 (data,
1629 W83781D_REG_SCFG2) & BIT_SCFG2[i - 1])
1630 data->sens[i - 1] = 1;
1631 else
1632 data->sens[i - 1] = 2;
1633 }
1634 if ((type == w83697hf) && (i == 2))
1635 break;
1636 }
1637
1638 if(init) {
1639 /* Enable temp2 */
1640 tmp = w83627hf_read_value(data, W83627HF_REG_TEMP2_CONFIG);
1641 if (tmp & 0x01) {
1642 dev_warn(&pdev->dev, "Enabling temp2, readings "
1643 "might not make sense\n");
1644 w83627hf_write_value(data, W83627HF_REG_TEMP2_CONFIG,
1645 tmp & 0xfe);
1646 }
1647
1648 /* Enable temp3 */
1649 if (type != w83697hf) {
1650 tmp = w83627hf_read_value(data,
1651 W83627HF_REG_TEMP3_CONFIG);
1652 if (tmp & 0x01) {
1653 dev_warn(&pdev->dev, "Enabling temp3, "
1654 "readings might not make sense\n");
1655 w83627hf_write_value(data,
1656 W83627HF_REG_TEMP3_CONFIG, tmp & 0xfe);
1657 }
1658 }
1659 }
1660
1661 /* Start monitoring */
1662 w83627hf_write_value(data, W83781D_REG_CONFIG,
1663 (w83627hf_read_value(data,
1664 W83781D_REG_CONFIG) & 0xf7)
1665 | 0x01);
1666
1667 /* Enable VBAT monitoring if needed */
1668 tmp = w83627hf_read_value(data, W83781D_REG_VBAT);
1669 if (!(tmp & 0x01))
1670 w83627hf_write_value(data, W83781D_REG_VBAT, tmp | 0x01);
1671 }
1672
1673 static void w83627hf_update_fan_div(struct w83627hf_data *data)
1674 {
1675 int reg;
1676
1677 reg = w83627hf_read_value(data, W83781D_REG_VID_FANDIV);
1678 data->fan_div[0] = (reg >> 4) & 0x03;
1679 data->fan_div[1] = (reg >> 6) & 0x03;
1680 if (data->type != w83697hf) {
1681 data->fan_div[2] = (w83627hf_read_value(data,
1682 W83781D_REG_PIN) >> 6) & 0x03;
1683 }
1684 reg = w83627hf_read_value(data, W83781D_REG_VBAT);
1685 data->fan_div[0] |= (reg >> 3) & 0x04;
1686 data->fan_div[1] |= (reg >> 4) & 0x04;
1687 if (data->type != w83697hf)
1688 data->fan_div[2] |= (reg >> 5) & 0x04;
1689 }
1690
1691 static struct w83627hf_data *w83627hf_update_device(struct device *dev)
1692 {
1693 struct w83627hf_data *data = dev_get_drvdata(dev);
1694 int i, num_temps = (data->type == w83697hf) ? 2 : 3;
1695 int num_pwms = (data->type == w83697hf) ? 2 : 3;
1696
1697 mutex_lock(&data->update_lock);
1698
1699 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
1700 || !data->valid) {
1701 for (i = 0; i <= 8; i++) {
1702 /* skip missing sensors */
1703 if (((data->type == w83697hf) && (i == 1)) ||
1704 ((data->type != w83627hf && data->type != w83697hf)
1705 && (i == 5 || i == 6)))
1706 continue;
1707 data->in[i] =
1708 w83627hf_read_value(data, W83781D_REG_IN(i));
1709 data->in_min[i] =
1710 w83627hf_read_value(data,
1711 W83781D_REG_IN_MIN(i));
1712 data->in_max[i] =
1713 w83627hf_read_value(data,
1714 W83781D_REG_IN_MAX(i));
1715 }
1716 for (i = 0; i <= 2; i++) {
1717 data->fan[i] =
1718 w83627hf_read_value(data, W83627HF_REG_FAN(i));
1719 data->fan_min[i] =
1720 w83627hf_read_value(data,
1721 W83627HF_REG_FAN_MIN(i));
1722 }
1723 for (i = 0; i <= 2; i++) {
1724 u8 tmp = w83627hf_read_value(data,
1725 W836X7HF_REG_PWM(data->type, i));
1726 /* bits 0-3 are reserved in 627THF */
1727 if (data->type == w83627thf)
1728 tmp &= 0xf0;
1729 data->pwm[i] = tmp;
1730 if (i == 1 &&
1731 (data->type == w83627hf || data->type == w83697hf))
1732 break;
1733 }
1734 if (data->type == w83627hf) {
1735 u8 tmp = w83627hf_read_value(data,
1736 W83627HF_REG_PWM_FREQ);
1737 data->pwm_freq[0] = tmp & 0x07;
1738 data->pwm_freq[1] = (tmp >> 4) & 0x07;
1739 } else if (data->type != w83627thf) {
1740 for (i = 1; i <= 3; i++) {
1741 data->pwm_freq[i - 1] =
1742 w83627hf_read_value(data,
1743 W83637HF_REG_PWM_FREQ[i - 1]);
1744 if (i == 2 && (data->type == w83697hf))
1745 break;
1746 }
1747 }
1748 if (data->type != w83627hf) {
1749 for (i = 0; i < num_pwms; i++) {
1750 u8 tmp = w83627hf_read_value(data,
1751 W83627THF_REG_PWM_ENABLE[i]);
1752 data->pwm_enable[i] =
1753 ((tmp >> W83627THF_PWM_ENABLE_SHIFT[i])
1754 & 0x03) + 1;
1755 }
1756 }
1757 for (i = 0; i < num_temps; i++) {
1758 data->temp[i] = w83627hf_read_value(
1759 data, w83627hf_reg_temp[i]);
1760 data->temp_max[i] = w83627hf_read_value(
1761 data, w83627hf_reg_temp_over[i]);
1762 data->temp_max_hyst[i] = w83627hf_read_value(
1763 data, w83627hf_reg_temp_hyst[i]);
1764 }
1765
1766 w83627hf_update_fan_div(data);
1767
1768 data->alarms =
1769 w83627hf_read_value(data, W83781D_REG_ALARM1) |
1770 (w83627hf_read_value(data, W83781D_REG_ALARM2) << 8) |
1771 (w83627hf_read_value(data, W83781D_REG_ALARM3) << 16);
1772 i = w83627hf_read_value(data, W83781D_REG_BEEP_INTS2);
1773 data->beep_mask = (i << 8) |
1774 w83627hf_read_value(data, W83781D_REG_BEEP_INTS1) |
1775 w83627hf_read_value(data, W83781D_REG_BEEP_INTS3) << 16;
1776 data->last_updated = jiffies;
1777 data->valid = 1;
1778 }
1779
1780 mutex_unlock(&data->update_lock);
1781
1782 return data;
1783 }
1784
1785 static int __init w83627hf_device_add(unsigned short address,
1786 const struct w83627hf_sio_data *sio_data)
1787 {
1788 struct resource res = {
1789 .start = address + WINB_REGION_OFFSET,
1790 .end = address + WINB_REGION_OFFSET + WINB_REGION_SIZE - 1,
1791 .name = DRVNAME,
1792 .flags = IORESOURCE_IO,
1793 };
1794 int err;
1795
1796 pdev = platform_device_alloc(DRVNAME, address);
1797 if (!pdev) {
1798 err = -ENOMEM;
1799 printk(KERN_ERR DRVNAME ": Device allocation failed\n");
1800 goto exit;
1801 }
1802
1803 err = platform_device_add_resources(pdev, &res, 1);
1804 if (err) {
1805 printk(KERN_ERR DRVNAME ": Device resource addition failed "
1806 "(%d)\n", err);
1807 goto exit_device_put;
1808 }
1809
1810 err = platform_device_add_data(pdev, sio_data,
1811 sizeof(struct w83627hf_sio_data));
1812 if (err) {
1813 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1814 goto exit_device_put;
1815 }
1816
1817 err = platform_device_add(pdev);
1818 if (err) {
1819 printk(KERN_ERR DRVNAME ": Device addition failed (%d)\n",
1820 err);
1821 goto exit_device_put;
1822 }
1823
1824 return 0;
1825
1826 exit_device_put:
1827 platform_device_put(pdev);
1828 exit:
1829 return err;
1830 }
1831
1832 static int __init sensors_w83627hf_init(void)
1833 {
1834 int err;
1835 unsigned short address;
1836 struct w83627hf_sio_data sio_data;
1837
1838 if (w83627hf_find(0x2e, &address, &sio_data)
1839 && w83627hf_find(0x4e, &address, &sio_data))
1840 return -ENODEV;
1841
1842 err = platform_driver_register(&w83627hf_driver);
1843 if (err)
1844 goto exit;
1845
1846 /* Sets global pdev as a side effect */
1847 err = w83627hf_device_add(address, &sio_data);
1848 if (err)
1849 goto exit_driver;
1850
1851 return 0;
1852
1853 exit_driver:
1854 platform_driver_unregister(&w83627hf_driver);
1855 exit:
1856 return err;
1857 }
1858
1859 static void __exit sensors_w83627hf_exit(void)
1860 {
1861 platform_device_unregister(pdev);
1862 platform_driver_unregister(&w83627hf_driver);
1863 }
1864
1865 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
1866 "Philip Edelbrock <phil@netroedge.com>, "
1867 "and Mark Studebaker <mdsxyz123@yahoo.com>");
1868 MODULE_DESCRIPTION("W83627HF driver");
1869 MODULE_LICENSE("GPL");
1870
1871 module_init(sensors_w83627hf_init);
1872 module_exit(sensors_w83627hf_exit);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree