hwmon/w83627ehf: Fix timing issues
[linux-2.6] / 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
9     Shamelessly ripped from the w83627hf driver
10     Copyright (C) 2003  Mark Studebaker
11
12     Thanks to Leon Moonen, Steve Cliffe and Grant Coady for their help
13     in testing and debugging this driver.
14
15     This driver also supports the W83627EHG, which is the lead-free
16     version of the W83627EHF.
17
18     This program is free software; you can redistribute it and/or modify
19     it under the terms of the GNU General Public License as published by
20     the Free Software Foundation; either version 2 of the License, or
21     (at your option) any later version.
22
23     This program is distributed in the hope that it will be useful,
24     but WITHOUT ANY WARRANTY; without even the implied warranty of
25     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
26     GNU General Public License for more details.
27
28     You should have received a copy of the GNU General Public License
29     along with this program; if not, write to the Free Software
30     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
31
32
33     Supports the following chips:
34
35     Chip        #vin    #fan    #pwm    #temp  chip IDs       man ID
36     w83627ehf   10      5       4       3      0x8850 0x88    0x5ca3
37                                                0x8860 0xa1
38     w83627dhg    9      5       4       3      0xa020 0xc1    0x5ca3
39 */
40
41 #include <linux/module.h>
42 #include <linux/init.h>
43 #include <linux/slab.h>
44 #include <linux/jiffies.h>
45 #include <linux/platform_device.h>
46 #include <linux/hwmon.h>
47 #include <linux/hwmon-sysfs.h>
48 #include <linux/err.h>
49 #include <linux/mutex.h>
50 #include <asm/io.h>
51 #include "lm75.h"
52
53 enum kinds { w83627ehf, w83627dhg };
54
55 /* used to set data->name = w83627ehf_device_names[data->sio_kind] */
56 static const char * w83627ehf_device_names[] = {
57         "w83627ehf",
58         "w83627dhg",
59 };
60
61 #define DRVNAME "w83627ehf"
62
63 /*
64  * Super-I/O constants and functions
65  */
66
67 #define W83627EHF_LD_HWM        0x0b
68
69 #define SIO_REG_LDSEL           0x07    /* Logical device select */
70 #define SIO_REG_DEVID           0x20    /* Device ID (2 bytes) */
71 #define SIO_REG_ENABLE          0x30    /* Logical device enable */
72 #define SIO_REG_ADDR            0x60    /* Logical device address (2 bytes) */
73
74 #define SIO_W83627EHF_ID        0x8850
75 #define SIO_W83627EHG_ID        0x8860
76 #define SIO_W83627DHG_ID        0xa020
77 #define SIO_ID_MASK             0xFFF0
78
79 static inline void
80 superio_outb(int ioreg, int reg, int val)
81 {
82         outb(reg, ioreg);
83         outb(val, ioreg + 1);
84 }
85
86 static inline int
87 superio_inb(int ioreg, int reg)
88 {
89         outb(reg, ioreg);
90         return inb(ioreg + 1);
91 }
92
93 static inline void
94 superio_select(int ioreg, int ld)
95 {
96         outb(SIO_REG_LDSEL, ioreg);
97         outb(ld, ioreg + 1);
98 }
99
100 static inline void
101 superio_enter(int ioreg)
102 {
103         outb(0x87, ioreg);
104         outb(0x87, ioreg);
105 }
106
107 static inline void
108 superio_exit(int ioreg)
109 {
110         outb(0x02, ioreg);
111         outb(0x02, ioreg + 1);
112 }
113
114 /*
115  * ISA constants
116  */
117
118 #define IOREGION_ALIGNMENT      ~7
119 #define IOREGION_OFFSET         5
120 #define IOREGION_LENGTH         2
121 #define ADDR_REG_OFFSET         0
122 #define DATA_REG_OFFSET         1
123
124 #define W83627EHF_REG_BANK              0x4E
125 #define W83627EHF_REG_CONFIG            0x40
126
127 /* Not currently used:
128  * REG_MAN_ID has the value 0x5ca3 for all supported chips.
129  * REG_CHIP_ID == 0x88/0xa1/0xc1 depending on chip model.
130  * REG_MAN_ID is at port 0x4f
131  * REG_CHIP_ID is at port 0x58 */
132
133 static const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 };
134 static const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c };
135
136 /* The W83627EHF registers for nr=7,8,9 are in bank 5 */
137 #define W83627EHF_REG_IN_MAX(nr)        ((nr < 7) ? (0x2b + (nr) * 2) : \
138                                          (0x554 + (((nr) - 7) * 2)))
139 #define W83627EHF_REG_IN_MIN(nr)        ((nr < 7) ? (0x2c + (nr) * 2) : \
140                                          (0x555 + (((nr) - 7) * 2)))
141 #define W83627EHF_REG_IN(nr)            ((nr < 7) ? (0x20 + (nr)) : \
142                                          (0x550 + (nr) - 7))
143
144 #define W83627EHF_REG_TEMP1             0x27
145 #define W83627EHF_REG_TEMP1_HYST        0x3a
146 #define W83627EHF_REG_TEMP1_OVER        0x39
147 static const u16 W83627EHF_REG_TEMP[] = { 0x150, 0x250 };
148 static const u16 W83627EHF_REG_TEMP_HYST[] = { 0x153, 0x253 };
149 static const u16 W83627EHF_REG_TEMP_OVER[] = { 0x155, 0x255 };
150 static const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0x152, 0x252 };
151
152 /* Fan clock dividers are spread over the following five registers */
153 #define W83627EHF_REG_FANDIV1           0x47
154 #define W83627EHF_REG_FANDIV2           0x4B
155 #define W83627EHF_REG_VBAT              0x5D
156 #define W83627EHF_REG_DIODE             0x59
157 #define W83627EHF_REG_SMI_OVT           0x4C
158
159 #define W83627EHF_REG_ALARM1            0x459
160 #define W83627EHF_REG_ALARM2            0x45A
161 #define W83627EHF_REG_ALARM3            0x45B
162
163 /* SmartFan registers */
164 /* DC or PWM output fan configuration */
165 static const u8 W83627EHF_REG_PWM_ENABLE[] = {
166         0x04,                   /* SYS FAN0 output mode and PWM mode */
167         0x04,                   /* CPU FAN0 output mode and PWM mode */
168         0x12,                   /* AUX FAN mode */
169         0x62,                   /* CPU fan1 mode */
170 };
171
172 static const u8 W83627EHF_PWM_MODE_SHIFT[] = { 0, 1, 0, 6 };
173 static const u8 W83627EHF_PWM_ENABLE_SHIFT[] = { 2, 4, 1, 4 };
174
175 /* FAN Duty Cycle, be used to control */
176 static const u8 W83627EHF_REG_PWM[] = { 0x01, 0x03, 0x11, 0x61 };
177 static const u8 W83627EHF_REG_TARGET[] = { 0x05, 0x06, 0x13, 0x63 };
178 static const u8 W83627EHF_REG_TOLERANCE[] = { 0x07, 0x07, 0x14, 0x62 };
179
180
181 /* Advanced Fan control, some values are common for all fans */
182 static const u8 W83627EHF_REG_FAN_MIN_OUTPUT[] = { 0x08, 0x09, 0x15, 0x64 };
183 static const u8 W83627EHF_REG_FAN_STOP_TIME[] = { 0x0C, 0x0D, 0x17, 0x66 };
184
185 /*
186  * Conversions
187  */
188
189 /* 1 is PWM mode, output in ms */
190 static inline unsigned int step_time_from_reg(u8 reg, u8 mode)
191 {
192         return mode ? 100 * reg : 400 * reg;
193 }
194
195 static inline u8 step_time_to_reg(unsigned int msec, u8 mode)
196 {
197         return SENSORS_LIMIT((mode ? (msec + 50) / 100 :
198                                                 (msec + 200) / 400), 1, 255);
199 }
200
201 static inline unsigned int
202 fan_from_reg(u8 reg, unsigned int div)
203 {
204         if (reg == 0 || reg == 255)
205                 return 0;
206         return 1350000U / (reg * div);
207 }
208
209 static inline unsigned int
210 div_from_reg(u8 reg)
211 {
212         return 1 << reg;
213 }
214
215 static inline int
216 temp1_from_reg(s8 reg)
217 {
218         return reg * 1000;
219 }
220
221 static inline s8
222 temp1_to_reg(int temp, int min, int max)
223 {
224         if (temp <= min)
225                 return min / 1000;
226         if (temp >= max)
227                 return max / 1000;
228         if (temp < 0)
229                 return (temp - 500) / 1000;
230         return (temp + 500) / 1000;
231 }
232
233 /* Some of analog inputs have internal scaling (2x), 8mV is ADC LSB */
234
235 static u8 scale_in[10] = { 8, 8, 16, 16, 8, 8, 8, 16, 16, 8 };
236
237 static inline long in_from_reg(u8 reg, u8 nr)
238 {
239         return reg * scale_in[nr];
240 }
241
242 static inline u8 in_to_reg(u32 val, u8 nr)
243 {
244         return SENSORS_LIMIT(((val + (scale_in[nr] / 2)) / scale_in[nr]), 0, 255);
245 }
246
247 /*
248  * Data structures and manipulation thereof
249  */
250
251 struct w83627ehf_data {
252         int addr;       /* IO base of hw monitor block */
253         const char *name;
254
255         struct class_device *class_dev;
256         struct mutex lock;
257
258         struct mutex update_lock;
259         char valid;             /* !=0 if following fields are valid */
260         unsigned long last_updated;     /* In jiffies */
261
262         /* Register values */
263         u8 in_num;              /* number of in inputs we have */
264         u8 in[10];              /* Register value */
265         u8 in_max[10];          /* Register value */
266         u8 in_min[10];          /* Register value */
267         u8 fan[5];
268         u8 fan_min[5];
269         u8 fan_div[5];
270         u8 has_fan;             /* some fan inputs can be disabled */
271         s8 temp1;
272         s8 temp1_max;
273         s8 temp1_max_hyst;
274         s16 temp[2];
275         s16 temp_max[2];
276         s16 temp_max_hyst[2];
277         u32 alarms;
278
279         u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */
280         u8 pwm_enable[4]; /* 1->manual
281                              2->thermal cruise (also called SmartFan I) */
282         u8 pwm[4];
283         u8 target_temp[4];
284         u8 tolerance[4];
285
286         u8 fan_min_output[4]; /* minimum fan speed */
287         u8 fan_stop_time[4];
288 };
289
290 struct w83627ehf_sio_data {
291         int sioreg;
292         enum kinds kind;
293 };
294
295 static inline int is_word_sized(u16 reg)
296 {
297         return (((reg & 0xff00) == 0x100
298               || (reg & 0xff00) == 0x200)
299              && ((reg & 0x00ff) == 0x50
300               || (reg & 0x00ff) == 0x53
301               || (reg & 0x00ff) == 0x55));
302 }
303
304 /* We assume that the default bank is 0, thus the following two functions do
305    nothing for registers which live in bank 0. For others, they respectively
306    set the bank register to the correct value (before the register is
307    accessed), and back to 0 (afterwards). */
308 static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg)
309 {
310         if (reg & 0xff00) {
311                 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
312                 outb_p(reg >> 8, data->addr + DATA_REG_OFFSET);
313         }
314 }
315
316 static inline void w83627ehf_reset_bank(struct w83627ehf_data *data, u16 reg)
317 {
318         if (reg & 0xff00) {
319                 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
320                 outb_p(0, data->addr + DATA_REG_OFFSET);
321         }
322 }
323
324 static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg)
325 {
326         int res, word_sized = is_word_sized(reg);
327
328         mutex_lock(&data->lock);
329
330         w83627ehf_set_bank(data, reg);
331         outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
332         res = inb_p(data->addr + DATA_REG_OFFSET);
333         if (word_sized) {
334                 outb_p((reg & 0xff) + 1,
335                        data->addr + ADDR_REG_OFFSET);
336                 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
337         }
338         w83627ehf_reset_bank(data, reg);
339
340         mutex_unlock(&data->lock);
341
342         return res;
343 }
344
345 static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg, u16 value)
346 {
347         int word_sized = is_word_sized(reg);
348
349         mutex_lock(&data->lock);
350
351         w83627ehf_set_bank(data, reg);
352         outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
353         if (word_sized) {
354                 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
355                 outb_p((reg & 0xff) + 1,
356                        data->addr + ADDR_REG_OFFSET);
357         }
358         outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
359         w83627ehf_reset_bank(data, reg);
360
361         mutex_unlock(&data->lock);
362         return 0;
363 }
364
365 /* This function assumes that the caller holds data->update_lock */
366 static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr)
367 {
368         u8 reg;
369
370         switch (nr) {
371         case 0:
372                 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf)
373                     | ((data->fan_div[0] & 0x03) << 4);
374                 /* fan5 input control bit is write only, compute the value */
375                 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
376                 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
377                 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf)
378                     | ((data->fan_div[0] & 0x04) << 3);
379                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
380                 break;
381         case 1:
382                 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f)
383                     | ((data->fan_div[1] & 0x03) << 6);
384                 /* fan5 input control bit is write only, compute the value */
385                 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
386                 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
387                 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf)
388                     | ((data->fan_div[1] & 0x04) << 4);
389                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
390                 break;
391         case 2:
392                 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f)
393                     | ((data->fan_div[2] & 0x03) << 6);
394                 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg);
395                 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f)
396                     | ((data->fan_div[2] & 0x04) << 5);
397                 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
398                 break;
399         case 3:
400                 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc)
401                     | (data->fan_div[3] & 0x03);
402                 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
403                 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f)
404                     | ((data->fan_div[3] & 0x04) << 5);
405                 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg);
406                 break;
407         case 4:
408                 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73)
409                     | ((data->fan_div[4] & 0x03) << 2)
410                     | ((data->fan_div[4] & 0x04) << 5);
411                 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
412                 break;
413         }
414 }
415
416 static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
417 {
418         struct w83627ehf_data *data = dev_get_drvdata(dev);
419         int pwmcfg = 0, tolerance = 0; /* shut up the compiler */
420         int i;
421
422         mutex_lock(&data->update_lock);
423
424         if (time_after(jiffies, data->last_updated + HZ + HZ/2)
425          || !data->valid) {
426                 /* Fan clock dividers */
427                 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
428                 data->fan_div[0] = (i >> 4) & 0x03;
429                 data->fan_div[1] = (i >> 6) & 0x03;
430                 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2);
431                 data->fan_div[2] = (i >> 6) & 0x03;
432                 i = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
433                 data->fan_div[0] |= (i >> 3) & 0x04;
434                 data->fan_div[1] |= (i >> 4) & 0x04;
435                 data->fan_div[2] |= (i >> 5) & 0x04;
436                 if (data->has_fan & ((1 << 3) | (1 << 4))) {
437                         i = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
438                         data->fan_div[3] = i & 0x03;
439                         data->fan_div[4] = ((i >> 2) & 0x03)
440                                          | ((i >> 5) & 0x04);
441                 }
442                 if (data->has_fan & (1 << 3)) {
443                         i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT);
444                         data->fan_div[3] |= (i >> 5) & 0x04;
445                 }
446
447                 /* Measured voltages and limits */
448                 for (i = 0; i < data->in_num; i++) {
449                         data->in[i] = w83627ehf_read_value(data,
450                                       W83627EHF_REG_IN(i));
451                         data->in_min[i] = w83627ehf_read_value(data,
452                                           W83627EHF_REG_IN_MIN(i));
453                         data->in_max[i] = w83627ehf_read_value(data,
454                                           W83627EHF_REG_IN_MAX(i));
455                 }
456
457                 /* Measured fan speeds and limits */
458                 for (i = 0; i < 5; i++) {
459                         if (!(data->has_fan & (1 << i)))
460                                 continue;
461
462                         data->fan[i] = w83627ehf_read_value(data,
463                                        W83627EHF_REG_FAN[i]);
464                         data->fan_min[i] = w83627ehf_read_value(data,
465                                            W83627EHF_REG_FAN_MIN[i]);
466
467                         /* If we failed to measure the fan speed and clock
468                            divider can be increased, let's try that for next
469                            time */
470                         if (data->fan[i] == 0xff
471                          && data->fan_div[i] < 0x07) {
472                                 dev_dbg(dev, "Increasing fan%d "
473                                         "clock divider from %u to %u\n",
474                                         i + 1, div_from_reg(data->fan_div[i]),
475                                         div_from_reg(data->fan_div[i] + 1));
476                                 data->fan_div[i]++;
477                                 w83627ehf_write_fan_div(data, i);
478                                 /* Preserve min limit if possible */
479                                 if (data->fan_min[i] >= 2
480                                  && data->fan_min[i] != 255)
481                                         w83627ehf_write_value(data,
482                                                 W83627EHF_REG_FAN_MIN[i],
483                                                 (data->fan_min[i] /= 2));
484                         }
485                 }
486
487                 for (i = 0; i < 4; i++) {
488                         /* pwmcfg, tolarance mapped for i=0, i=1 to same reg */
489                         if (i != 1) {
490                                 pwmcfg = w83627ehf_read_value(data,
491                                                 W83627EHF_REG_PWM_ENABLE[i]);
492                                 tolerance = w83627ehf_read_value(data,
493                                                 W83627EHF_REG_TOLERANCE[i]);
494                         }
495                         data->pwm_mode[i] =
496                                 ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1)
497                                 ? 0 : 1;
498                         data->pwm_enable[i] =
499                                         ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i])
500                                                 & 3) + 1;
501                         data->pwm[i] = w83627ehf_read_value(data,
502                                                 W83627EHF_REG_PWM[i]);
503                         data->fan_min_output[i] = w83627ehf_read_value(data,
504                                                 W83627EHF_REG_FAN_MIN_OUTPUT[i]);
505                         data->fan_stop_time[i] = w83627ehf_read_value(data,
506                                                 W83627EHF_REG_FAN_STOP_TIME[i]);
507                         data->target_temp[i] =
508                                 w83627ehf_read_value(data,
509                                         W83627EHF_REG_TARGET[i]) &
510                                         (data->pwm_mode[i] == 1 ? 0x7f : 0xff);
511                         data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0))
512                                                                         & 0x0f;
513                 }
514
515                 /* Measured temperatures and limits */
516                 data->temp1 = w83627ehf_read_value(data,
517                               W83627EHF_REG_TEMP1);
518                 data->temp1_max = w83627ehf_read_value(data,
519                                   W83627EHF_REG_TEMP1_OVER);
520                 data->temp1_max_hyst = w83627ehf_read_value(data,
521                                        W83627EHF_REG_TEMP1_HYST);
522                 for (i = 0; i < 2; i++) {
523                         data->temp[i] = w83627ehf_read_value(data,
524                                         W83627EHF_REG_TEMP[i]);
525                         data->temp_max[i] = w83627ehf_read_value(data,
526                                             W83627EHF_REG_TEMP_OVER[i]);
527                         data->temp_max_hyst[i] = w83627ehf_read_value(data,
528                                                  W83627EHF_REG_TEMP_HYST[i]);
529                 }
530
531                 data->alarms = w83627ehf_read_value(data,
532                                         W83627EHF_REG_ALARM1) |
533                                (w83627ehf_read_value(data,
534                                         W83627EHF_REG_ALARM2) << 8) |
535                                (w83627ehf_read_value(data,
536                                         W83627EHF_REG_ALARM3) << 16);
537
538                 data->last_updated = jiffies;
539                 data->valid = 1;
540         }
541
542         mutex_unlock(&data->update_lock);
543         return data;
544 }
545
546 /*
547  * Sysfs callback functions
548  */
549 #define show_in_reg(reg) \
550 static ssize_t \
551 show_##reg(struct device *dev, struct device_attribute *attr, \
552            char *buf) \
553 { \
554         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
555         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
556         int nr = sensor_attr->index; \
557         return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr)); \
558 }
559 show_in_reg(in)
560 show_in_reg(in_min)
561 show_in_reg(in_max)
562
563 #define store_in_reg(REG, reg) \
564 static ssize_t \
565 store_in_##reg (struct device *dev, struct device_attribute *attr, \
566                         const char *buf, size_t count) \
567 { \
568         struct w83627ehf_data *data = dev_get_drvdata(dev); \
569         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
570         int nr = sensor_attr->index; \
571         u32 val = simple_strtoul(buf, NULL, 10); \
572  \
573         mutex_lock(&data->update_lock); \
574         data->in_##reg[nr] = in_to_reg(val, nr); \
575         w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \
576                               data->in_##reg[nr]); \
577         mutex_unlock(&data->update_lock); \
578         return count; \
579 }
580
581 store_in_reg(MIN, min)
582 store_in_reg(MAX, max)
583
584 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, char *buf)
585 {
586         struct w83627ehf_data *data = w83627ehf_update_device(dev);
587         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
588         int nr = sensor_attr->index;
589         return sprintf(buf, "%u\n", (data->alarms >> nr) & 0x01);
590 }
591
592 static struct sensor_device_attribute sda_in_input[] = {
593         SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
594         SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
595         SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
596         SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
597         SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
598         SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
599         SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
600         SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
601         SENSOR_ATTR(in8_input, S_IRUGO, show_in, NULL, 8),
602         SENSOR_ATTR(in9_input, S_IRUGO, show_in, NULL, 9),
603 };
604
605 static struct sensor_device_attribute sda_in_alarm[] = {
606         SENSOR_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0),
607         SENSOR_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1),
608         SENSOR_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2),
609         SENSOR_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3),
610         SENSOR_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8),
611         SENSOR_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 21),
612         SENSOR_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 20),
613         SENSOR_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16),
614         SENSOR_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17),
615         SENSOR_ATTR(in9_alarm, S_IRUGO, show_alarm, NULL, 19),
616 };
617
618 static struct sensor_device_attribute sda_in_min[] = {
619        SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
620        SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
621        SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
622        SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 3),
623        SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 4),
624        SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 5),
625        SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 6),
626        SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 7),
627        SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 8),
628        SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 9),
629 };
630
631 static struct sensor_device_attribute sda_in_max[] = {
632        SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
633        SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
634        SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
635        SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 3),
636        SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 4),
637        SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 5),
638        SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 6),
639        SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 7),
640        SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 8),
641        SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 9),
642 };
643
644 #define show_fan_reg(reg) \
645 static ssize_t \
646 show_##reg(struct device *dev, struct device_attribute *attr, \
647            char *buf) \
648 { \
649         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
650         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
651         int nr = sensor_attr->index; \
652         return sprintf(buf, "%d\n", \
653                        fan_from_reg(data->reg[nr], \
654                                     div_from_reg(data->fan_div[nr]))); \
655 }
656 show_fan_reg(fan);
657 show_fan_reg(fan_min);
658
659 static ssize_t
660 show_fan_div(struct device *dev, struct device_attribute *attr,
661              char *buf)
662 {
663         struct w83627ehf_data *data = w83627ehf_update_device(dev);
664         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
665         int nr = sensor_attr->index;
666         return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
667 }
668
669 static ssize_t
670 store_fan_min(struct device *dev, struct device_attribute *attr,
671               const char *buf, size_t count)
672 {
673         struct w83627ehf_data *data = dev_get_drvdata(dev);
674         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
675         int nr = sensor_attr->index;
676         unsigned int val = simple_strtoul(buf, NULL, 10);
677         unsigned int reg;
678         u8 new_div;
679
680         mutex_lock(&data->update_lock);
681         if (!val) {
682                 /* No min limit, alarm disabled */
683                 data->fan_min[nr] = 255;
684                 new_div = data->fan_div[nr]; /* No change */
685                 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
686         } else if ((reg = 1350000U / val) >= 128 * 255) {
687                 /* Speed below this value cannot possibly be represented,
688                    even with the highest divider (128) */
689                 data->fan_min[nr] = 254;
690                 new_div = 7; /* 128 == (1 << 7) */
691                 dev_warn(dev, "fan%u low limit %u below minimum %u, set to "
692                          "minimum\n", nr + 1, val, fan_from_reg(254, 128));
693         } else if (!reg) {
694                 /* Speed above this value cannot possibly be represented,
695                    even with the lowest divider (1) */
696                 data->fan_min[nr] = 1;
697                 new_div = 0; /* 1 == (1 << 0) */
698                 dev_warn(dev, "fan%u low limit %u above maximum %u, set to "
699                          "maximum\n", nr + 1, val, fan_from_reg(1, 1));
700         } else {
701                 /* Automatically pick the best divider, i.e. the one such
702                    that the min limit will correspond to a register value
703                    in the 96..192 range */
704                 new_div = 0;
705                 while (reg > 192 && new_div < 7) {
706                         reg >>= 1;
707                         new_div++;
708                 }
709                 data->fan_min[nr] = reg;
710         }
711
712         /* Write both the fan clock divider (if it changed) and the new
713            fan min (unconditionally) */
714         if (new_div != data->fan_div[nr]) {
715                 /* Preserve the fan speed reading */
716                 if (data->fan[nr] != 0xff) {
717                         if (new_div > data->fan_div[nr])
718                                 data->fan[nr] >>= new_div - data->fan_div[nr];
719                         else if (data->fan[nr] & 0x80)
720                                 data->fan[nr] = 0xff;
721                         else
722                                 data->fan[nr] <<= data->fan_div[nr] - new_div;
723                 }
724
725                 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
726                         nr + 1, div_from_reg(data->fan_div[nr]),
727                         div_from_reg(new_div));
728                 data->fan_div[nr] = new_div;
729                 w83627ehf_write_fan_div(data, nr);
730                 /* Give the chip time to sample a new speed value */
731                 data->last_updated = jiffies;
732         }
733         w83627ehf_write_value(data, W83627EHF_REG_FAN_MIN[nr],
734                               data->fan_min[nr]);
735         mutex_unlock(&data->update_lock);
736
737         return count;
738 }
739
740 static struct sensor_device_attribute sda_fan_input[] = {
741         SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
742         SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
743         SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
744         SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
745         SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
746 };
747
748 static struct sensor_device_attribute sda_fan_alarm[] = {
749         SENSOR_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6),
750         SENSOR_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7),
751         SENSOR_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11),
752         SENSOR_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 10),
753         SENSOR_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 23),
754 };
755
756 static struct sensor_device_attribute sda_fan_min[] = {
757         SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
758                     store_fan_min, 0),
759         SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
760                     store_fan_min, 1),
761         SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
762                     store_fan_min, 2),
763         SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
764                     store_fan_min, 3),
765         SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO, show_fan_min,
766                     store_fan_min, 4),
767 };
768
769 static struct sensor_device_attribute sda_fan_div[] = {
770         SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
771         SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
772         SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
773         SENSOR_ATTR(fan4_div, S_IRUGO, show_fan_div, NULL, 3),
774         SENSOR_ATTR(fan5_div, S_IRUGO, show_fan_div, NULL, 4),
775 };
776
777 #define show_temp1_reg(reg) \
778 static ssize_t \
779 show_##reg(struct device *dev, struct device_attribute *attr, \
780            char *buf) \
781 { \
782         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
783         return sprintf(buf, "%d\n", temp1_from_reg(data->reg)); \
784 }
785 show_temp1_reg(temp1);
786 show_temp1_reg(temp1_max);
787 show_temp1_reg(temp1_max_hyst);
788
789 #define store_temp1_reg(REG, reg) \
790 static ssize_t \
791 store_temp1_##reg(struct device *dev, struct device_attribute *attr, \
792                   const char *buf, size_t count) \
793 { \
794         struct w83627ehf_data *data = dev_get_drvdata(dev); \
795         u32 val = simple_strtoul(buf, NULL, 10); \
796  \
797         mutex_lock(&data->update_lock); \
798         data->temp1_##reg = temp1_to_reg(val, -128000, 127000); \
799         w83627ehf_write_value(data, W83627EHF_REG_TEMP1_##REG, \
800                               data->temp1_##reg); \
801         mutex_unlock(&data->update_lock); \
802         return count; \
803 }
804 store_temp1_reg(OVER, max);
805 store_temp1_reg(HYST, max_hyst);
806
807 #define show_temp_reg(reg) \
808 static ssize_t \
809 show_##reg(struct device *dev, struct device_attribute *attr, \
810            char *buf) \
811 { \
812         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
813         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
814         int nr = sensor_attr->index; \
815         return sprintf(buf, "%d\n", \
816                        LM75_TEMP_FROM_REG(data->reg[nr])); \
817 }
818 show_temp_reg(temp);
819 show_temp_reg(temp_max);
820 show_temp_reg(temp_max_hyst);
821
822 #define store_temp_reg(REG, reg) \
823 static ssize_t \
824 store_##reg(struct device *dev, struct device_attribute *attr, \
825             const char *buf, size_t count) \
826 { \
827         struct w83627ehf_data *data = dev_get_drvdata(dev); \
828         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
829         int nr = sensor_attr->index; \
830         u32 val = simple_strtoul(buf, NULL, 10); \
831  \
832         mutex_lock(&data->update_lock); \
833         data->reg[nr] = LM75_TEMP_TO_REG(val); \
834         w83627ehf_write_value(data, W83627EHF_REG_TEMP_##REG[nr], \
835                               data->reg[nr]); \
836         mutex_unlock(&data->update_lock); \
837         return count; \
838 }
839 store_temp_reg(OVER, temp_max);
840 store_temp_reg(HYST, temp_max_hyst);
841
842 static struct sensor_device_attribute sda_temp[] = {
843         SENSOR_ATTR(temp1_input, S_IRUGO, show_temp1, NULL, 0),
844         SENSOR_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 0),
845         SENSOR_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 1),
846         SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp1_max,
847                     store_temp1_max, 0),
848         SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
849                     store_temp_max, 0),
850         SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
851                     store_temp_max, 1),
852         SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp1_max_hyst,
853                     store_temp1_max_hyst, 0),
854         SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
855                     store_temp_max_hyst, 0),
856         SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
857                     store_temp_max_hyst, 1),
858         SENSOR_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4),
859         SENSOR_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5),
860         SENSOR_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13),
861 };
862
863 #define show_pwm_reg(reg) \
864 static ssize_t show_##reg (struct device *dev, struct device_attribute *attr, \
865                                 char *buf) \
866 { \
867         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
868         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
869         int nr = sensor_attr->index; \
870         return sprintf(buf, "%d\n", data->reg[nr]); \
871 }
872
873 show_pwm_reg(pwm_mode)
874 show_pwm_reg(pwm_enable)
875 show_pwm_reg(pwm)
876
877 static ssize_t
878 store_pwm_mode(struct device *dev, struct device_attribute *attr,
879                         const char *buf, size_t count)
880 {
881         struct w83627ehf_data *data = dev_get_drvdata(dev);
882         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
883         int nr = sensor_attr->index;
884         u32 val = simple_strtoul(buf, NULL, 10);
885         u16 reg;
886
887         if (val > 1)
888                 return -EINVAL;
889         mutex_lock(&data->update_lock);
890         reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
891         data->pwm_mode[nr] = val;
892         reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
893         if (!val)
894                 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
895         w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
896         mutex_unlock(&data->update_lock);
897         return count;
898 }
899
900 static ssize_t
901 store_pwm(struct device *dev, struct device_attribute *attr,
902                         const char *buf, size_t count)
903 {
904         struct w83627ehf_data *data = dev_get_drvdata(dev);
905         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
906         int nr = sensor_attr->index;
907         u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 0, 255);
908
909         mutex_lock(&data->update_lock);
910         data->pwm[nr] = val;
911         w83627ehf_write_value(data, W83627EHF_REG_PWM[nr], val);
912         mutex_unlock(&data->update_lock);
913         return count;
914 }
915
916 static ssize_t
917 store_pwm_enable(struct device *dev, struct device_attribute *attr,
918                         const char *buf, size_t count)
919 {
920         struct w83627ehf_data *data = dev_get_drvdata(dev);
921         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
922         int nr = sensor_attr->index;
923         u32 val = simple_strtoul(buf, NULL, 10);
924         u16 reg;
925
926         if (!val || (val > 2))  /* only modes 1 and 2 are supported */
927                 return -EINVAL;
928         mutex_lock(&data->update_lock);
929         reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
930         data->pwm_enable[nr] = val;
931         reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
932         reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
933         w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
934         mutex_unlock(&data->update_lock);
935         return count;
936 }
937
938
939 #define show_tol_temp(reg) \
940 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
941                                 char *buf) \
942 { \
943         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
944         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
945         int nr = sensor_attr->index; \
946         return sprintf(buf, "%d\n", temp1_from_reg(data->reg[nr])); \
947 }
948
949 show_tol_temp(tolerance)
950 show_tol_temp(target_temp)
951
952 static ssize_t
953 store_target_temp(struct device *dev, struct device_attribute *attr,
954                         const char *buf, size_t count)
955 {
956         struct w83627ehf_data *data = dev_get_drvdata(dev);
957         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
958         int nr = sensor_attr->index;
959         u8 val = temp1_to_reg(simple_strtoul(buf, NULL, 10), 0, 127000);
960
961         mutex_lock(&data->update_lock);
962         data->target_temp[nr] = val;
963         w83627ehf_write_value(data, W83627EHF_REG_TARGET[nr], val);
964         mutex_unlock(&data->update_lock);
965         return count;
966 }
967
968 static ssize_t
969 store_tolerance(struct device *dev, struct device_attribute *attr,
970                         const char *buf, size_t count)
971 {
972         struct w83627ehf_data *data = dev_get_drvdata(dev);
973         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
974         int nr = sensor_attr->index;
975         u16 reg;
976         /* Limit the temp to 0C - 15C */
977         u8 val = temp1_to_reg(simple_strtoul(buf, NULL, 10), 0, 15000);
978
979         mutex_lock(&data->update_lock);
980         reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
981         data->tolerance[nr] = val;
982         if (nr == 1)
983                 reg = (reg & 0x0f) | (val << 4);
984         else
985                 reg = (reg & 0xf0) | val;
986         w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
987         mutex_unlock(&data->update_lock);
988         return count;
989 }
990
991 static struct sensor_device_attribute sda_pwm[] = {
992         SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
993         SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
994         SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
995         SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
996 };
997
998 static struct sensor_device_attribute sda_pwm_mode[] = {
999         SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1000                     store_pwm_mode, 0),
1001         SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1002                     store_pwm_mode, 1),
1003         SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1004                     store_pwm_mode, 2),
1005         SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1006                     store_pwm_mode, 3),
1007 };
1008
1009 static struct sensor_device_attribute sda_pwm_enable[] = {
1010         SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1011                     store_pwm_enable, 0),
1012         SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1013                     store_pwm_enable, 1),
1014         SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1015                     store_pwm_enable, 2),
1016         SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1017                     store_pwm_enable, 3),
1018 };
1019
1020 static struct sensor_device_attribute sda_target_temp[] = {
1021         SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1022                     store_target_temp, 0),
1023         SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1024                     store_target_temp, 1),
1025         SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1026                     store_target_temp, 2),
1027         SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1028                     store_target_temp, 3),
1029 };
1030
1031 static struct sensor_device_attribute sda_tolerance[] = {
1032         SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1033                     store_tolerance, 0),
1034         SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1035                     store_tolerance, 1),
1036         SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1037                     store_tolerance, 2),
1038         SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1039                     store_tolerance, 3),
1040 };
1041
1042 /* Smart Fan registers */
1043
1044 #define fan_functions(reg, REG) \
1045 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1046                        char *buf) \
1047 { \
1048         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1049         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1050         int nr = sensor_attr->index; \
1051         return sprintf(buf, "%d\n", data->reg[nr]); \
1052 }\
1053 static ssize_t \
1054 store_##reg(struct device *dev, struct device_attribute *attr, \
1055                             const char *buf, size_t count) \
1056 {\
1057         struct w83627ehf_data *data = dev_get_drvdata(dev); \
1058         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1059         int nr = sensor_attr->index; \
1060         u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 1, 255); \
1061         mutex_lock(&data->update_lock); \
1062         data->reg[nr] = val; \
1063         w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
1064         mutex_unlock(&data->update_lock); \
1065         return count; \
1066 }
1067
1068 fan_functions(fan_min_output, FAN_MIN_OUTPUT)
1069
1070 #define fan_time_functions(reg, REG) \
1071 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1072                                 char *buf) \
1073 { \
1074         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1075         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1076         int nr = sensor_attr->index; \
1077         return sprintf(buf, "%d\n", \
1078                         step_time_from_reg(data->reg[nr], data->pwm_mode[nr])); \
1079 } \
1080 \
1081 static ssize_t \
1082 store_##reg(struct device *dev, struct device_attribute *attr, \
1083                         const char *buf, size_t count) \
1084 { \
1085         struct w83627ehf_data *data = dev_get_drvdata(dev); \
1086         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1087         int nr = sensor_attr->index; \
1088         u8 val = step_time_to_reg(simple_strtoul(buf, NULL, 10), \
1089                                         data->pwm_mode[nr]); \
1090         mutex_lock(&data->update_lock); \
1091         data->reg[nr] = val; \
1092         w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
1093         mutex_unlock(&data->update_lock); \
1094         return count; \
1095 } \
1096
1097 fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1098
1099 static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1100                          char *buf)
1101 {
1102         struct w83627ehf_data *data = dev_get_drvdata(dev);
1103
1104         return sprintf(buf, "%s\n", data->name);
1105 }
1106 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1107
1108 static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1109         SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1110                     store_fan_stop_time, 3),
1111         SENSOR_ATTR(pwm4_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1112                     store_fan_min_output, 3),
1113 };
1114
1115 static struct sensor_device_attribute sda_sf3_arrays[] = {
1116         SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1117                     store_fan_stop_time, 0),
1118         SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1119                     store_fan_stop_time, 1),
1120         SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1121                     store_fan_stop_time, 2),
1122         SENSOR_ATTR(pwm1_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1123                     store_fan_min_output, 0),
1124         SENSOR_ATTR(pwm2_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1125                     store_fan_min_output, 1),
1126         SENSOR_ATTR(pwm3_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1127                     store_fan_min_output, 2),
1128 };
1129
1130 /*
1131  * Driver and device management
1132  */
1133
1134 static void w83627ehf_device_remove_files(struct device *dev)
1135 {
1136         /* some entries in the following arrays may not have been used in
1137          * device_create_file(), but device_remove_file() will ignore them */
1138         int i;
1139         struct w83627ehf_data *data = dev_get_drvdata(dev);
1140
1141         for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1142                 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
1143         for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1144                 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
1145         for (i = 0; i < data->in_num; i++) {
1146                 device_remove_file(dev, &sda_in_input[i].dev_attr);
1147                 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1148                 device_remove_file(dev, &sda_in_min[i].dev_attr);
1149                 device_remove_file(dev, &sda_in_max[i].dev_attr);
1150         }
1151         for (i = 0; i < 5; i++) {
1152                 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1153                 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1154                 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1155                 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1156         }
1157         for (i = 0; i < 4; i++) {
1158                 device_remove_file(dev, &sda_pwm[i].dev_attr);
1159                 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1160                 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1161                 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1162                 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1163         }
1164         for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
1165                 device_remove_file(dev, &sda_temp[i].dev_attr);
1166
1167         device_remove_file(dev, &dev_attr_name);
1168 }
1169
1170 /* Get the monitoring functions started */
1171 static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data)
1172 {
1173         int i;
1174         u8 tmp;
1175
1176         /* Start monitoring is needed */
1177         tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
1178         if (!(tmp & 0x01))
1179                 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
1180                                       tmp | 0x01);
1181
1182         /* Enable temp2 and temp3 if needed */
1183         for (i = 0; i < 2; i++) {
1184                 tmp = w83627ehf_read_value(data,
1185                                            W83627EHF_REG_TEMP_CONFIG[i]);
1186                 if (tmp & 0x01)
1187                         w83627ehf_write_value(data,
1188                                               W83627EHF_REG_TEMP_CONFIG[i],
1189                                               tmp & 0xfe);
1190         }
1191 }
1192
1193 static int __devinit w83627ehf_probe(struct platform_device *pdev)
1194 {
1195         struct device *dev = &pdev->dev;
1196         struct w83627ehf_sio_data *sio_data = dev->platform_data;
1197         struct w83627ehf_data *data;
1198         struct resource *res;
1199         u8 fan4pin, fan5pin;
1200         int i, err = 0;
1201
1202         res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1203         if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
1204                 err = -EBUSY;
1205                 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1206                         (unsigned long)res->start,
1207                         (unsigned long)res->start + IOREGION_LENGTH - 1);
1208                 goto exit;
1209         }
1210
1211         if (!(data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL))) {
1212                 err = -ENOMEM;
1213                 goto exit_release;
1214         }
1215
1216         data->addr = res->start;
1217         mutex_init(&data->lock);
1218         mutex_init(&data->update_lock);
1219         data->name = w83627ehf_device_names[sio_data->kind];
1220         platform_set_drvdata(pdev, data);
1221
1222         /* 627EHG and 627EHF have 10 voltage inputs; DHG has 9 */
1223         data->in_num = (sio_data->kind == w83627dhg) ? 9 : 10;
1224
1225         /* Initialize the chip */
1226         w83627ehf_init_device(data);
1227
1228         /* A few vars need to be filled upon startup */
1229         for (i = 0; i < 5; i++)
1230                 data->fan_min[i] = w83627ehf_read_value(data,
1231                                    W83627EHF_REG_FAN_MIN[i]);
1232
1233         /* fan4 and fan5 share some pins with the GPIO and serial flash */
1234
1235         superio_enter(sio_data->sioreg);
1236         fan5pin = superio_inb(sio_data->sioreg, 0x24) & 0x2;
1237         fan4pin = superio_inb(sio_data->sioreg, 0x29) & 0x6;
1238         superio_exit(sio_data->sioreg);
1239
1240         /* It looks like fan4 and fan5 pins can be alternatively used
1241            as fan on/off switches, but fan5 control is write only :/
1242            We assume that if the serial interface is disabled, designers
1243            connected fan5 as input unless they are emitting log 1, which
1244            is not the default. */
1245
1246         data->has_fan = 0x07; /* fan1, fan2 and fan3 */
1247         i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
1248         if ((i & (1 << 2)) && (!fan4pin))
1249                 data->has_fan |= (1 << 3);
1250         if (!(i & (1 << 1)) && (!fan5pin))
1251                 data->has_fan |= (1 << 4);
1252
1253         /* Register sysfs hooks */
1254         for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1255                 if ((err = device_create_file(dev,
1256                         &sda_sf3_arrays[i].dev_attr)))
1257                         goto exit_remove;
1258
1259         /* if fan4 is enabled create the sf3 files for it */
1260         if (data->has_fan & (1 << 3))
1261                 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
1262                         if ((err = device_create_file(dev,
1263                                 &sda_sf3_arrays_fan4[i].dev_attr)))
1264                                 goto exit_remove;
1265                 }
1266
1267         for (i = 0; i < data->in_num; i++)
1268                 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
1269                         || (err = device_create_file(dev,
1270                                 &sda_in_alarm[i].dev_attr))
1271                         || (err = device_create_file(dev,
1272                                 &sda_in_min[i].dev_attr))
1273                         || (err = device_create_file(dev,
1274                                 &sda_in_max[i].dev_attr)))
1275                         goto exit_remove;
1276
1277         for (i = 0; i < 5; i++) {
1278                 if (data->has_fan & (1 << i)) {
1279                         if ((err = device_create_file(dev,
1280                                         &sda_fan_input[i].dev_attr))
1281                                 || (err = device_create_file(dev,
1282                                         &sda_fan_alarm[i].dev_attr))
1283                                 || (err = device_create_file(dev,
1284                                         &sda_fan_div[i].dev_attr))
1285                                 || (err = device_create_file(dev,
1286                                         &sda_fan_min[i].dev_attr)))
1287                                 goto exit_remove;
1288                         if (i < 4 && /* w83627ehf only has 4 pwm */
1289                                 ((err = device_create_file(dev,
1290                                         &sda_pwm[i].dev_attr))
1291                                 || (err = device_create_file(dev,
1292                                         &sda_pwm_mode[i].dev_attr))
1293                                 || (err = device_create_file(dev,
1294                                         &sda_pwm_enable[i].dev_attr))
1295                                 || (err = device_create_file(dev,
1296                                         &sda_target_temp[i].dev_attr))
1297                                 || (err = device_create_file(dev,
1298                                         &sda_tolerance[i].dev_attr))))
1299                                 goto exit_remove;
1300                 }
1301         }
1302
1303         for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
1304                 if ((err = device_create_file(dev, &sda_temp[i].dev_attr)))
1305                         goto exit_remove;
1306
1307         err = device_create_file(dev, &dev_attr_name);
1308         if (err)
1309                 goto exit_remove;
1310
1311         data->class_dev = hwmon_device_register(dev);
1312         if (IS_ERR(data->class_dev)) {
1313                 err = PTR_ERR(data->class_dev);
1314                 goto exit_remove;
1315         }
1316
1317         return 0;
1318
1319 exit_remove:
1320         w83627ehf_device_remove_files(dev);
1321         kfree(data);
1322         platform_set_drvdata(pdev, NULL);
1323 exit_release:
1324         release_region(res->start, IOREGION_LENGTH);
1325 exit:
1326         return err;
1327 }
1328
1329 static int __devexit w83627ehf_remove(struct platform_device *pdev)
1330 {
1331         struct w83627ehf_data *data = platform_get_drvdata(pdev);
1332
1333         hwmon_device_unregister(data->class_dev);
1334         w83627ehf_device_remove_files(&pdev->dev);
1335         release_region(data->addr, IOREGION_LENGTH);
1336         platform_set_drvdata(pdev, NULL);
1337         kfree(data);
1338
1339         return 0;
1340 }
1341
1342 static struct platform_driver w83627ehf_driver = {
1343         .driver = {
1344                 .owner  = THIS_MODULE,
1345                 .name   = DRVNAME,
1346         },
1347         .probe          = w83627ehf_probe,
1348         .remove         = __devexit_p(w83627ehf_remove),
1349 };
1350
1351 /* w83627ehf_find() looks for a '627 in the Super-I/O config space */
1352 static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
1353                                  struct w83627ehf_sio_data *sio_data)
1354 {
1355         static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
1356         static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
1357         static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
1358
1359         u16 val;
1360         const char *sio_name;
1361
1362         superio_enter(sioaddr);
1363
1364         val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
1365             | superio_inb(sioaddr, SIO_REG_DEVID + 1);
1366         switch (val & SIO_ID_MASK) {
1367         case SIO_W83627EHF_ID:
1368                 sio_data->kind = w83627ehf;
1369                 sio_name = sio_name_W83627EHF;
1370                 break;
1371         case SIO_W83627EHG_ID:
1372                 sio_data->kind = w83627ehf;
1373                 sio_name = sio_name_W83627EHG;
1374                 break;
1375         case SIO_W83627DHG_ID:
1376                 sio_data->kind = w83627dhg;
1377                 sio_name = sio_name_W83627DHG;
1378                 break;
1379         default:
1380                 pr_info(DRVNAME ": unsupported chip ID: 0x%04x\n",
1381                         val);
1382                 superio_exit(sioaddr);
1383                 return -ENODEV;
1384         }
1385
1386         /* We have a known chip, find the HWM I/O address */
1387         superio_select(sioaddr, W83627EHF_LD_HWM);
1388         val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
1389             | superio_inb(sioaddr, SIO_REG_ADDR + 1);
1390         *addr = val & IOREGION_ALIGNMENT;
1391         if (*addr == 0) {
1392                 printk(KERN_ERR DRVNAME ": Refusing to enable a Super-I/O "
1393                        "device with a base I/O port 0.\n");
1394                 superio_exit(sioaddr);
1395                 return -ENODEV;
1396         }
1397
1398         /* Activate logical device if needed */
1399         val = superio_inb(sioaddr, SIO_REG_ENABLE);
1400         if (!(val & 0x01)) {
1401                 printk(KERN_WARNING DRVNAME ": Forcibly enabling Super-I/O. "
1402                        "Sensor is probably unusable.\n");
1403                 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
1404         }
1405
1406         superio_exit(sioaddr);
1407         pr_info(DRVNAME ": Found %s chip at %#x\n", sio_name, *addr);
1408         sio_data->sioreg = sioaddr;
1409
1410         return 0;
1411 }
1412
1413 /* when Super-I/O functions move to a separate file, the Super-I/O
1414  * bus will manage the lifetime of the device and this module will only keep
1415  * track of the w83627ehf driver. But since we platform_device_alloc(), we
1416  * must keep track of the device */
1417 static struct platform_device *pdev;
1418
1419 static int __init sensors_w83627ehf_init(void)
1420 {
1421         int err;
1422         unsigned short address;
1423         struct resource res;
1424         struct w83627ehf_sio_data sio_data;
1425
1426         /* initialize sio_data->kind and sio_data->sioreg.
1427          *
1428          * when Super-I/O functions move to a separate file, the Super-I/O
1429          * driver will probe 0x2e and 0x4e and auto-detect the presence of a
1430          * w83627ehf hardware monitor, and call probe() */
1431         if (w83627ehf_find(0x2e, &address, &sio_data) &&
1432             w83627ehf_find(0x4e, &address, &sio_data))
1433                 return -ENODEV;
1434
1435         err = platform_driver_register(&w83627ehf_driver);
1436         if (err)
1437                 goto exit;
1438
1439         if (!(pdev = platform_device_alloc(DRVNAME, address))) {
1440                 err = -ENOMEM;
1441                 printk(KERN_ERR DRVNAME ": Device allocation failed\n");
1442                 goto exit_unregister;
1443         }
1444
1445         err = platform_device_add_data(pdev, &sio_data,
1446                                        sizeof(struct w83627ehf_sio_data));
1447         if (err) {
1448                 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1449                 goto exit_device_put;
1450         }
1451
1452         memset(&res, 0, sizeof(res));
1453         res.name = DRVNAME;
1454         res.start = address + IOREGION_OFFSET;
1455         res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
1456         res.flags = IORESOURCE_IO;
1457         err = platform_device_add_resources(pdev, &res, 1);
1458         if (err) {
1459                 printk(KERN_ERR DRVNAME ": Device resource addition failed "
1460                        "(%d)\n", err);
1461                 goto exit_device_put;
1462         }
1463
1464         /* platform_device_add calls probe() */
1465         err = platform_device_add(pdev);
1466         if (err) {
1467                 printk(KERN_ERR DRVNAME ": Device addition failed (%d)\n",
1468                        err);
1469                 goto exit_device_put;
1470         }
1471
1472         return 0;
1473
1474 exit_device_put:
1475         platform_device_put(pdev);
1476 exit_unregister:
1477         platform_driver_unregister(&w83627ehf_driver);
1478 exit:
1479         return err;
1480 }
1481
1482 static void __exit sensors_w83627ehf_exit(void)
1483 {
1484         platform_device_unregister(pdev);
1485         platform_driver_unregister(&w83627ehf_driver);
1486 }
1487
1488 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
1489 MODULE_DESCRIPTION("W83627EHF driver");
1490 MODULE_LICENSE("GPL");
1491
1492 module_init(sensors_w83627ehf_init);
1493 module_exit(sensors_w83627ehf_exit);