]> git.karo-electronics.de Git - mv-sheeva.git/blob - drivers/hwmon/w83627ehf.c
hwmon: (w83627ehf) Clean up probe function
[mv-sheeva.git] / drivers / hwmon / w83627ehf.c
1 /*
2     w83627ehf - Driver for the hardware monitoring functionality of
3                 the Winbond W83627EHF Super-I/O chip
4     Copyright (C) 2005  Jean Delvare <khali@linux-fr.org>
5     Copyright (C) 2006  Yuan Mu (Winbond),
6                         Rudolf Marek <r.marek@assembler.cz>
7                         David Hubbard <david.c.hubbard@gmail.com>
8                         Daniel J Blueman <daniel.blueman@gmail.com>
9     Copyright (C) 2010  Sheng-Yuan Huang (Nuvoton) (PS00)
10
11     Shamelessly ripped from the w83627hf driver
12     Copyright (C) 2003  Mark Studebaker
13
14     Thanks to Leon Moonen, Steve Cliffe and Grant Coady for their help
15     in testing and debugging this driver.
16
17     This driver also supports the W83627EHG, which is the lead-free
18     version of the W83627EHF.
19
20     This program is free software; you can redistribute it and/or modify
21     it under the terms of the GNU General Public License as published by
22     the Free Software Foundation; either version 2 of the License, or
23     (at your option) any later version.
24
25     This program is distributed in the hope that it will be useful,
26     but WITHOUT ANY WARRANTY; without even the implied warranty of
27     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
28     GNU General Public License for more details.
29
30     You should have received a copy of the GNU General Public License
31     along with this program; if not, write to the Free Software
32     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
33
34
35     Supports the following chips:
36
37     Chip        #vin    #fan    #pwm    #temp  chip IDs       man ID
38     w83627ehf   10      5       4       3      0x8850 0x88    0x5ca3
39                                                0x8860 0xa1
40     w83627dhg    9      5       4       3      0xa020 0xc1    0x5ca3
41     w83627dhg-p  9      5       4       3      0xb070 0xc1    0x5ca3
42     w83667hg     9      5       3       3      0xa510 0xc1    0x5ca3
43     w83667hg-b   9      5       3       4      0xb350 0xc1    0x5ca3
44     nct6775f     9      4       3       9      0xb470 0xc1    0x5ca3
45     nct6776f     9      5       3       9      0xC330 0xc1    0x5ca3
46 */
47
48 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
49
50 #include <linux/module.h>
51 #include <linux/init.h>
52 #include <linux/slab.h>
53 #include <linux/jiffies.h>
54 #include <linux/platform_device.h>
55 #include <linux/hwmon.h>
56 #include <linux/hwmon-sysfs.h>
57 #include <linux/hwmon-vid.h>
58 #include <linux/err.h>
59 #include <linux/mutex.h>
60 #include <linux/acpi.h>
61 #include <linux/io.h>
62 #include "lm75.h"
63
64 enum kinds { w83627ehf, w83627dhg, w83627dhg_p, w83667hg, w83667hg_b, nct6775,
65         nct6776 };
66
67 /* used to set data->name = w83627ehf_device_names[data->sio_kind] */
68 static const char * const w83627ehf_device_names[] = {
69         "w83627ehf",
70         "w83627dhg",
71         "w83627dhg",
72         "w83667hg",
73         "w83667hg",
74         "nct6775",
75         "nct6776",
76 };
77
78 static unsigned short force_id;
79 module_param(force_id, ushort, 0);
80 MODULE_PARM_DESC(force_id, "Override the detected device ID");
81
82 static unsigned short fan_debounce;
83 module_param(fan_debounce, ushort, 0);
84 MODULE_PARM_DESC(fan_debounce, "Enable debouncing for fan RPM signal");
85
86 #define DRVNAME "w83627ehf"
87
88 /*
89  * Super-I/O constants and functions
90  */
91
92 #define W83627EHF_LD_HWM        0x0b
93 #define W83667HG_LD_VID         0x0d
94
95 #define SIO_REG_LDSEL           0x07    /* Logical device select */
96 #define SIO_REG_DEVID           0x20    /* Device ID (2 bytes) */
97 #define SIO_REG_EN_VRM10        0x2C    /* GPIO3, GPIO4 selection */
98 #define SIO_REG_ENABLE          0x30    /* Logical device enable */
99 #define SIO_REG_ADDR            0x60    /* Logical device address (2 bytes) */
100 #define SIO_REG_VID_CTRL        0xF0    /* VID control */
101 #define SIO_REG_VID_DATA        0xF1    /* VID data */
102
103 #define SIO_W83627EHF_ID        0x8850
104 #define SIO_W83627EHG_ID        0x8860
105 #define SIO_W83627DHG_ID        0xa020
106 #define SIO_W83627DHG_P_ID      0xb070
107 #define SIO_W83667HG_ID         0xa510
108 #define SIO_W83667HG_B_ID       0xb350
109 #define SIO_NCT6775_ID          0xb470
110 #define SIO_NCT6776_ID          0xc330
111 #define SIO_ID_MASK             0xFFF0
112
113 static inline void
114 superio_outb(int ioreg, int reg, int val)
115 {
116         outb(reg, ioreg);
117         outb(val, ioreg + 1);
118 }
119
120 static inline int
121 superio_inb(int ioreg, int reg)
122 {
123         outb(reg, ioreg);
124         return inb(ioreg + 1);
125 }
126
127 static inline void
128 superio_select(int ioreg, int ld)
129 {
130         outb(SIO_REG_LDSEL, ioreg);
131         outb(ld, ioreg + 1);
132 }
133
134 static inline void
135 superio_enter(int ioreg)
136 {
137         outb(0x87, ioreg);
138         outb(0x87, ioreg);
139 }
140
141 static inline void
142 superio_exit(int ioreg)
143 {
144         outb(0xaa, ioreg);
145         outb(0x02, ioreg);
146         outb(0x02, ioreg + 1);
147 }
148
149 /*
150  * ISA constants
151  */
152
153 #define IOREGION_ALIGNMENT      (~7)
154 #define IOREGION_OFFSET         5
155 #define IOREGION_LENGTH         2
156 #define ADDR_REG_OFFSET         0
157 #define DATA_REG_OFFSET         1
158
159 #define W83627EHF_REG_BANK              0x4E
160 #define W83627EHF_REG_CONFIG            0x40
161
162 /* Not currently used:
163  * REG_MAN_ID has the value 0x5ca3 for all supported chips.
164  * REG_CHIP_ID == 0x88/0xa1/0xc1 depending on chip model.
165  * REG_MAN_ID is at port 0x4f
166  * REG_CHIP_ID is at port 0x58 */
167
168 static const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 };
169 static const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c };
170
171 /* The W83627EHF registers for nr=7,8,9 are in bank 5 */
172 #define W83627EHF_REG_IN_MAX(nr)        ((nr < 7) ? (0x2b + (nr) * 2) : \
173                                          (0x554 + (((nr) - 7) * 2)))
174 #define W83627EHF_REG_IN_MIN(nr)        ((nr < 7) ? (0x2c + (nr) * 2) : \
175                                          (0x555 + (((nr) - 7) * 2)))
176 #define W83627EHF_REG_IN(nr)            ((nr < 7) ? (0x20 + (nr)) : \
177                                          (0x550 + (nr) - 7))
178
179 static const u16 W83627EHF_REG_TEMP[] = { 0x27, 0x150, 0x250, 0x7e };
180 static const u16 W83627EHF_REG_TEMP_HYST[] = { 0x3a, 0x153, 0x253, 0 };
181 static const u16 W83627EHF_REG_TEMP_OVER[] = { 0x39, 0x155, 0x255, 0 };
182 static const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0, 0x152, 0x252, 0 };
183
184 /* Fan clock dividers are spread over the following five registers */
185 #define W83627EHF_REG_FANDIV1           0x47
186 #define W83627EHF_REG_FANDIV2           0x4B
187 #define W83627EHF_REG_VBAT              0x5D
188 #define W83627EHF_REG_DIODE             0x59
189 #define W83627EHF_REG_SMI_OVT           0x4C
190
191 /* NCT6775F has its own fan divider registers */
192 #define NCT6775_REG_FANDIV1             0x506
193 #define NCT6775_REG_FANDIV2             0x507
194 #define NCT6775_REG_FAN_DEBOUNCE        0xf0
195
196 #define W83627EHF_REG_ALARM1            0x459
197 #define W83627EHF_REG_ALARM2            0x45A
198 #define W83627EHF_REG_ALARM3            0x45B
199
200 #define W83627EHF_REG_CASEOPEN_DET      0x42 /* SMI STATUS #2 */
201 #define W83627EHF_REG_CASEOPEN_CLR      0x46 /* SMI MASK #3 */
202
203 /* SmartFan registers */
204 #define W83627EHF_REG_FAN_STEPUP_TIME 0x0f
205 #define W83627EHF_REG_FAN_STEPDOWN_TIME 0x0e
206
207 /* DC or PWM output fan configuration */
208 static const u8 W83627EHF_REG_PWM_ENABLE[] = {
209         0x04,                   /* SYS FAN0 output mode and PWM mode */
210         0x04,                   /* CPU FAN0 output mode and PWM mode */
211         0x12,                   /* AUX FAN mode */
212         0x62,                   /* CPU FAN1 mode */
213 };
214
215 static const u8 W83627EHF_PWM_MODE_SHIFT[] = { 0, 1, 0, 6 };
216 static const u8 W83627EHF_PWM_ENABLE_SHIFT[] = { 2, 4, 1, 4 };
217
218 /* FAN Duty Cycle, be used to control */
219 static const u16 W83627EHF_REG_PWM[] = { 0x01, 0x03, 0x11, 0x61 };
220 static const u16 W83627EHF_REG_TARGET[] = { 0x05, 0x06, 0x13, 0x63 };
221 static const u8 W83627EHF_REG_TOLERANCE[] = { 0x07, 0x07, 0x14, 0x62 };
222
223 /* Advanced Fan control, some values are common for all fans */
224 static const u16 W83627EHF_REG_FAN_START_OUTPUT[] = { 0x0a, 0x0b, 0x16, 0x65 };
225 static const u16 W83627EHF_REG_FAN_STOP_OUTPUT[] = { 0x08, 0x09, 0x15, 0x64 };
226 static const u16 W83627EHF_REG_FAN_STOP_TIME[] = { 0x0c, 0x0d, 0x17, 0x66 };
227
228 static const u16 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON[]
229                                                 = { 0xff, 0x67, 0xff, 0x69 };
230 static const u16 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON[]
231                                                 = { 0xff, 0x68, 0xff, 0x6a };
232
233 static const u16 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B[] = { 0x67, 0x69, 0x6b };
234 static const u16 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B[]
235                                                 = { 0x68, 0x6a, 0x6c };
236
237 static const u16 NCT6775_REG_TARGET[] = { 0x101, 0x201, 0x301 };
238 static const u16 NCT6775_REG_FAN_MODE[] = { 0x102, 0x202, 0x302 };
239 static const u16 NCT6775_REG_FAN_STOP_OUTPUT[] = { 0x105, 0x205, 0x305 };
240 static const u16 NCT6775_REG_FAN_START_OUTPUT[] = { 0x106, 0x206, 0x306 };
241 static const u16 NCT6775_REG_FAN_STOP_TIME[] = { 0x107, 0x207, 0x307 };
242 static const u16 NCT6775_REG_PWM[] = { 0x109, 0x209, 0x309 };
243 static const u16 NCT6775_REG_FAN_MAX_OUTPUT[] = { 0x10a, 0x20a, 0x30a };
244 static const u16 NCT6775_REG_FAN_STEP_OUTPUT[] = { 0x10b, 0x20b, 0x30b };
245 static const u16 NCT6775_REG_FAN[] = { 0x630, 0x632, 0x634, 0x636, 0x638 };
246 static const u16 NCT6776_REG_FAN_MIN[] = { 0x63a, 0x63c, 0x63e, 0x640, 0x642};
247
248 static const u16 NCT6775_REG_TEMP[]
249         = { 0x27, 0x150, 0x250, 0x73, 0x75, 0x77, 0x62b, 0x62c, 0x62d };
250 static const u16 NCT6775_REG_TEMP_CONFIG[]
251         = { 0, 0x152, 0x252, 0, 0, 0, 0x628, 0x629, 0x62A };
252 static const u16 NCT6775_REG_TEMP_HYST[]
253         = { 0x3a, 0x153, 0x253, 0, 0, 0, 0x673, 0x678, 0x67D };
254 static const u16 NCT6775_REG_TEMP_OVER[]
255         = { 0x39, 0x155, 0x255, 0, 0, 0, 0x672, 0x677, 0x67C };
256 static const u16 NCT6775_REG_TEMP_SOURCE[]
257         = { 0x621, 0x622, 0x623, 0x100, 0x200, 0x300, 0x624, 0x625, 0x626 };
258
259 static const char *const w83667hg_b_temp_label[] = {
260         "SYSTIN",
261         "CPUTIN",
262         "AUXTIN",
263         "AMDTSI",
264         "PECI Agent 1",
265         "PECI Agent 2",
266         "PECI Agent 3",
267         "PECI Agent 4"
268 };
269
270 static const char *const nct6775_temp_label[] = {
271         "",
272         "SYSTIN",
273         "CPUTIN",
274         "AUXTIN",
275         "AMD SB-TSI",
276         "PECI Agent 0",
277         "PECI Agent 1",
278         "PECI Agent 2",
279         "PECI Agent 3",
280         "PECI Agent 4",
281         "PECI Agent 5",
282         "PECI Agent 6",
283         "PECI Agent 7",
284         "PCH_CHIP_CPU_MAX_TEMP",
285         "PCH_CHIP_TEMP",
286         "PCH_CPU_TEMP",
287         "PCH_MCH_TEMP",
288         "PCH_DIM0_TEMP",
289         "PCH_DIM1_TEMP",
290         "PCH_DIM2_TEMP",
291         "PCH_DIM3_TEMP"
292 };
293
294 static const char *const nct6776_temp_label[] = {
295         "",
296         "SYSTIN",
297         "CPUTIN",
298         "AUXTIN",
299         "SMBUSMASTER 0",
300         "SMBUSMASTER 1",
301         "SMBUSMASTER 2",
302         "SMBUSMASTER 3",
303         "SMBUSMASTER 4",
304         "SMBUSMASTER 5",
305         "SMBUSMASTER 6",
306         "SMBUSMASTER 7",
307         "PECI Agent 0",
308         "PECI Agent 1",
309         "PCH_CHIP_CPU_MAX_TEMP",
310         "PCH_CHIP_TEMP",
311         "PCH_CPU_TEMP",
312         "PCH_MCH_TEMP",
313         "PCH_DIM0_TEMP",
314         "PCH_DIM1_TEMP",
315         "PCH_DIM2_TEMP",
316         "PCH_DIM3_TEMP",
317         "BYTE_TEMP"
318 };
319
320 #define NUM_REG_TEMP    ARRAY_SIZE(NCT6775_REG_TEMP)
321
322 static int is_word_sized(u16 reg)
323 {
324         return ((((reg & 0xff00) == 0x100
325               || (reg & 0xff00) == 0x200)
326              && ((reg & 0x00ff) == 0x50
327               || (reg & 0x00ff) == 0x53
328               || (reg & 0x00ff) == 0x55))
329              || (reg & 0xfff0) == 0x630
330              || reg == 0x640 || reg == 0x642
331              || ((reg & 0xfff0) == 0x650
332                  && (reg & 0x000f) >= 0x06)
333              || reg == 0x73 || reg == 0x75 || reg == 0x77
334                 );
335 }
336
337 /*
338  * Conversions
339  */
340
341 /* 1 is PWM mode, output in ms */
342 static inline unsigned int step_time_from_reg(u8 reg, u8 mode)
343 {
344         return mode ? 100 * reg : 400 * reg;
345 }
346
347 static inline u8 step_time_to_reg(unsigned int msec, u8 mode)
348 {
349         return SENSORS_LIMIT((mode ? (msec + 50) / 100 :
350                                                 (msec + 200) / 400), 1, 255);
351 }
352
353 static unsigned int fan_from_reg8(u16 reg, unsigned int divreg)
354 {
355         if (reg == 0 || reg == 255)
356                 return 0;
357         return 1350000U / (reg << divreg);
358 }
359
360 static unsigned int fan_from_reg13(u16 reg, unsigned int divreg)
361 {
362         if ((reg & 0xff1f) == 0xff1f)
363                 return 0;
364
365         reg = (reg & 0x1f) | ((reg & 0xff00) >> 3);
366
367         if (reg == 0)
368                 return 0;
369
370         return 1350000U / reg;
371 }
372
373 static unsigned int fan_from_reg16(u16 reg, unsigned int divreg)
374 {
375         if (reg == 0 || reg == 0xffff)
376                 return 0;
377
378         /*
379          * Even though the registers are 16 bit wide, the fan divisor
380          * still applies.
381          */
382         return 1350000U / (reg << divreg);
383 }
384
385 static inline unsigned int
386 div_from_reg(u8 reg)
387 {
388         return 1 << reg;
389 }
390
391 /* Some of analog inputs have internal scaling (2x), 8mV is ADC LSB */
392
393 static u8 scale_in[10] = { 8, 8, 16, 16, 8, 8, 8, 16, 16, 8 };
394
395 static inline long in_from_reg(u8 reg, u8 nr)
396 {
397         return reg * scale_in[nr];
398 }
399
400 static inline u8 in_to_reg(u32 val, u8 nr)
401 {
402         return SENSORS_LIMIT(((val + (scale_in[nr] / 2)) / scale_in[nr]), 0,
403                              255);
404 }
405
406 /*
407  * Data structures and manipulation thereof
408  */
409
410 struct w83627ehf_data {
411         int addr;       /* IO base of hw monitor block */
412         const char *name;
413
414         struct device *hwmon_dev;
415         struct mutex lock;
416
417         u16 reg_temp[NUM_REG_TEMP];
418         u16 reg_temp_over[NUM_REG_TEMP];
419         u16 reg_temp_hyst[NUM_REG_TEMP];
420         u16 reg_temp_config[NUM_REG_TEMP];
421         u8 temp_src[NUM_REG_TEMP];
422         const char * const *temp_label;
423
424         const u16 *REG_PWM;
425         const u16 *REG_TARGET;
426         const u16 *REG_FAN;
427         const u16 *REG_FAN_MIN;
428         const u16 *REG_FAN_START_OUTPUT;
429         const u16 *REG_FAN_STOP_OUTPUT;
430         const u16 *REG_FAN_STOP_TIME;
431         const u16 *REG_FAN_MAX_OUTPUT;
432         const u16 *REG_FAN_STEP_OUTPUT;
433
434         unsigned int (*fan_from_reg)(u16 reg, unsigned int divreg);
435         unsigned int (*fan_from_reg_min)(u16 reg, unsigned int divreg);
436
437         struct mutex update_lock;
438         char valid;             /* !=0 if following fields are valid */
439         unsigned long last_updated;     /* In jiffies */
440
441         /* Register values */
442         u8 bank;                /* current register bank */
443         u8 in_num;              /* number of in inputs we have */
444         u8 in[10];              /* Register value */
445         u8 in_max[10];          /* Register value */
446         u8 in_min[10];          /* Register value */
447         unsigned int rpm[5];
448         u16 fan_min[5];
449         u8 fan_div[5];
450         u8 has_fan;             /* some fan inputs can be disabled */
451         u8 has_fan_min;         /* some fans don't have min register */
452         bool has_fan_div;
453         u8 temp_type[3];
454         s16 temp[9];
455         s16 temp_max[9];
456         s16 temp_max_hyst[9];
457         u32 alarms;
458         u8 caseopen;
459
460         u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */
461         u8 pwm_enable[4]; /* 1->manual
462                              2->thermal cruise mode (also called SmartFan I)
463                              3->fan speed cruise mode
464                              4->variable thermal cruise (also called
465                                 SmartFan III)
466                              5->enhanced variable thermal cruise (also called
467                                 SmartFan IV) */
468         u8 pwm_enable_orig[4];  /* original value of pwm_enable */
469         u8 pwm_num;             /* number of pwm */
470         u8 pwm[4];
471         u8 target_temp[4];
472         u8 tolerance[4];
473
474         u8 fan_start_output[4]; /* minimum fan speed when spinning up */
475         u8 fan_stop_output[4]; /* minimum fan speed when spinning down */
476         u8 fan_stop_time[4]; /* time at minimum before disabling fan */
477         u8 fan_max_output[4]; /* maximum fan speed */
478         u8 fan_step_output[4]; /* rate of change output value */
479
480         u8 vid;
481         u8 vrm;
482
483         u16 have_temp;
484         u8 in6_skip;
485 };
486
487 struct w83627ehf_sio_data {
488         int sioreg;
489         enum kinds kind;
490 };
491
492 /*
493  * On older chips, only registers 0x50-0x5f are banked.
494  * On more recent chips, all registers are banked.
495  * Assume that is the case and set the bank number for each access.
496  * Cache the bank number so it only needs to be set if it changes.
497  */
498 static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg)
499 {
500         u8 bank = reg >> 8;
501         if (data->bank != bank) {
502                 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
503                 outb_p(bank, data->addr + DATA_REG_OFFSET);
504                 data->bank = bank;
505         }
506 }
507
508 static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg)
509 {
510         int res, word_sized = is_word_sized(reg);
511
512         mutex_lock(&data->lock);
513
514         w83627ehf_set_bank(data, reg);
515         outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
516         res = inb_p(data->addr + DATA_REG_OFFSET);
517         if (word_sized) {
518                 outb_p((reg & 0xff) + 1,
519                        data->addr + ADDR_REG_OFFSET);
520                 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
521         }
522
523         mutex_unlock(&data->lock);
524         return res;
525 }
526
527 static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg,
528                                  u16 value)
529 {
530         int word_sized = is_word_sized(reg);
531
532         mutex_lock(&data->lock);
533
534         w83627ehf_set_bank(data, reg);
535         outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
536         if (word_sized) {
537                 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
538                 outb_p((reg & 0xff) + 1,
539                        data->addr + ADDR_REG_OFFSET);
540         }
541         outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
542
543         mutex_unlock(&data->lock);
544         return 0;
545 }
546
547 /* We left-align 8-bit temperature values to make the code simpler */
548 static u16 w83627ehf_read_temp(struct w83627ehf_data *data, u16 reg)
549 {
550         u16 res;
551
552         res = w83627ehf_read_value(data, reg);
553         if (!is_word_sized(reg))
554                 res <<= 8;
555
556         return res;
557 }
558
559 static int w83627ehf_write_temp(struct w83627ehf_data *data, u16 reg,
560                                        u16 value)
561 {
562         if (!is_word_sized(reg))
563                 value >>= 8;
564         return w83627ehf_write_value(data, reg, value);
565 }
566
567 /* This function assumes that the caller holds data->update_lock */
568 static void nct6775_write_fan_div(struct w83627ehf_data *data, int nr)
569 {
570         u8 reg;
571
572         switch (nr) {
573         case 0:
574                 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV1) & 0x70)
575                     | (data->fan_div[0] & 0x7);
576                 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, reg);
577                 break;
578         case 1:
579                 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV1) & 0x7)
580                     | ((data->fan_div[1] << 4) & 0x70);
581                 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, reg);
582         case 2:
583                 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV2) & 0x70)
584                     | (data->fan_div[2] & 0x7);
585                 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, reg);
586                 break;
587         case 3:
588                 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV2) & 0x7)
589                     | ((data->fan_div[3] << 4) & 0x70);
590                 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, reg);
591                 break;
592         }
593 }
594
595 /* This function assumes that the caller holds data->update_lock */
596 static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr)
597 {
598         u8 reg;
599
600         switch (nr) {
601         case 0:
602                 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf)
603                     | ((data->fan_div[0] & 0x03) << 4);
604                 /* fan5 input control bit is write only, compute the value */
605                 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
606                 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
607                 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf)
608                     | ((data->fan_div[0] & 0x04) << 3);
609                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
610                 break;
611         case 1:
612                 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f)
613                     | ((data->fan_div[1] & 0x03) << 6);
614                 /* fan5 input control bit is write only, compute the value */
615                 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
616                 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
617                 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf)
618                     | ((data->fan_div[1] & 0x04) << 4);
619                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
620                 break;
621         case 2:
622                 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f)
623                     | ((data->fan_div[2] & 0x03) << 6);
624                 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg);
625                 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f)
626                     | ((data->fan_div[2] & 0x04) << 5);
627                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
628                 break;
629         case 3:
630                 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc)
631                     | (data->fan_div[3] & 0x03);
632                 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
633                 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f)
634                     | ((data->fan_div[3] & 0x04) << 5);
635                 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg);
636                 break;
637         case 4:
638                 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73)
639                     | ((data->fan_div[4] & 0x03) << 2)
640                     | ((data->fan_div[4] & 0x04) << 5);
641                 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
642                 break;
643         }
644 }
645
646 static void w83627ehf_write_fan_div_common(struct device *dev,
647                                            struct w83627ehf_data *data, int nr)
648 {
649         struct w83627ehf_sio_data *sio_data = dev->platform_data;
650
651         if (sio_data->kind == nct6776)
652                 ; /* no dividers, do nothing */
653         else if (sio_data->kind == nct6775)
654                 nct6775_write_fan_div(data, nr);
655         else
656                 w83627ehf_write_fan_div(data, nr);
657 }
658
659 static void nct6775_update_fan_div(struct w83627ehf_data *data)
660 {
661         u8 i;
662
663         i = w83627ehf_read_value(data, NCT6775_REG_FANDIV1);
664         data->fan_div[0] = i & 0x7;
665         data->fan_div[1] = (i & 0x70) >> 4;
666         i = w83627ehf_read_value(data, NCT6775_REG_FANDIV2);
667         data->fan_div[2] = i & 0x7;
668         if (data->has_fan & (1<<3))
669                 data->fan_div[3] = (i & 0x70) >> 4;
670 }
671
672 static void w83627ehf_update_fan_div(struct w83627ehf_data *data)
673 {
674         int i;
675
676         i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
677         data->fan_div[0] = (i >> 4) & 0x03;
678         data->fan_div[1] = (i >> 6) & 0x03;
679         i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2);
680         data->fan_div[2] = (i >> 6) & 0x03;
681         i = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
682         data->fan_div[0] |= (i >> 3) & 0x04;
683         data->fan_div[1] |= (i >> 4) & 0x04;
684         data->fan_div[2] |= (i >> 5) & 0x04;
685         if (data->has_fan & ((1 << 3) | (1 << 4))) {
686                 i = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
687                 data->fan_div[3] = i & 0x03;
688                 data->fan_div[4] = ((i >> 2) & 0x03)
689                                  | ((i >> 5) & 0x04);
690         }
691         if (data->has_fan & (1 << 3)) {
692                 i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT);
693                 data->fan_div[3] |= (i >> 5) & 0x04;
694         }
695 }
696
697 static void w83627ehf_update_fan_div_common(struct device *dev,
698                                             struct w83627ehf_data *data)
699 {
700         struct w83627ehf_sio_data *sio_data = dev->platform_data;
701
702         if (sio_data->kind == nct6776)
703                 ; /* no dividers, do nothing */
704         else if (sio_data->kind == nct6775)
705                 nct6775_update_fan_div(data);
706         else
707                 w83627ehf_update_fan_div(data);
708 }
709
710 static void nct6775_update_pwm(struct w83627ehf_data *data)
711 {
712         int i;
713         int pwmcfg, fanmodecfg;
714
715         for (i = 0; i < data->pwm_num; i++) {
716                 pwmcfg = w83627ehf_read_value(data,
717                                               W83627EHF_REG_PWM_ENABLE[i]);
718                 fanmodecfg = w83627ehf_read_value(data,
719                                                   NCT6775_REG_FAN_MODE[i]);
720                 data->pwm_mode[i] =
721                   ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1) ? 0 : 1;
722                 data->pwm_enable[i] = ((fanmodecfg >> 4) & 7) + 1;
723                 data->tolerance[i] = fanmodecfg & 0x0f;
724                 data->pwm[i] = w83627ehf_read_value(data, data->REG_PWM[i]);
725         }
726 }
727
728 static void w83627ehf_update_pwm(struct w83627ehf_data *data)
729 {
730         int i;
731         int pwmcfg = 0, tolerance = 0; /* shut up the compiler */
732
733         for (i = 0; i < data->pwm_num; i++) {
734                 if (!(data->has_fan & (1 << i)))
735                         continue;
736
737                 /* pwmcfg, tolerance mapped for i=0, i=1 to same reg */
738                 if (i != 1) {
739                         pwmcfg = w83627ehf_read_value(data,
740                                         W83627EHF_REG_PWM_ENABLE[i]);
741                         tolerance = w83627ehf_read_value(data,
742                                         W83627EHF_REG_TOLERANCE[i]);
743                 }
744                 data->pwm_mode[i] =
745                         ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1) ? 0 : 1;
746                 data->pwm_enable[i] = ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i])
747                                        & 3) + 1;
748                 data->pwm[i] = w83627ehf_read_value(data, data->REG_PWM[i]);
749
750                 data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0)) & 0x0f;
751         }
752 }
753
754 static void w83627ehf_update_pwm_common(struct device *dev,
755                                         struct w83627ehf_data *data)
756 {
757         struct w83627ehf_sio_data *sio_data = dev->platform_data;
758
759         if (sio_data->kind == nct6775 || sio_data->kind == nct6776)
760                 nct6775_update_pwm(data);
761         else
762                 w83627ehf_update_pwm(data);
763 }
764
765 static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
766 {
767         struct w83627ehf_data *data = dev_get_drvdata(dev);
768         struct w83627ehf_sio_data *sio_data = dev->platform_data;
769
770         int i;
771
772         mutex_lock(&data->update_lock);
773
774         if (time_after(jiffies, data->last_updated + HZ + HZ/2)
775          || !data->valid) {
776                 /* Fan clock dividers */
777                 w83627ehf_update_fan_div_common(dev, data);
778
779                 /* Measured voltages and limits */
780                 for (i = 0; i < data->in_num; i++) {
781                         if ((i == 6) && data->in6_skip)
782                                 continue;
783
784                         data->in[i] = w83627ehf_read_value(data,
785                                       W83627EHF_REG_IN(i));
786                         data->in_min[i] = w83627ehf_read_value(data,
787                                           W83627EHF_REG_IN_MIN(i));
788                         data->in_max[i] = w83627ehf_read_value(data,
789                                           W83627EHF_REG_IN_MAX(i));
790                 }
791
792                 /* Measured fan speeds and limits */
793                 for (i = 0; i < 5; i++) {
794                         u16 reg;
795
796                         if (!(data->has_fan & (1 << i)))
797                                 continue;
798
799                         reg = w83627ehf_read_value(data, data->REG_FAN[i]);
800                         data->rpm[i] = data->fan_from_reg(reg,
801                                                           data->fan_div[i]);
802
803                         if (data->has_fan_min & (1 << i))
804                                 data->fan_min[i] = w83627ehf_read_value(data,
805                                            data->REG_FAN_MIN[i]);
806
807                         /* If we failed to measure the fan speed and clock
808                            divider can be increased, let's try that for next
809                            time */
810                         if (data->has_fan_div
811                             && (reg >= 0xff || (sio_data->kind == nct6775
812                                                 && reg == 0x00))
813                             && data->fan_div[i] < 0x07) {
814                                 dev_dbg(dev, "Increasing fan%d "
815                                         "clock divider from %u to %u\n",
816                                         i + 1, div_from_reg(data->fan_div[i]),
817                                         div_from_reg(data->fan_div[i] + 1));
818                                 data->fan_div[i]++;
819                                 w83627ehf_write_fan_div_common(dev, data, i);
820                                 /* Preserve min limit if possible */
821                                 if ((data->has_fan_min & (1 << i))
822                                  && data->fan_min[i] >= 2
823                                  && data->fan_min[i] != 255)
824                                         w83627ehf_write_value(data,
825                                                 data->REG_FAN_MIN[i],
826                                                 (data->fan_min[i] /= 2));
827                         }
828                 }
829
830                 w83627ehf_update_pwm_common(dev, data);
831
832                 for (i = 0; i < data->pwm_num; i++) {
833                         if (!(data->has_fan & (1 << i)))
834                                 continue;
835
836                         data->fan_start_output[i] =
837                           w83627ehf_read_value(data,
838                                                data->REG_FAN_START_OUTPUT[i]);
839                         data->fan_stop_output[i] =
840                           w83627ehf_read_value(data,
841                                                data->REG_FAN_STOP_OUTPUT[i]);
842                         data->fan_stop_time[i] =
843                           w83627ehf_read_value(data,
844                                                data->REG_FAN_STOP_TIME[i]);
845
846                         if (data->REG_FAN_MAX_OUTPUT &&
847                             data->REG_FAN_MAX_OUTPUT[i] != 0xff)
848                                 data->fan_max_output[i] =
849                                   w83627ehf_read_value(data,
850                                                 data->REG_FAN_MAX_OUTPUT[i]);
851
852                         if (data->REG_FAN_STEP_OUTPUT &&
853                             data->REG_FAN_STEP_OUTPUT[i] != 0xff)
854                                 data->fan_step_output[i] =
855                                   w83627ehf_read_value(data,
856                                                 data->REG_FAN_STEP_OUTPUT[i]);
857
858                         data->target_temp[i] =
859                                 w83627ehf_read_value(data,
860                                         data->REG_TARGET[i]) &
861                                         (data->pwm_mode[i] == 1 ? 0x7f : 0xff);
862                 }
863
864                 /* Measured temperatures and limits */
865                 for (i = 0; i < NUM_REG_TEMP; i++) {
866                         if (!(data->have_temp & (1 << i)))
867                                 continue;
868                         data->temp[i] = w83627ehf_read_temp(data,
869                                                 data->reg_temp[i]);
870                         if (data->reg_temp_over[i])
871                                 data->temp_max[i]
872                                   = w83627ehf_read_temp(data,
873                                                 data->reg_temp_over[i]);
874                         if (data->reg_temp_hyst[i])
875                                 data->temp_max_hyst[i]
876                                   = w83627ehf_read_temp(data,
877                                                 data->reg_temp_hyst[i]);
878                 }
879
880                 data->alarms = w83627ehf_read_value(data,
881                                         W83627EHF_REG_ALARM1) |
882                                (w83627ehf_read_value(data,
883                                         W83627EHF_REG_ALARM2) << 8) |
884                                (w83627ehf_read_value(data,
885                                         W83627EHF_REG_ALARM3) << 16);
886
887                 data->caseopen = w83627ehf_read_value(data,
888                                                 W83627EHF_REG_CASEOPEN_DET);
889
890                 data->last_updated = jiffies;
891                 data->valid = 1;
892         }
893
894         mutex_unlock(&data->update_lock);
895         return data;
896 }
897
898 /*
899  * Sysfs callback functions
900  */
901 #define show_in_reg(reg) \
902 static ssize_t \
903 show_##reg(struct device *dev, struct device_attribute *attr, \
904            char *buf) \
905 { \
906         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
907         struct sensor_device_attribute *sensor_attr = \
908                 to_sensor_dev_attr(attr); \
909         int nr = sensor_attr->index; \
910         return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr)); \
911 }
912 show_in_reg(in)
913 show_in_reg(in_min)
914 show_in_reg(in_max)
915
916 #define store_in_reg(REG, reg) \
917 static ssize_t \
918 store_in_##reg(struct device *dev, struct device_attribute *attr, \
919                const char *buf, size_t count) \
920 { \
921         struct w83627ehf_data *data = dev_get_drvdata(dev); \
922         struct sensor_device_attribute *sensor_attr = \
923                 to_sensor_dev_attr(attr); \
924         int nr = sensor_attr->index; \
925         unsigned long val; \
926         int err; \
927         err = strict_strtoul(buf, 10, &val); \
928         if (err < 0) \
929                 return err; \
930         mutex_lock(&data->update_lock); \
931         data->in_##reg[nr] = in_to_reg(val, nr); \
932         w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \
933                               data->in_##reg[nr]); \
934         mutex_unlock(&data->update_lock); \
935         return count; \
936 }
937
938 store_in_reg(MIN, min)
939 store_in_reg(MAX, max)
940
941 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
942                           char *buf)
943 {
944         struct w83627ehf_data *data = w83627ehf_update_device(dev);
945         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
946         int nr = sensor_attr->index;
947         return sprintf(buf, "%u\n", (data->alarms >> nr) & 0x01);
948 }
949
950 static struct sensor_device_attribute sda_in_input[] = {
951         SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
952         SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
953         SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
954         SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
955         SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
956         SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
957         SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
958         SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
959         SENSOR_ATTR(in8_input, S_IRUGO, show_in, NULL, 8),
960         SENSOR_ATTR(in9_input, S_IRUGO, show_in, NULL, 9),
961 };
962
963 static struct sensor_device_attribute sda_in_alarm[] = {
964         SENSOR_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0),
965         SENSOR_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1),
966         SENSOR_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2),
967         SENSOR_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3),
968         SENSOR_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8),
969         SENSOR_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 21),
970         SENSOR_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 20),
971         SENSOR_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16),
972         SENSOR_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17),
973         SENSOR_ATTR(in9_alarm, S_IRUGO, show_alarm, NULL, 19),
974 };
975
976 static struct sensor_device_attribute sda_in_min[] = {
977         SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
978         SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
979         SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
980         SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 3),
981         SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 4),
982         SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 5),
983         SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 6),
984         SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 7),
985         SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 8),
986         SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 9),
987 };
988
989 static struct sensor_device_attribute sda_in_max[] = {
990         SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
991         SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
992         SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
993         SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 3),
994         SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 4),
995         SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 5),
996         SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 6),
997         SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 7),
998         SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 8),
999         SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 9),
1000 };
1001
1002 static ssize_t
1003 show_fan(struct device *dev, struct device_attribute *attr, char *buf)
1004 {
1005         struct w83627ehf_data *data = w83627ehf_update_device(dev);
1006         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1007         int nr = sensor_attr->index;
1008         return sprintf(buf, "%d\n", data->rpm[nr]);
1009 }
1010
1011 static ssize_t
1012 show_fan_min(struct device *dev, struct device_attribute *attr, char *buf)
1013 {
1014         struct w83627ehf_data *data = w83627ehf_update_device(dev);
1015         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1016         int nr = sensor_attr->index;
1017         return sprintf(buf, "%d\n",
1018                        data->fan_from_reg_min(data->fan_min[nr],
1019                                               data->fan_div[nr]));
1020 }
1021
1022 static ssize_t
1023 show_fan_div(struct device *dev, struct device_attribute *attr,
1024              char *buf)
1025 {
1026         struct w83627ehf_data *data = w83627ehf_update_device(dev);
1027         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1028         int nr = sensor_attr->index;
1029         return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
1030 }
1031
1032 static ssize_t
1033 store_fan_min(struct device *dev, struct device_attribute *attr,
1034               const char *buf, size_t count)
1035 {
1036         struct w83627ehf_data *data = dev_get_drvdata(dev);
1037         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1038         int nr = sensor_attr->index;
1039         unsigned long val;
1040         int err;
1041         unsigned int reg;
1042         u8 new_div;
1043
1044         err = strict_strtoul(buf, 10, &val);
1045         if (err < 0)
1046                 return err;
1047
1048         mutex_lock(&data->update_lock);
1049         if (!data->has_fan_div) {
1050                 /*
1051                  * Only NCT6776F for now, so we know that this is a 13 bit
1052                  * register
1053                  */
1054                 if (!val) {
1055                         val = 0xff1f;
1056                 } else {
1057                         if (val > 1350000U)
1058                                 val = 135000U;
1059                         val = 1350000U / val;
1060                         val = (val & 0x1f) | ((val << 3) & 0xff00);
1061                 }
1062                 data->fan_min[nr] = val;
1063                 goto done;      /* Leave fan divider alone */
1064         }
1065         if (!val) {
1066                 /* No min limit, alarm disabled */
1067                 data->fan_min[nr] = 255;
1068                 new_div = data->fan_div[nr]; /* No change */
1069                 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
1070         } else if ((reg = 1350000U / val) >= 128 * 255) {
1071                 /* Speed below this value cannot possibly be represented,
1072                    even with the highest divider (128) */
1073                 data->fan_min[nr] = 254;
1074                 new_div = 7; /* 128 == (1 << 7) */
1075                 dev_warn(dev, "fan%u low limit %lu below minimum %u, set to "
1076                          "minimum\n", nr + 1, val,
1077                          data->fan_from_reg_min(254, 7));
1078         } else if (!reg) {
1079                 /* Speed above this value cannot possibly be represented,
1080                    even with the lowest divider (1) */
1081                 data->fan_min[nr] = 1;
1082                 new_div = 0; /* 1 == (1 << 0) */
1083                 dev_warn(dev, "fan%u low limit %lu above maximum %u, set to "
1084                          "maximum\n", nr + 1, val,
1085                          data->fan_from_reg_min(1, 0));
1086         } else {
1087                 /* Automatically pick the best divider, i.e. the one such
1088                    that the min limit will correspond to a register value
1089                    in the 96..192 range */
1090                 new_div = 0;
1091                 while (reg > 192 && new_div < 7) {
1092                         reg >>= 1;
1093                         new_div++;
1094                 }
1095                 data->fan_min[nr] = reg;
1096         }
1097
1098         /* Write both the fan clock divider (if it changed) and the new
1099            fan min (unconditionally) */
1100         if (new_div != data->fan_div[nr]) {
1101                 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
1102                         nr + 1, div_from_reg(data->fan_div[nr]),
1103                         div_from_reg(new_div));
1104                 data->fan_div[nr] = new_div;
1105                 w83627ehf_write_fan_div_common(dev, data, nr);
1106                 /* Give the chip time to sample a new speed value */
1107                 data->last_updated = jiffies;
1108         }
1109 done:
1110         w83627ehf_write_value(data, data->REG_FAN_MIN[nr],
1111                               data->fan_min[nr]);
1112         mutex_unlock(&data->update_lock);
1113
1114         return count;
1115 }
1116
1117 static struct sensor_device_attribute sda_fan_input[] = {
1118         SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
1119         SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
1120         SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
1121         SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
1122         SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
1123 };
1124
1125 static struct sensor_device_attribute sda_fan_alarm[] = {
1126         SENSOR_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6),
1127         SENSOR_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7),
1128         SENSOR_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11),
1129         SENSOR_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 10),
1130         SENSOR_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 23),
1131 };
1132
1133 static struct sensor_device_attribute sda_fan_min[] = {
1134         SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
1135                     store_fan_min, 0),
1136         SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
1137                     store_fan_min, 1),
1138         SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
1139                     store_fan_min, 2),
1140         SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
1141                     store_fan_min, 3),
1142         SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO, show_fan_min,
1143                     store_fan_min, 4),
1144 };
1145
1146 static struct sensor_device_attribute sda_fan_div[] = {
1147         SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
1148         SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
1149         SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
1150         SENSOR_ATTR(fan4_div, S_IRUGO, show_fan_div, NULL, 3),
1151         SENSOR_ATTR(fan5_div, S_IRUGO, show_fan_div, NULL, 4),
1152 };
1153
1154 static ssize_t
1155 show_temp_label(struct device *dev, struct device_attribute *attr, char *buf)
1156 {
1157         struct w83627ehf_data *data = w83627ehf_update_device(dev);
1158         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1159         int nr = sensor_attr->index;
1160         return sprintf(buf, "%s\n", data->temp_label[data->temp_src[nr]]);
1161 }
1162
1163 #define show_temp_reg(addr, reg) \
1164 static ssize_t \
1165 show_##reg(struct device *dev, struct device_attribute *attr, \
1166            char *buf) \
1167 { \
1168         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1169         struct sensor_device_attribute *sensor_attr = \
1170                 to_sensor_dev_attr(attr); \
1171         int nr = sensor_attr->index; \
1172         return sprintf(buf, "%d\n", LM75_TEMP_FROM_REG(data->reg[nr])); \
1173 }
1174 show_temp_reg(reg_temp, temp);
1175 show_temp_reg(reg_temp_over, temp_max);
1176 show_temp_reg(reg_temp_hyst, temp_max_hyst);
1177
1178 #define store_temp_reg(addr, reg) \
1179 static ssize_t \
1180 store_##reg(struct device *dev, struct device_attribute *attr, \
1181             const char *buf, size_t count) \
1182 { \
1183         struct w83627ehf_data *data = dev_get_drvdata(dev); \
1184         struct sensor_device_attribute *sensor_attr = \
1185                 to_sensor_dev_attr(attr); \
1186         int nr = sensor_attr->index; \
1187         int err; \
1188         long val; \
1189         err = strict_strtol(buf, 10, &val); \
1190         if (err < 0) \
1191                 return err; \
1192         mutex_lock(&data->update_lock); \
1193         data->reg[nr] = LM75_TEMP_TO_REG(val); \
1194         w83627ehf_write_temp(data, data->addr[nr], data->reg[nr]); \
1195         mutex_unlock(&data->update_lock); \
1196         return count; \
1197 }
1198 store_temp_reg(reg_temp_over, temp_max);
1199 store_temp_reg(reg_temp_hyst, temp_max_hyst);
1200
1201 static ssize_t
1202 show_temp_type(struct device *dev, struct device_attribute *attr, char *buf)
1203 {
1204         struct w83627ehf_data *data = w83627ehf_update_device(dev);
1205         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1206         int nr = sensor_attr->index;
1207         return sprintf(buf, "%d\n", (int)data->temp_type[nr]);
1208 }
1209
1210 static struct sensor_device_attribute sda_temp_input[] = {
1211         SENSOR_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0),
1212         SENSOR_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1),
1213         SENSOR_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2),
1214         SENSOR_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3),
1215         SENSOR_ATTR(temp5_input, S_IRUGO, show_temp, NULL, 4),
1216         SENSOR_ATTR(temp6_input, S_IRUGO, show_temp, NULL, 5),
1217         SENSOR_ATTR(temp7_input, S_IRUGO, show_temp, NULL, 6),
1218         SENSOR_ATTR(temp8_input, S_IRUGO, show_temp, NULL, 7),
1219         SENSOR_ATTR(temp9_input, S_IRUGO, show_temp, NULL, 8),
1220 };
1221
1222 static struct sensor_device_attribute sda_temp_label[] = {
1223         SENSOR_ATTR(temp1_label, S_IRUGO, show_temp_label, NULL, 0),
1224         SENSOR_ATTR(temp2_label, S_IRUGO, show_temp_label, NULL, 1),
1225         SENSOR_ATTR(temp3_label, S_IRUGO, show_temp_label, NULL, 2),
1226         SENSOR_ATTR(temp4_label, S_IRUGO, show_temp_label, NULL, 3),
1227         SENSOR_ATTR(temp5_label, S_IRUGO, show_temp_label, NULL, 4),
1228         SENSOR_ATTR(temp6_label, S_IRUGO, show_temp_label, NULL, 5),
1229         SENSOR_ATTR(temp7_label, S_IRUGO, show_temp_label, NULL, 6),
1230         SENSOR_ATTR(temp8_label, S_IRUGO, show_temp_label, NULL, 7),
1231         SENSOR_ATTR(temp9_label, S_IRUGO, show_temp_label, NULL, 8),
1232 };
1233
1234 static struct sensor_device_attribute sda_temp_max[] = {
1235         SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp_max,
1236                     store_temp_max, 0),
1237         SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
1238                     store_temp_max, 1),
1239         SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
1240                     store_temp_max, 2),
1241         SENSOR_ATTR(temp4_max, S_IRUGO | S_IWUSR, show_temp_max,
1242                     store_temp_max, 3),
1243         SENSOR_ATTR(temp5_max, S_IRUGO | S_IWUSR, show_temp_max,
1244                     store_temp_max, 4),
1245         SENSOR_ATTR(temp6_max, S_IRUGO | S_IWUSR, show_temp_max,
1246                     store_temp_max, 5),
1247         SENSOR_ATTR(temp7_max, S_IRUGO | S_IWUSR, show_temp_max,
1248                     store_temp_max, 6),
1249         SENSOR_ATTR(temp8_max, S_IRUGO | S_IWUSR, show_temp_max,
1250                     store_temp_max, 7),
1251         SENSOR_ATTR(temp9_max, S_IRUGO | S_IWUSR, show_temp_max,
1252                     store_temp_max, 8),
1253 };
1254
1255 static struct sensor_device_attribute sda_temp_max_hyst[] = {
1256         SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1257                     store_temp_max_hyst, 0),
1258         SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1259                     store_temp_max_hyst, 1),
1260         SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1261                     store_temp_max_hyst, 2),
1262         SENSOR_ATTR(temp4_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1263                     store_temp_max_hyst, 3),
1264         SENSOR_ATTR(temp5_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1265                     store_temp_max_hyst, 4),
1266         SENSOR_ATTR(temp6_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1267                     store_temp_max_hyst, 5),
1268         SENSOR_ATTR(temp7_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1269                     store_temp_max_hyst, 6),
1270         SENSOR_ATTR(temp8_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1271                     store_temp_max_hyst, 7),
1272         SENSOR_ATTR(temp9_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1273                     store_temp_max_hyst, 8),
1274 };
1275
1276 static struct sensor_device_attribute sda_temp_alarm[] = {
1277         SENSOR_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4),
1278         SENSOR_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5),
1279         SENSOR_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13),
1280 };
1281
1282 static struct sensor_device_attribute sda_temp_type[] = {
1283         SENSOR_ATTR(temp1_type, S_IRUGO, show_temp_type, NULL, 0),
1284         SENSOR_ATTR(temp2_type, S_IRUGO, show_temp_type, NULL, 1),
1285         SENSOR_ATTR(temp3_type, S_IRUGO, show_temp_type, NULL, 2),
1286 };
1287
1288 #define show_pwm_reg(reg) \
1289 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1290                           char *buf) \
1291 { \
1292         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1293         struct sensor_device_attribute *sensor_attr = \
1294                 to_sensor_dev_attr(attr); \
1295         int nr = sensor_attr->index; \
1296         return sprintf(buf, "%d\n", data->reg[nr]); \
1297 }
1298
1299 show_pwm_reg(pwm_mode)
1300 show_pwm_reg(pwm_enable)
1301 show_pwm_reg(pwm)
1302
1303 static ssize_t
1304 store_pwm_mode(struct device *dev, struct device_attribute *attr,
1305                         const char *buf, size_t count)
1306 {
1307         struct w83627ehf_data *data = dev_get_drvdata(dev);
1308         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1309         int nr = sensor_attr->index;
1310         unsigned long val;
1311         int err;
1312         u16 reg;
1313
1314         err = strict_strtoul(buf, 10, &val);
1315         if (err < 0)
1316                 return err;
1317
1318         if (val > 1)
1319                 return -EINVAL;
1320         mutex_lock(&data->update_lock);
1321         reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1322         data->pwm_mode[nr] = val;
1323         reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
1324         if (!val)
1325                 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
1326         w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1327         mutex_unlock(&data->update_lock);
1328         return count;
1329 }
1330
1331 static ssize_t
1332 store_pwm(struct device *dev, struct device_attribute *attr,
1333                         const char *buf, size_t count)
1334 {
1335         struct w83627ehf_data *data = dev_get_drvdata(dev);
1336         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1337         int nr = sensor_attr->index;
1338         unsigned long val;
1339         int err;
1340
1341         err = strict_strtoul(buf, 10, &val);
1342         if (err < 0)
1343                 return err;
1344
1345         val = SENSORS_LIMIT(val, 0, 255);
1346
1347         mutex_lock(&data->update_lock);
1348         data->pwm[nr] = val;
1349         w83627ehf_write_value(data, data->REG_PWM[nr], val);
1350         mutex_unlock(&data->update_lock);
1351         return count;
1352 }
1353
1354 static ssize_t
1355 store_pwm_enable(struct device *dev, struct device_attribute *attr,
1356                         const char *buf, size_t count)
1357 {
1358         struct w83627ehf_data *data = dev_get_drvdata(dev);
1359         struct w83627ehf_sio_data *sio_data = dev->platform_data;
1360         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1361         int nr = sensor_attr->index;
1362         unsigned long val;
1363         int err;
1364         u16 reg;
1365
1366         err = strict_strtoul(buf, 10, &val);
1367         if (err < 0)
1368                 return err;
1369
1370         if (!val || (val > 4 && val != data->pwm_enable_orig[nr]))
1371                 return -EINVAL;
1372         /* SmartFan III mode is not supported on NCT6776F */
1373         if (sio_data->kind == nct6776 && val == 4)
1374                 return -EINVAL;
1375
1376         mutex_lock(&data->update_lock);
1377         data->pwm_enable[nr] = val;
1378         if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1379                 reg = w83627ehf_read_value(data,
1380                                            NCT6775_REG_FAN_MODE[nr]);
1381                 reg &= 0x0f;
1382                 reg |= (val - 1) << 4;
1383                 w83627ehf_write_value(data,
1384                                       NCT6775_REG_FAN_MODE[nr], reg);
1385         } else {
1386                 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1387                 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
1388                 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
1389                 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1390         }
1391         mutex_unlock(&data->update_lock);
1392         return count;
1393 }
1394
1395
1396 #define show_tol_temp(reg) \
1397 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1398                                 char *buf) \
1399 { \
1400         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1401         struct sensor_device_attribute *sensor_attr = \
1402                 to_sensor_dev_attr(attr); \
1403         int nr = sensor_attr->index; \
1404         return sprintf(buf, "%d\n", data->reg[nr] * 1000); \
1405 }
1406
1407 show_tol_temp(tolerance)
1408 show_tol_temp(target_temp)
1409
1410 static ssize_t
1411 store_target_temp(struct device *dev, struct device_attribute *attr,
1412                         const char *buf, size_t count)
1413 {
1414         struct w83627ehf_data *data = dev_get_drvdata(dev);
1415         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1416         int nr = sensor_attr->index;
1417         long val;
1418         int err;
1419
1420         err = strict_strtol(buf, 10, &val);
1421         if (err < 0)
1422                 return err;
1423
1424         val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 127);
1425
1426         mutex_lock(&data->update_lock);
1427         data->target_temp[nr] = val;
1428         w83627ehf_write_value(data, data->REG_TARGET[nr], val);
1429         mutex_unlock(&data->update_lock);
1430         return count;
1431 }
1432
1433 static ssize_t
1434 store_tolerance(struct device *dev, struct device_attribute *attr,
1435                         const char *buf, size_t count)
1436 {
1437         struct w83627ehf_data *data = dev_get_drvdata(dev);
1438         struct w83627ehf_sio_data *sio_data = dev->platform_data;
1439         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1440         int nr = sensor_attr->index;
1441         u16 reg;
1442         long val;
1443         int err;
1444
1445         err = strict_strtol(buf, 10, &val);
1446         if (err < 0)
1447                 return err;
1448
1449         /* Limit the temp to 0C - 15C */
1450         val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 15);
1451
1452         mutex_lock(&data->update_lock);
1453         if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1454                 /* Limit tolerance further for NCT6776F */
1455                 if (sio_data->kind == nct6776 && val > 7)
1456                         val = 7;
1457                 reg = w83627ehf_read_value(data, NCT6775_REG_FAN_MODE[nr]);
1458                 reg = (reg & 0xf0) | val;
1459                 w83627ehf_write_value(data, NCT6775_REG_FAN_MODE[nr], reg);
1460         } else {
1461                 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
1462                 if (nr == 1)
1463                         reg = (reg & 0x0f) | (val << 4);
1464                 else
1465                         reg = (reg & 0xf0) | val;
1466                 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
1467         }
1468         data->tolerance[nr] = val;
1469         mutex_unlock(&data->update_lock);
1470         return count;
1471 }
1472
1473 static struct sensor_device_attribute sda_pwm[] = {
1474         SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
1475         SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
1476         SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
1477         SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
1478 };
1479
1480 static struct sensor_device_attribute sda_pwm_mode[] = {
1481         SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1482                     store_pwm_mode, 0),
1483         SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1484                     store_pwm_mode, 1),
1485         SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1486                     store_pwm_mode, 2),
1487         SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1488                     store_pwm_mode, 3),
1489 };
1490
1491 static struct sensor_device_attribute sda_pwm_enable[] = {
1492         SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1493                     store_pwm_enable, 0),
1494         SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1495                     store_pwm_enable, 1),
1496         SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1497                     store_pwm_enable, 2),
1498         SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1499                     store_pwm_enable, 3),
1500 };
1501
1502 static struct sensor_device_attribute sda_target_temp[] = {
1503         SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1504                     store_target_temp, 0),
1505         SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1506                     store_target_temp, 1),
1507         SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1508                     store_target_temp, 2),
1509         SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1510                     store_target_temp, 3),
1511 };
1512
1513 static struct sensor_device_attribute sda_tolerance[] = {
1514         SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1515                     store_tolerance, 0),
1516         SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1517                     store_tolerance, 1),
1518         SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1519                     store_tolerance, 2),
1520         SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1521                     store_tolerance, 3),
1522 };
1523
1524 /* Smart Fan registers */
1525
1526 #define fan_functions(reg, REG) \
1527 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1528                        char *buf) \
1529 { \
1530         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1531         struct sensor_device_attribute *sensor_attr = \
1532                 to_sensor_dev_attr(attr); \
1533         int nr = sensor_attr->index; \
1534         return sprintf(buf, "%d\n", data->reg[nr]); \
1535 } \
1536 static ssize_t \
1537 store_##reg(struct device *dev, struct device_attribute *attr, \
1538                             const char *buf, size_t count) \
1539 { \
1540         struct w83627ehf_data *data = dev_get_drvdata(dev); \
1541         struct sensor_device_attribute *sensor_attr = \
1542                 to_sensor_dev_attr(attr); \
1543         int nr = sensor_attr->index; \
1544         unsigned long val; \
1545         int err; \
1546         err = strict_strtoul(buf, 10, &val); \
1547         if (err < 0) \
1548                 return err; \
1549         val = SENSORS_LIMIT(val, 1, 255); \
1550         mutex_lock(&data->update_lock); \
1551         data->reg[nr] = val; \
1552         w83627ehf_write_value(data, data->REG_##REG[nr], val); \
1553         mutex_unlock(&data->update_lock); \
1554         return count; \
1555 }
1556
1557 fan_functions(fan_start_output, FAN_START_OUTPUT)
1558 fan_functions(fan_stop_output, FAN_STOP_OUTPUT)
1559 fan_functions(fan_max_output, FAN_MAX_OUTPUT)
1560 fan_functions(fan_step_output, FAN_STEP_OUTPUT)
1561
1562 #define fan_time_functions(reg, REG) \
1563 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1564                                 char *buf) \
1565 { \
1566         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1567         struct sensor_device_attribute *sensor_attr = \
1568                 to_sensor_dev_attr(attr); \
1569         int nr = sensor_attr->index; \
1570         return sprintf(buf, "%d\n", \
1571                         step_time_from_reg(data->reg[nr], \
1572                                            data->pwm_mode[nr])); \
1573 } \
1574 \
1575 static ssize_t \
1576 store_##reg(struct device *dev, struct device_attribute *attr, \
1577                         const char *buf, size_t count) \
1578 { \
1579         struct w83627ehf_data *data = dev_get_drvdata(dev); \
1580         struct sensor_device_attribute *sensor_attr = \
1581                 to_sensor_dev_attr(attr); \
1582         int nr = sensor_attr->index; \
1583         unsigned long val; \
1584         int err; \
1585         err = strict_strtoul(buf, 10, &val); \
1586         if (err < 0) \
1587                 return err; \
1588         val = step_time_to_reg(val, data->pwm_mode[nr]); \
1589         mutex_lock(&data->update_lock); \
1590         data->reg[nr] = val; \
1591         w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
1592         mutex_unlock(&data->update_lock); \
1593         return count; \
1594 } \
1595
1596 fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1597
1598 static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1599                          char *buf)
1600 {
1601         struct w83627ehf_data *data = dev_get_drvdata(dev);
1602
1603         return sprintf(buf, "%s\n", data->name);
1604 }
1605 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1606
1607 static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1608         SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1609                     store_fan_stop_time, 3),
1610         SENSOR_ATTR(pwm4_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1611                     store_fan_start_output, 3),
1612         SENSOR_ATTR(pwm4_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1613                     store_fan_stop_output, 3),
1614         SENSOR_ATTR(pwm4_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1615                     store_fan_max_output, 3),
1616         SENSOR_ATTR(pwm4_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1617                     store_fan_step_output, 3),
1618 };
1619
1620 static struct sensor_device_attribute sda_sf3_arrays[] = {
1621         SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1622                     store_fan_stop_time, 0),
1623         SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1624                     store_fan_stop_time, 1),
1625         SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1626                     store_fan_stop_time, 2),
1627         SENSOR_ATTR(pwm1_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1628                     store_fan_start_output, 0),
1629         SENSOR_ATTR(pwm2_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1630                     store_fan_start_output, 1),
1631         SENSOR_ATTR(pwm3_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1632                     store_fan_start_output, 2),
1633         SENSOR_ATTR(pwm1_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1634                     store_fan_stop_output, 0),
1635         SENSOR_ATTR(pwm2_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1636                     store_fan_stop_output, 1),
1637         SENSOR_ATTR(pwm3_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1638                     store_fan_stop_output, 2),
1639 };
1640
1641
1642 /*
1643  * pwm1 and pwm3 don't support max and step settings on all chips.
1644  * Need to check support while generating/removing attribute files.
1645  */
1646 static struct sensor_device_attribute sda_sf3_max_step_arrays[] = {
1647         SENSOR_ATTR(pwm1_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1648                     store_fan_max_output, 0),
1649         SENSOR_ATTR(pwm1_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1650                     store_fan_step_output, 0),
1651         SENSOR_ATTR(pwm2_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1652                     store_fan_max_output, 1),
1653         SENSOR_ATTR(pwm2_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1654                     store_fan_step_output, 1),
1655         SENSOR_ATTR(pwm3_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1656                     store_fan_max_output, 2),
1657         SENSOR_ATTR(pwm3_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1658                     store_fan_step_output, 2),
1659 };
1660
1661 static ssize_t
1662 show_vid(struct device *dev, struct device_attribute *attr, char *buf)
1663 {
1664         struct w83627ehf_data *data = dev_get_drvdata(dev);
1665         return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1666 }
1667 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
1668
1669
1670 /* Case open detection */
1671
1672 static ssize_t
1673 show_caseopen(struct device *dev, struct device_attribute *attr, char *buf)
1674 {
1675         struct w83627ehf_data *data = w83627ehf_update_device(dev);
1676
1677         return sprintf(buf, "%d\n",
1678                 !!(data->caseopen & to_sensor_dev_attr_2(attr)->index));
1679 }
1680
1681 static ssize_t
1682 clear_caseopen(struct device *dev, struct device_attribute *attr,
1683                         const char *buf, size_t count)
1684 {
1685         struct w83627ehf_data *data = dev_get_drvdata(dev);
1686         unsigned long val;
1687         u16 reg, mask;
1688
1689         if (strict_strtoul(buf, 10, &val) || val != 0)
1690                 return -EINVAL;
1691
1692         mask = to_sensor_dev_attr_2(attr)->nr;
1693
1694         mutex_lock(&data->update_lock);
1695         reg = w83627ehf_read_value(data, W83627EHF_REG_CASEOPEN_CLR);
1696         w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg | mask);
1697         w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg & ~mask);
1698         data->valid = 0;        /* Force cache refresh */
1699         mutex_unlock(&data->update_lock);
1700
1701         return count;
1702 }
1703
1704 static struct sensor_device_attribute_2 sda_caseopen[] = {
1705         SENSOR_ATTR_2(intrusion0_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1706                         clear_caseopen, 0x80, 0x10),
1707         SENSOR_ATTR_2(intrusion1_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1708                         clear_caseopen, 0x40, 0x40),
1709 };
1710
1711 /*
1712  * Driver and device management
1713  */
1714
1715 static void w83627ehf_device_remove_files(struct device *dev)
1716 {
1717         /* some entries in the following arrays may not have been used in
1718          * device_create_file(), but device_remove_file() will ignore them */
1719         int i;
1720         struct w83627ehf_data *data = dev_get_drvdata(dev);
1721
1722         for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1723                 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
1724         for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
1725                 struct sensor_device_attribute *attr =
1726                   &sda_sf3_max_step_arrays[i];
1727                 if (data->REG_FAN_STEP_OUTPUT &&
1728                     data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff)
1729                         device_remove_file(dev, &attr->dev_attr);
1730         }
1731         for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1732                 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
1733         for (i = 0; i < data->in_num; i++) {
1734                 if ((i == 6) && data->in6_skip)
1735                         continue;
1736                 device_remove_file(dev, &sda_in_input[i].dev_attr);
1737                 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1738                 device_remove_file(dev, &sda_in_min[i].dev_attr);
1739                 device_remove_file(dev, &sda_in_max[i].dev_attr);
1740         }
1741         for (i = 0; i < 5; i++) {
1742                 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1743                 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1744                 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1745                 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1746         }
1747         for (i = 0; i < data->pwm_num; i++) {
1748                 device_remove_file(dev, &sda_pwm[i].dev_attr);
1749                 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1750                 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1751                 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1752                 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1753         }
1754         for (i = 0; i < NUM_REG_TEMP; i++) {
1755                 if (!(data->have_temp & (1 << i)))
1756                         continue;
1757                 device_remove_file(dev, &sda_temp_input[i].dev_attr);
1758                 device_remove_file(dev, &sda_temp_label[i].dev_attr);
1759                 device_remove_file(dev, &sda_temp_max[i].dev_attr);
1760                 device_remove_file(dev, &sda_temp_max_hyst[i].dev_attr);
1761                 if (i > 2)
1762                         continue;
1763                 device_remove_file(dev, &sda_temp_alarm[i].dev_attr);
1764                 device_remove_file(dev, &sda_temp_type[i].dev_attr);
1765         }
1766
1767         device_remove_file(dev, &sda_caseopen[0].dev_attr);
1768         device_remove_file(dev, &sda_caseopen[1].dev_attr);
1769
1770         device_remove_file(dev, &dev_attr_name);
1771         device_remove_file(dev, &dev_attr_cpu0_vid);
1772 }
1773
1774 /* Get the monitoring functions started */
1775 static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data,
1776                                                    enum kinds kind)
1777 {
1778         int i;
1779         u8 tmp, diode;
1780
1781         /* Start monitoring is needed */
1782         tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
1783         if (!(tmp & 0x01))
1784                 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
1785                                       tmp | 0x01);
1786
1787         /* Enable temperature sensors if needed */
1788         for (i = 0; i < NUM_REG_TEMP; i++) {
1789                 if (!(data->have_temp & (1 << i)))
1790                         continue;
1791                 if (!data->reg_temp_config[i])
1792                         continue;
1793                 tmp = w83627ehf_read_value(data,
1794                                            data->reg_temp_config[i]);
1795                 if (tmp & 0x01)
1796                         w83627ehf_write_value(data,
1797                                               data->reg_temp_config[i],
1798                                               tmp & 0xfe);
1799         }
1800
1801         /* Enable VBAT monitoring if needed */
1802         tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
1803         if (!(tmp & 0x01))
1804                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01);
1805
1806         /* Get thermal sensor types */
1807         switch (kind) {
1808         case w83627ehf:
1809                 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
1810                 break;
1811         default:
1812                 diode = 0x70;
1813         }
1814         for (i = 0; i < 3; i++) {
1815                 const char *label = data->temp_label[data->temp_src[i]];
1816
1817                 /* Digital source overrides analog type */
1818                 if (strncmp(label, "PECI", 4) == 0)
1819                         data->temp_type[i] = 6;
1820                 else if (strncmp(label, "AMD", 3) == 0)
1821                         data->temp_type[i] = 5;
1822                 else if ((tmp & (0x02 << i)))
1823                         data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 3;
1824                 else
1825                         data->temp_type[i] = 4; /* thermistor */
1826         }
1827 }
1828
1829 static void w82627ehf_swap_tempreg(struct w83627ehf_data *data,
1830                                    int r1, int r2)
1831 {
1832         u16 tmp;
1833
1834         tmp = data->temp_src[r1];
1835         data->temp_src[r1] = data->temp_src[r2];
1836         data->temp_src[r2] = tmp;
1837
1838         tmp = data->reg_temp[r1];
1839         data->reg_temp[r1] = data->reg_temp[r2];
1840         data->reg_temp[r2] = tmp;
1841
1842         tmp = data->reg_temp_over[r1];
1843         data->reg_temp_over[r1] = data->reg_temp_over[r2];
1844         data->reg_temp_over[r2] = tmp;
1845
1846         tmp = data->reg_temp_hyst[r1];
1847         data->reg_temp_hyst[r1] = data->reg_temp_hyst[r2];
1848         data->reg_temp_hyst[r2] = tmp;
1849
1850         tmp = data->reg_temp_config[r1];
1851         data->reg_temp_config[r1] = data->reg_temp_config[r2];
1852         data->reg_temp_config[r2] = tmp;
1853 }
1854
1855 static void __devinit
1856 w83627ehf_set_temp_reg_ehf(struct w83627ehf_data *data, int n_temp)
1857 {
1858         int i;
1859
1860         for (i = 0; i < n_temp; i++) {
1861                 data->reg_temp[i] = W83627EHF_REG_TEMP[i];
1862                 data->reg_temp_over[i] = W83627EHF_REG_TEMP_OVER[i];
1863                 data->reg_temp_hyst[i] = W83627EHF_REG_TEMP_HYST[i];
1864                 data->reg_temp_config[i] = W83627EHF_REG_TEMP_CONFIG[i];
1865         }
1866 }
1867
1868 static void __devinit
1869 w83627ehf_check_fan_inputs(const struct w83627ehf_sio_data *sio_data,
1870                            struct w83627ehf_data *data)
1871 {
1872         int fan3pin, fan4pin, fan4min, fan5pin, regval;
1873
1874         superio_enter(sio_data->sioreg);
1875
1876         /* fan4 and fan5 share some pins with the GPIO and serial flash */
1877         if (sio_data->kind == nct6775) {
1878                 /* On NCT6775, fan4 shares pins with the fdc interface */
1879                 fan3pin = 1;
1880                 fan4pin = !(superio_inb(sio_data->sioreg, 0x2A) & 0x80);
1881                 fan4min = 0;
1882                 fan5pin = 0;
1883         } else if (sio_data->kind == nct6776) {
1884                 fan3pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x40);
1885                 fan4pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x01);
1886                 fan5pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x02);
1887                 fan4min = fan4pin;
1888         } else if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) {
1889                 fan3pin = 1;
1890                 fan4pin = superio_inb(sio_data->sioreg, 0x27) & 0x40;
1891                 fan5pin = superio_inb(sio_data->sioreg, 0x27) & 0x20;
1892                 fan4min = fan4pin;
1893         } else {
1894                 fan3pin = 1;
1895                 fan4pin = !(superio_inb(sio_data->sioreg, 0x29) & 0x06);
1896                 fan5pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x02);
1897                 fan4min = fan4pin;
1898         }
1899
1900         superio_exit(sio_data->sioreg);
1901
1902         data->has_fan = data->has_fan_min = 0x03; /* fan1 and fan2 */
1903         data->has_fan |= (fan3pin << 2);
1904         data->has_fan_min |= (fan3pin << 2);
1905
1906         if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1907                 /*
1908                  * NCT6775F and NCT6776F don't have the W83627EHF_REG_FANDIV1
1909                  * register
1910                  */
1911                 data->has_fan |= (fan4pin << 3) | (fan5pin << 4);
1912                 data->has_fan_min |= (fan4min << 3) | (fan5pin << 4);
1913         } else {
1914                 /*
1915                  * It looks like fan4 and fan5 pins can be alternatively used
1916                  * as fan on/off switches, but fan5 control is write only :/
1917                  * We assume that if the serial interface is disabled, designers
1918                  * connected fan5 as input unless they are emitting log 1, which
1919                  * is not the default.
1920                  */
1921                 regval = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
1922                 if ((regval & (1 << 2)) && fan4pin) {
1923                         data->has_fan |= (1 << 3);
1924                         data->has_fan_min |= (1 << 3);
1925                 }
1926                 if (!(regval & (1 << 1)) && fan5pin) {
1927                         data->has_fan |= (1 << 4);
1928                         data->has_fan_min |= (1 << 4);
1929                 }
1930         }
1931 }
1932
1933 static int __devinit w83627ehf_probe(struct platform_device *pdev)
1934 {
1935         struct device *dev = &pdev->dev;
1936         struct w83627ehf_sio_data *sio_data = dev->platform_data;
1937         struct w83627ehf_data *data;
1938         struct resource *res;
1939         u8 en_vrm10;
1940         int i, err = 0;
1941
1942         res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1943         if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
1944                 err = -EBUSY;
1945                 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1946                         (unsigned long)res->start,
1947                         (unsigned long)res->start + IOREGION_LENGTH - 1);
1948                 goto exit;
1949         }
1950
1951         data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL);
1952         if (!data) {
1953                 err = -ENOMEM;
1954                 goto exit_release;
1955         }
1956
1957         data->addr = res->start;
1958         mutex_init(&data->lock);
1959         mutex_init(&data->update_lock);
1960         data->name = w83627ehf_device_names[sio_data->kind];
1961         platform_set_drvdata(pdev, data);
1962
1963         /* 627EHG and 627EHF have 10 voltage inputs; 627DHG and 667HG have 9 */
1964         data->in_num = (sio_data->kind == w83627ehf) ? 10 : 9;
1965         /* 667HG, NCT6775F, and NCT6776F have 3 pwms */
1966         data->pwm_num = (sio_data->kind == w83667hg
1967                          || sio_data->kind == w83667hg_b
1968                          || sio_data->kind == nct6775
1969                          || sio_data->kind == nct6776) ? 3 : 4;
1970
1971         /* Default to 3 temperature inputs, code below will adjust as needed */
1972         data->have_temp = 0x07;
1973
1974         /* Deal with temperature register setup first. */
1975         if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1976                 int mask = 0;
1977
1978                 /*
1979                  * Display temperature sensor output only if it monitors
1980                  * a source other than one already reported. Always display
1981                  * first three temperature registers, though.
1982                  */
1983                 for (i = 0; i < NUM_REG_TEMP; i++) {
1984                         u8 src;
1985
1986                         data->reg_temp[i] = NCT6775_REG_TEMP[i];
1987                         data->reg_temp_over[i] = NCT6775_REG_TEMP_OVER[i];
1988                         data->reg_temp_hyst[i] = NCT6775_REG_TEMP_HYST[i];
1989                         data->reg_temp_config[i] = NCT6775_REG_TEMP_CONFIG[i];
1990
1991                         src = w83627ehf_read_value(data,
1992                                                    NCT6775_REG_TEMP_SOURCE[i]);
1993                         src &= 0x1f;
1994                         if (src && !(mask & (1 << src))) {
1995                                 data->have_temp |= 1 << i;
1996                                 mask |= 1 << src;
1997                         }
1998
1999                         data->temp_src[i] = src;
2000
2001                         /*
2002                          * Now do some register swapping if index 0..2 don't
2003                          * point to SYSTIN(1), CPUIN(2), and AUXIN(3).
2004                          * Idea is to have the first three attributes
2005                          * report SYSTIN, CPUIN, and AUXIN if possible
2006                          * without overriding the basic system configuration.
2007                          */
2008                         if (i > 0 && data->temp_src[0] != 1
2009                             && data->temp_src[i] == 1)
2010                                 w82627ehf_swap_tempreg(data, 0, i);
2011                         if (i > 1 && data->temp_src[1] != 2
2012                             && data->temp_src[i] == 2)
2013                                 w82627ehf_swap_tempreg(data, 1, i);
2014                         if (i > 2 && data->temp_src[2] != 3
2015                             && data->temp_src[i] == 3)
2016                                 w82627ehf_swap_tempreg(data, 2, i);
2017                 }
2018                 if (sio_data->kind == nct6776) {
2019                         /*
2020                          * On NCT6776, AUXTIN and VIN3 pins are shared.
2021                          * Only way to detect it is to check if AUXTIN is used
2022                          * as a temperature source, and if that source is
2023                          * enabled.
2024                          *
2025                          * If that is the case, disable in6, which reports VIN3.
2026                          * Otherwise disable temp3.
2027                          */
2028                         if (data->temp_src[2] == 3) {
2029                                 u8 reg;
2030
2031                                 if (data->reg_temp_config[2])
2032                                         reg = w83627ehf_read_value(data,
2033                                                 data->reg_temp_config[2]);
2034                                 else
2035                                         reg = 0; /* Assume AUXTIN is used */
2036
2037                                 if (reg & 0x01)
2038                                         data->have_temp &= ~(1 << 2);
2039                                 else
2040                                         data->in6_skip = 1;
2041                         }
2042                         data->temp_label = nct6776_temp_label;
2043                 } else {
2044                         data->temp_label = nct6775_temp_label;
2045                 }
2046         } else if (sio_data->kind == w83667hg_b) {
2047                 u8 reg;
2048
2049                 w83627ehf_set_temp_reg_ehf(data, 4);
2050
2051                 /*
2052                  * Temperature sources are selected with bank 0, registers 0x49
2053                  * and 0x4a.
2054                  */
2055                 reg = w83627ehf_read_value(data, 0x4a);
2056                 data->temp_src[0] = reg >> 5;
2057                 reg = w83627ehf_read_value(data, 0x49);
2058                 data->temp_src[1] = reg & 0x07;
2059                 data->temp_src[2] = (reg >> 4) & 0x07;
2060
2061                 /*
2062                  * W83667HG-B has another temperature register at 0x7e.
2063                  * The temperature source is selected with register 0x7d.
2064                  * Support it if the source differs from already reported
2065                  * sources.
2066                  */
2067                 reg = w83627ehf_read_value(data, 0x7d);
2068                 reg &= 0x07;
2069                 if (reg != data->temp_src[0] && reg != data->temp_src[1]
2070                     && reg != data->temp_src[2]) {
2071                         data->temp_src[3] = reg;
2072                         data->have_temp |= 1 << 3;
2073                 }
2074
2075                 /*
2076                  * Chip supports either AUXTIN or VIN3. Try to find out which
2077                  * one.
2078                  */
2079                 reg = w83627ehf_read_value(data, W83627EHF_REG_TEMP_CONFIG[2]);
2080                 if (data->temp_src[2] == 2 && (reg & 0x01))
2081                         data->have_temp &= ~(1 << 2);
2082
2083                 if ((data->temp_src[2] == 2 && (data->have_temp & (1 << 2)))
2084                     || (data->temp_src[3] == 2 && (data->have_temp & (1 << 3))))
2085                         data->in6_skip = 1;
2086
2087                 data->temp_label = w83667hg_b_temp_label;
2088         } else {
2089                 w83627ehf_set_temp_reg_ehf(data, 3);
2090
2091                 /* Temperature sources are fixed */
2092
2093                 if (sio_data->kind == w83667hg) {
2094                         u8 reg;
2095
2096                         /*
2097                          * Chip supports either AUXTIN or VIN3. Try to find
2098                          * out which one.
2099                          */
2100                         reg = w83627ehf_read_value(data,
2101                                                 W83627EHF_REG_TEMP_CONFIG[2]);
2102                         if (reg & 0x01)
2103                                 data->have_temp &= ~(1 << 2);
2104                         else
2105                                 data->in6_skip = 1;
2106                 }
2107         }
2108
2109         if (sio_data->kind == nct6775) {
2110                 data->has_fan_div = true;
2111                 data->fan_from_reg = fan_from_reg16;
2112                 data->fan_from_reg_min = fan_from_reg8;
2113                 data->REG_PWM = NCT6775_REG_PWM;
2114                 data->REG_TARGET = NCT6775_REG_TARGET;
2115                 data->REG_FAN = NCT6775_REG_FAN;
2116                 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2117                 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2118                 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2119                 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2120                 data->REG_FAN_MAX_OUTPUT = NCT6775_REG_FAN_MAX_OUTPUT;
2121                 data->REG_FAN_STEP_OUTPUT = NCT6775_REG_FAN_STEP_OUTPUT;
2122         } else if (sio_data->kind == nct6776) {
2123                 data->has_fan_div = false;
2124                 data->fan_from_reg = fan_from_reg13;
2125                 data->fan_from_reg_min = fan_from_reg13;
2126                 data->REG_PWM = NCT6775_REG_PWM;
2127                 data->REG_TARGET = NCT6775_REG_TARGET;
2128                 data->REG_FAN = NCT6775_REG_FAN;
2129                 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
2130                 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2131                 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2132                 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2133         } else if (sio_data->kind == w83667hg_b) {
2134                 data->has_fan_div = true;
2135                 data->fan_from_reg = fan_from_reg8;
2136                 data->fan_from_reg_min = fan_from_reg8;
2137                 data->REG_PWM = W83627EHF_REG_PWM;
2138                 data->REG_TARGET = W83627EHF_REG_TARGET;
2139                 data->REG_FAN = W83627EHF_REG_FAN;
2140                 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2141                 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2142                 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2143                 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
2144                 data->REG_FAN_MAX_OUTPUT =
2145                   W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B;
2146                 data->REG_FAN_STEP_OUTPUT =
2147                   W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B;
2148         } else {
2149                 data->has_fan_div = true;
2150                 data->fan_from_reg = fan_from_reg8;
2151                 data->fan_from_reg_min = fan_from_reg8;
2152                 data->REG_PWM = W83627EHF_REG_PWM;
2153                 data->REG_TARGET = W83627EHF_REG_TARGET;
2154                 data->REG_FAN = W83627EHF_REG_FAN;
2155                 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2156                 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2157                 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2158                 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
2159                 data->REG_FAN_MAX_OUTPUT =
2160                   W83627EHF_REG_FAN_MAX_OUTPUT_COMMON;
2161                 data->REG_FAN_STEP_OUTPUT =
2162                   W83627EHF_REG_FAN_STEP_OUTPUT_COMMON;
2163         }
2164
2165         /* Initialize the chip */
2166         w83627ehf_init_device(data, sio_data->kind);
2167
2168         data->vrm = vid_which_vrm();
2169         superio_enter(sio_data->sioreg);
2170         /* Read VID value */
2171         if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b ||
2172             sio_data->kind == nct6775 || sio_data->kind == nct6776) {
2173                 /* W83667HG has different pins for VID input and output, so
2174                 we can get the VID input values directly at logical device D
2175                 0xe3. */
2176                 superio_select(sio_data->sioreg, W83667HG_LD_VID);
2177                 data->vid = superio_inb(sio_data->sioreg, 0xe3);
2178                 err = device_create_file(dev, &dev_attr_cpu0_vid);
2179                 if (err)
2180                         goto exit_release;
2181         } else {
2182                 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2183                 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) {
2184                         /* Set VID input sensibility if needed. In theory the
2185                            BIOS should have set it, but in practice it's not
2186                            always the case. We only do it for the W83627EHF/EHG
2187                            because the W83627DHG is more complex in this
2188                            respect. */
2189                         if (sio_data->kind == w83627ehf) {
2190                                 en_vrm10 = superio_inb(sio_data->sioreg,
2191                                                        SIO_REG_EN_VRM10);
2192                                 if ((en_vrm10 & 0x08) && data->vrm == 90) {
2193                                         dev_warn(dev, "Setting VID input "
2194                                                  "voltage to TTL\n");
2195                                         superio_outb(sio_data->sioreg,
2196                                                      SIO_REG_EN_VRM10,
2197                                                      en_vrm10 & ~0x08);
2198                                 } else if (!(en_vrm10 & 0x08)
2199                                            && data->vrm == 100) {
2200                                         dev_warn(dev, "Setting VID input "
2201                                                  "voltage to VRM10\n");
2202                                         superio_outb(sio_data->sioreg,
2203                                                      SIO_REG_EN_VRM10,
2204                                                      en_vrm10 | 0x08);
2205                                 }
2206                         }
2207
2208                         data->vid = superio_inb(sio_data->sioreg,
2209                                                 SIO_REG_VID_DATA);
2210                         if (sio_data->kind == w83627ehf) /* 6 VID pins only */
2211                                 data->vid &= 0x3f;
2212
2213                         err = device_create_file(dev, &dev_attr_cpu0_vid);
2214                         if (err)
2215                                 goto exit_release;
2216                 } else {
2217                         dev_info(dev, "VID pins in output mode, CPU VID not "
2218                                  "available\n");
2219                 }
2220         }
2221
2222         if (fan_debounce &&
2223             (sio_data->kind == nct6775 || sio_data->kind == nct6776)) {
2224                 u8 tmp;
2225
2226                 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2227                 tmp = superio_inb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE);
2228                 if (sio_data->kind == nct6776)
2229                         superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2230                                      0x3e | tmp);
2231                 else
2232                         superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2233                                      0x1e | tmp);
2234                 pr_info("Enabled fan debounce for chip %s\n", data->name);
2235         }
2236
2237         superio_exit(sio_data->sioreg);
2238
2239         w83627ehf_check_fan_inputs(sio_data, data);
2240
2241         /* Read fan clock dividers immediately */
2242         w83627ehf_update_fan_div_common(dev, data);
2243
2244         /* Read pwm data to save original values */
2245         w83627ehf_update_pwm_common(dev, data);
2246         for (i = 0; i < data->pwm_num; i++)
2247                 data->pwm_enable_orig[i] = data->pwm_enable[i];
2248
2249         /* Read pwm data to save original values */
2250         w83627ehf_update_pwm_common(dev, data);
2251         for (i = 0; i < data->pwm_num; i++)
2252                 data->pwm_enable_orig[i] = data->pwm_enable[i];
2253
2254         /* Register sysfs hooks */
2255         for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++) {
2256                 err = device_create_file(dev, &sda_sf3_arrays[i].dev_attr);
2257                 if (err)
2258                         goto exit_remove;
2259         }
2260
2261         for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
2262                 struct sensor_device_attribute *attr =
2263                   &sda_sf3_max_step_arrays[i];
2264                 if (data->REG_FAN_STEP_OUTPUT &&
2265                     data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff) {
2266                         err = device_create_file(dev, &attr->dev_attr);
2267                         if (err)
2268                                 goto exit_remove;
2269                 }
2270         }
2271         /* if fan4 is enabled create the sf3 files for it */
2272         if ((data->has_fan & (1 << 3)) && data->pwm_num >= 4)
2273                 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
2274                         err = device_create_file(dev,
2275                                         &sda_sf3_arrays_fan4[i].dev_attr);
2276                         if (err)
2277                                 goto exit_remove;
2278                 }
2279
2280         for (i = 0; i < data->in_num; i++) {
2281                 if ((i == 6) && data->in6_skip)
2282                         continue;
2283                 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
2284                         || (err = device_create_file(dev,
2285                                 &sda_in_alarm[i].dev_attr))
2286                         || (err = device_create_file(dev,
2287                                 &sda_in_min[i].dev_attr))
2288                         || (err = device_create_file(dev,
2289                                 &sda_in_max[i].dev_attr)))
2290                         goto exit_remove;
2291         }
2292
2293         for (i = 0; i < 5; i++) {
2294                 if (data->has_fan & (1 << i)) {
2295                         if ((err = device_create_file(dev,
2296                                         &sda_fan_input[i].dev_attr))
2297                                 || (err = device_create_file(dev,
2298                                         &sda_fan_alarm[i].dev_attr)))
2299                                 goto exit_remove;
2300                         if (sio_data->kind != nct6776) {
2301                                 err = device_create_file(dev,
2302                                                 &sda_fan_div[i].dev_attr);
2303                                 if (err)
2304                                         goto exit_remove;
2305                         }
2306                         if (data->has_fan_min & (1 << i)) {
2307                                 err = device_create_file(dev,
2308                                                 &sda_fan_min[i].dev_attr);
2309                                 if (err)
2310                                         goto exit_remove;
2311                         }
2312                         if (i < data->pwm_num &&
2313                                 ((err = device_create_file(dev,
2314                                         &sda_pwm[i].dev_attr))
2315                                 || (err = device_create_file(dev,
2316                                         &sda_pwm_mode[i].dev_attr))
2317                                 || (err = device_create_file(dev,
2318                                         &sda_pwm_enable[i].dev_attr))
2319                                 || (err = device_create_file(dev,
2320                                         &sda_target_temp[i].dev_attr))
2321                                 || (err = device_create_file(dev,
2322                                         &sda_tolerance[i].dev_attr))))
2323                                 goto exit_remove;
2324                 }
2325         }
2326
2327         for (i = 0; i < NUM_REG_TEMP; i++) {
2328                 if (!(data->have_temp & (1 << i)))
2329                         continue;
2330                 err = device_create_file(dev, &sda_temp_input[i].dev_attr);
2331                 if (err)
2332                         goto exit_remove;
2333                 if (data->temp_label) {
2334                         err = device_create_file(dev,
2335                                                  &sda_temp_label[i].dev_attr);
2336                         if (err)
2337                                 goto exit_remove;
2338                 }
2339                 if (data->reg_temp_over[i]) {
2340                         err = device_create_file(dev,
2341                                 &sda_temp_max[i].dev_attr);
2342                         if (err)
2343                                 goto exit_remove;
2344                 }
2345                 if (data->reg_temp_hyst[i]) {
2346                         err = device_create_file(dev,
2347                                 &sda_temp_max_hyst[i].dev_attr);
2348                         if (err)
2349                                 goto exit_remove;
2350                 }
2351                 if (i > 2)
2352                         continue;
2353                 if ((err = device_create_file(dev,
2354                                 &sda_temp_alarm[i].dev_attr))
2355                         || (err = device_create_file(dev,
2356                                 &sda_temp_type[i].dev_attr)))
2357                         goto exit_remove;
2358         }
2359
2360         err = device_create_file(dev, &sda_caseopen[0].dev_attr);
2361         if (err)
2362                 goto exit_remove;
2363
2364         if (sio_data->kind == nct6776) {
2365                 err = device_create_file(dev, &sda_caseopen[1].dev_attr);
2366                 if (err)
2367                         goto exit_remove;
2368         }
2369
2370         err = device_create_file(dev, &dev_attr_name);
2371         if (err)
2372                 goto exit_remove;
2373
2374         data->hwmon_dev = hwmon_device_register(dev);
2375         if (IS_ERR(data->hwmon_dev)) {
2376                 err = PTR_ERR(data->hwmon_dev);
2377                 goto exit_remove;
2378         }
2379
2380         return 0;
2381
2382 exit_remove:
2383         w83627ehf_device_remove_files(dev);
2384         kfree(data);
2385         platform_set_drvdata(pdev, NULL);
2386 exit_release:
2387         release_region(res->start, IOREGION_LENGTH);
2388 exit:
2389         return err;
2390 }
2391
2392 static int __devexit w83627ehf_remove(struct platform_device *pdev)
2393 {
2394         struct w83627ehf_data *data = platform_get_drvdata(pdev);
2395
2396         hwmon_device_unregister(data->hwmon_dev);
2397         w83627ehf_device_remove_files(&pdev->dev);
2398         release_region(data->addr, IOREGION_LENGTH);
2399         platform_set_drvdata(pdev, NULL);
2400         kfree(data);
2401
2402         return 0;
2403 }
2404
2405 static struct platform_driver w83627ehf_driver = {
2406         .driver = {
2407                 .owner  = THIS_MODULE,
2408                 .name   = DRVNAME,
2409         },
2410         .probe          = w83627ehf_probe,
2411         .remove         = __devexit_p(w83627ehf_remove),
2412 };
2413
2414 /* w83627ehf_find() looks for a '627 in the Super-I/O config space */
2415 static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
2416                                  struct w83627ehf_sio_data *sio_data)
2417 {
2418         static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
2419         static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
2420         static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
2421         static const char __initdata sio_name_W83627DHG_P[] = "W83627DHG-P";
2422         static const char __initdata sio_name_W83667HG[] = "W83667HG";
2423         static const char __initdata sio_name_W83667HG_B[] = "W83667HG-B";
2424         static const char __initdata sio_name_NCT6775[] = "NCT6775F";
2425         static const char __initdata sio_name_NCT6776[] = "NCT6776F";
2426
2427         u16 val;
2428         const char *sio_name;
2429
2430         superio_enter(sioaddr);
2431
2432         if (force_id)
2433                 val = force_id;
2434         else
2435                 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
2436                     | superio_inb(sioaddr, SIO_REG_DEVID + 1);
2437         switch (val & SIO_ID_MASK) {
2438         case SIO_W83627EHF_ID:
2439                 sio_data->kind = w83627ehf;
2440                 sio_name = sio_name_W83627EHF;
2441                 break;
2442         case SIO_W83627EHG_ID:
2443                 sio_data->kind = w83627ehf;
2444                 sio_name = sio_name_W83627EHG;
2445                 break;
2446         case SIO_W83627DHG_ID:
2447                 sio_data->kind = w83627dhg;
2448                 sio_name = sio_name_W83627DHG;
2449                 break;
2450         case SIO_W83627DHG_P_ID:
2451                 sio_data->kind = w83627dhg_p;
2452                 sio_name = sio_name_W83627DHG_P;
2453                 break;
2454         case SIO_W83667HG_ID:
2455                 sio_data->kind = w83667hg;
2456                 sio_name = sio_name_W83667HG;
2457                 break;
2458         case SIO_W83667HG_B_ID:
2459                 sio_data->kind = w83667hg_b;
2460                 sio_name = sio_name_W83667HG_B;
2461                 break;
2462         case SIO_NCT6775_ID:
2463                 sio_data->kind = nct6775;
2464                 sio_name = sio_name_NCT6775;
2465                 break;
2466         case SIO_NCT6776_ID:
2467                 sio_data->kind = nct6776;
2468                 sio_name = sio_name_NCT6776;
2469                 break;
2470         default:
2471                 if (val != 0xffff)
2472                         pr_debug("unsupported chip ID: 0x%04x\n", val);
2473                 superio_exit(sioaddr);
2474                 return -ENODEV;
2475         }
2476
2477         /* We have a known chip, find the HWM I/O address */
2478         superio_select(sioaddr, W83627EHF_LD_HWM);
2479         val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
2480             | superio_inb(sioaddr, SIO_REG_ADDR + 1);
2481         *addr = val & IOREGION_ALIGNMENT;
2482         if (*addr == 0) {
2483                 pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n");
2484                 superio_exit(sioaddr);
2485                 return -ENODEV;
2486         }
2487
2488         /* Activate logical device if needed */
2489         val = superio_inb(sioaddr, SIO_REG_ENABLE);
2490         if (!(val & 0x01)) {
2491                 pr_warn("Forcibly enabling Super-I/O. "
2492                         "Sensor is probably unusable.\n");
2493                 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
2494         }
2495
2496         superio_exit(sioaddr);
2497         pr_info("Found %s chip at %#x\n", sio_name, *addr);
2498         sio_data->sioreg = sioaddr;
2499
2500         return 0;
2501 }
2502
2503 /* when Super-I/O functions move to a separate file, the Super-I/O
2504  * bus will manage the lifetime of the device and this module will only keep
2505  * track of the w83627ehf driver. But since we platform_device_alloc(), we
2506  * must keep track of the device */
2507 static struct platform_device *pdev;
2508
2509 static int __init sensors_w83627ehf_init(void)
2510 {
2511         int err;
2512         unsigned short address;
2513         struct resource res;
2514         struct w83627ehf_sio_data sio_data;
2515
2516         /* initialize sio_data->kind and sio_data->sioreg.
2517          *
2518          * when Super-I/O functions move to a separate file, the Super-I/O
2519          * driver will probe 0x2e and 0x4e and auto-detect the presence of a
2520          * w83627ehf hardware monitor, and call probe() */
2521         if (w83627ehf_find(0x2e, &address, &sio_data) &&
2522             w83627ehf_find(0x4e, &address, &sio_data))
2523                 return -ENODEV;
2524
2525         err = platform_driver_register(&w83627ehf_driver);
2526         if (err)
2527                 goto exit;
2528
2529         pdev = platform_device_alloc(DRVNAME, address);
2530         if (!pdev) {
2531                 err = -ENOMEM;
2532                 pr_err("Device allocation failed\n");
2533                 goto exit_unregister;
2534         }
2535
2536         err = platform_device_add_data(pdev, &sio_data,
2537                                        sizeof(struct w83627ehf_sio_data));
2538         if (err) {
2539                 pr_err("Platform data allocation failed\n");
2540                 goto exit_device_put;
2541         }
2542
2543         memset(&res, 0, sizeof(res));
2544         res.name = DRVNAME;
2545         res.start = address + IOREGION_OFFSET;
2546         res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
2547         res.flags = IORESOURCE_IO;
2548
2549         err = acpi_check_resource_conflict(&res);
2550         if (err)
2551                 goto exit_device_put;
2552
2553         err = platform_device_add_resources(pdev, &res, 1);
2554         if (err) {
2555                 pr_err("Device resource addition failed (%d)\n", err);
2556                 goto exit_device_put;
2557         }
2558
2559         /* platform_device_add calls probe() */
2560         err = platform_device_add(pdev);
2561         if (err) {
2562                 pr_err("Device addition failed (%d)\n", err);
2563                 goto exit_device_put;
2564         }
2565
2566         return 0;
2567
2568 exit_device_put:
2569         platform_device_put(pdev);
2570 exit_unregister:
2571         platform_driver_unregister(&w83627ehf_driver);
2572 exit:
2573         return err;
2574 }
2575
2576 static void __exit sensors_w83627ehf_exit(void)
2577 {
2578         platform_device_unregister(pdev);
2579         platform_driver_unregister(&w83627ehf_driver);
2580 }
2581
2582 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
2583 MODULE_DESCRIPTION("W83627EHF driver");
2584 MODULE_LICENSE("GPL");
2585
2586 module_init(sensors_w83627ehf_init);
2587 module_exit(sensors_w83627ehf_exit);