Merge branch 'upstream'
[pandora-kernel.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
6     Shamelessly ripped from the w83627hf driver
7     Copyright (C) 2003  Mark Studebaker
8
9     Thanks to Leon Moonen, Steve Cliffe and Grant Coady for their help
10     in testing and debugging this driver.
11
12     This driver also supports the W83627EHG, which is the lead-free
13     version of the W83627EHF.
14
15     This program is free software; you can redistribute it and/or modify
16     it under the terms of the GNU General Public License as published by
17     the Free Software Foundation; either version 2 of the License, or
18     (at your option) any later version.
19
20     This program is distributed in the hope that it will be useful,
21     but WITHOUT ANY WARRANTY; without even the implied warranty of
22     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
23     GNU General Public License for more details.
24
25     You should have received a copy of the GNU General Public License
26     along with this program; if not, write to the Free Software
27     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
28
29
30     Supports the following chips:
31
32     Chip        #vin    #fan    #pwm    #temp   chip_id man_id
33     w83627ehf   -       5       -       3       0x88    0x5ca3
34
35     This is a preliminary version of the driver, only supporting the
36     fan and temperature inputs. The chip does much more than that.
37 */
38
39 #include <linux/module.h>
40 #include <linux/init.h>
41 #include <linux/slab.h>
42 #include <linux/i2c.h>
43 #include <linux/i2c-isa.h>
44 #include <linux/hwmon.h>
45 #include <linux/hwmon-sysfs.h>
46 #include <linux/err.h>
47 #include <linux/mutex.h>
48 #include <asm/io.h>
49 #include "lm75.h"
50
51 /* The actual ISA address is read from Super-I/O configuration space */
52 static unsigned short address;
53
54 /*
55  * Super-I/O constants and functions
56  */
57
58 static int REG;         /* The register to read/write */
59 static int VAL;         /* The value to read/write */
60
61 #define W83627EHF_LD_HWM        0x0b
62
63 #define SIO_REG_LDSEL           0x07    /* Logical device select */
64 #define SIO_REG_DEVID           0x20    /* Device ID (2 bytes) */
65 #define SIO_REG_ENABLE          0x30    /* Logical device enable */
66 #define SIO_REG_ADDR            0x60    /* Logical device address (2 bytes) */
67
68 #define SIO_W83627EHF_ID        0x8840
69 #define SIO_ID_MASK             0xFFC0
70
71 static inline void
72 superio_outb(int reg, int val)
73 {
74         outb(reg, REG);
75         outb(val, VAL);
76 }
77
78 static inline int
79 superio_inb(int reg)
80 {
81         outb(reg, REG);
82         return inb(VAL);
83 }
84
85 static inline void
86 superio_select(int ld)
87 {
88         outb(SIO_REG_LDSEL, REG);
89         outb(ld, VAL);
90 }
91
92 static inline void
93 superio_enter(void)
94 {
95         outb(0x87, REG);
96         outb(0x87, REG);
97 }
98
99 static inline void
100 superio_exit(void)
101 {
102         outb(0x02, REG);
103         outb(0x02, VAL);
104 }
105
106 /*
107  * ISA constants
108  */
109
110 #define REGION_ALIGNMENT        ~7
111 #define REGION_OFFSET           5
112 #define REGION_LENGTH           2
113 #define ADDR_REG_OFFSET         5
114 #define DATA_REG_OFFSET         6
115
116 #define W83627EHF_REG_BANK              0x4E
117 #define W83627EHF_REG_CONFIG            0x40
118 #define W83627EHF_REG_CHIP_ID           0x49
119 #define W83627EHF_REG_MAN_ID            0x4F
120
121 static const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 };
122 static const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c };
123
124 #define W83627EHF_REG_TEMP1             0x27
125 #define W83627EHF_REG_TEMP1_HYST        0x3a
126 #define W83627EHF_REG_TEMP1_OVER        0x39
127 static const u16 W83627EHF_REG_TEMP[] = { 0x150, 0x250 };
128 static const u16 W83627EHF_REG_TEMP_HYST[] = { 0x153, 0x253 };
129 static const u16 W83627EHF_REG_TEMP_OVER[] = { 0x155, 0x255 };
130 static const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0x152, 0x252 };
131
132 /* Fan clock dividers are spread over the following five registers */
133 #define W83627EHF_REG_FANDIV1           0x47
134 #define W83627EHF_REG_FANDIV2           0x4B
135 #define W83627EHF_REG_VBAT              0x5D
136 #define W83627EHF_REG_DIODE             0x59
137 #define W83627EHF_REG_SMI_OVT           0x4C
138
139 /*
140  * Conversions
141  */
142
143 static inline unsigned int
144 fan_from_reg(u8 reg, unsigned int div)
145 {
146         if (reg == 0 || reg == 255)
147                 return 0;
148         return 1350000U / (reg * div);
149 }
150
151 static inline unsigned int
152 div_from_reg(u8 reg)
153 {
154         return 1 << reg;
155 }
156
157 static inline int
158 temp1_from_reg(s8 reg)
159 {
160         return reg * 1000;
161 }
162
163 static inline s8
164 temp1_to_reg(int temp)
165 {
166         if (temp <= -128000)
167                 return -128;
168         if (temp >= 127000)
169                 return 127;
170         if (temp < 0)
171                 return (temp - 500) / 1000;
172         return (temp + 500) / 1000;
173 }
174
175 /*
176  * Data structures and manipulation thereof
177  */
178
179 struct w83627ehf_data {
180         struct i2c_client client;
181         struct class_device *class_dev;
182         struct mutex lock;
183
184         struct mutex update_lock;
185         char valid;             /* !=0 if following fields are valid */
186         unsigned long last_updated;     /* In jiffies */
187
188         /* Register values */
189         u8 fan[5];
190         u8 fan_min[5];
191         u8 fan_div[5];
192         u8 has_fan;             /* some fan inputs can be disabled */
193         s8 temp1;
194         s8 temp1_max;
195         s8 temp1_max_hyst;
196         s16 temp[2];
197         s16 temp_max[2];
198         s16 temp_max_hyst[2];
199 };
200
201 static inline int is_word_sized(u16 reg)
202 {
203         return (((reg & 0xff00) == 0x100
204               || (reg & 0xff00) == 0x200)
205              && ((reg & 0x00ff) == 0x50
206               || (reg & 0x00ff) == 0x53
207               || (reg & 0x00ff) == 0x55));
208 }
209
210 /* We assume that the default bank is 0, thus the following two functions do
211    nothing for registers which live in bank 0. For others, they respectively
212    set the bank register to the correct value (before the register is
213    accessed), and back to 0 (afterwards). */
214 static inline void w83627ehf_set_bank(struct i2c_client *client, u16 reg)
215 {
216         if (reg & 0xff00) {
217                 outb_p(W83627EHF_REG_BANK, client->addr + ADDR_REG_OFFSET);
218                 outb_p(reg >> 8, client->addr + DATA_REG_OFFSET);
219         }
220 }
221
222 static inline void w83627ehf_reset_bank(struct i2c_client *client, u16 reg)
223 {
224         if (reg & 0xff00) {
225                 outb_p(W83627EHF_REG_BANK, client->addr + ADDR_REG_OFFSET);
226                 outb_p(0, client->addr + DATA_REG_OFFSET);
227         }
228 }
229
230 static u16 w83627ehf_read_value(struct i2c_client *client, u16 reg)
231 {
232         struct w83627ehf_data *data = i2c_get_clientdata(client);
233         int res, word_sized = is_word_sized(reg);
234
235         mutex_lock(&data->lock);
236
237         w83627ehf_set_bank(client, reg);
238         outb_p(reg & 0xff, client->addr + ADDR_REG_OFFSET);
239         res = inb_p(client->addr + DATA_REG_OFFSET);
240         if (word_sized) {
241                 outb_p((reg & 0xff) + 1,
242                        client->addr + ADDR_REG_OFFSET);
243                 res = (res << 8) + inb_p(client->addr + DATA_REG_OFFSET);
244         }
245         w83627ehf_reset_bank(client, reg);
246
247         mutex_unlock(&data->lock);
248
249         return res;
250 }
251
252 static int w83627ehf_write_value(struct i2c_client *client, u16 reg, u16 value)
253 {
254         struct w83627ehf_data *data = i2c_get_clientdata(client);
255         int word_sized = is_word_sized(reg);
256
257         mutex_lock(&data->lock);
258
259         w83627ehf_set_bank(client, reg);
260         outb_p(reg & 0xff, client->addr + ADDR_REG_OFFSET);
261         if (word_sized) {
262                 outb_p(value >> 8, client->addr + DATA_REG_OFFSET);
263                 outb_p((reg & 0xff) + 1,
264                        client->addr + ADDR_REG_OFFSET);
265         }
266         outb_p(value & 0xff, client->addr + DATA_REG_OFFSET);
267         w83627ehf_reset_bank(client, reg);
268
269         mutex_unlock(&data->lock);
270         return 0;
271 }
272
273 /* This function assumes that the caller holds data->update_lock */
274 static void w83627ehf_write_fan_div(struct i2c_client *client, int nr)
275 {
276         struct w83627ehf_data *data = i2c_get_clientdata(client);
277         u8 reg;
278
279         switch (nr) {
280         case 0:
281                 reg = (w83627ehf_read_value(client, W83627EHF_REG_FANDIV1) & 0xcf)
282                     | ((data->fan_div[0] & 0x03) << 4);
283                 w83627ehf_write_value(client, W83627EHF_REG_FANDIV1, reg);
284                 reg = (w83627ehf_read_value(client, W83627EHF_REG_VBAT) & 0xdf)
285                     | ((data->fan_div[0] & 0x04) << 3);
286                 w83627ehf_write_value(client, W83627EHF_REG_VBAT, reg);
287                 break;
288         case 1:
289                 reg = (w83627ehf_read_value(client, W83627EHF_REG_FANDIV1) & 0x3f)
290                     | ((data->fan_div[1] & 0x03) << 6);
291                 w83627ehf_write_value(client, W83627EHF_REG_FANDIV1, reg);
292                 reg = (w83627ehf_read_value(client, W83627EHF_REG_VBAT) & 0xbf)
293                     | ((data->fan_div[1] & 0x04) << 4);
294                 w83627ehf_write_value(client, W83627EHF_REG_VBAT, reg);
295                 break;
296         case 2:
297                 reg = (w83627ehf_read_value(client, W83627EHF_REG_FANDIV2) & 0x3f)
298                     | ((data->fan_div[2] & 0x03) << 6);
299                 w83627ehf_write_value(client, W83627EHF_REG_FANDIV2, reg);
300                 reg = (w83627ehf_read_value(client, W83627EHF_REG_VBAT) & 0x7f)
301                     | ((data->fan_div[2] & 0x04) << 5);
302                 w83627ehf_write_value(client, W83627EHF_REG_VBAT, reg);
303                 break;
304         case 3:
305                 reg = (w83627ehf_read_value(client, W83627EHF_REG_DIODE) & 0xfc)
306                     | (data->fan_div[3] & 0x03);
307                 w83627ehf_write_value(client, W83627EHF_REG_DIODE, reg);
308                 reg = (w83627ehf_read_value(client, W83627EHF_REG_SMI_OVT) & 0x7f)
309                     | ((data->fan_div[3] & 0x04) << 5);
310                 w83627ehf_write_value(client, W83627EHF_REG_SMI_OVT, reg);
311                 break;
312         case 4:
313                 reg = (w83627ehf_read_value(client, W83627EHF_REG_DIODE) & 0x73)
314                     | ((data->fan_div[4] & 0x03) << 3)
315                     | ((data->fan_div[4] & 0x04) << 5);
316                 w83627ehf_write_value(client, W83627EHF_REG_DIODE, reg);
317                 break;
318         }
319 }
320
321 static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
322 {
323         struct i2c_client *client = to_i2c_client(dev);
324         struct w83627ehf_data *data = i2c_get_clientdata(client);
325         int i;
326
327         mutex_lock(&data->update_lock);
328
329         if (time_after(jiffies, data->last_updated + HZ)
330          || !data->valid) {
331                 /* Fan clock dividers */
332                 i = w83627ehf_read_value(client, W83627EHF_REG_FANDIV1);
333                 data->fan_div[0] = (i >> 4) & 0x03;
334                 data->fan_div[1] = (i >> 6) & 0x03;
335                 i = w83627ehf_read_value(client, W83627EHF_REG_FANDIV2);
336                 data->fan_div[2] = (i >> 6) & 0x03;
337                 i = w83627ehf_read_value(client, W83627EHF_REG_VBAT);
338                 data->fan_div[0] |= (i >> 3) & 0x04;
339                 data->fan_div[1] |= (i >> 4) & 0x04;
340                 data->fan_div[2] |= (i >> 5) & 0x04;
341                 if (data->has_fan & ((1 << 3) | (1 << 4))) {
342                         i = w83627ehf_read_value(client, W83627EHF_REG_DIODE);
343                         data->fan_div[3] = i & 0x03;
344                         data->fan_div[4] = ((i >> 2) & 0x03)
345                                          | ((i >> 5) & 0x04);
346                 }
347                 if (data->has_fan & (1 << 3)) {
348                         i = w83627ehf_read_value(client, W83627EHF_REG_SMI_OVT);
349                         data->fan_div[3] |= (i >> 5) & 0x04;
350                 }
351
352                 /* Measured fan speeds and limits */
353                 for (i = 0; i < 5; i++) {
354                         if (!(data->has_fan & (1 << i)))
355                                 continue;
356
357                         data->fan[i] = w83627ehf_read_value(client,
358                                        W83627EHF_REG_FAN[i]);
359                         data->fan_min[i] = w83627ehf_read_value(client,
360                                            W83627EHF_REG_FAN_MIN[i]);
361
362                         /* If we failed to measure the fan speed and clock
363                            divider can be increased, let's try that for next
364                            time */
365                         if (data->fan[i] == 0xff
366                          && data->fan_div[i] < 0x07) {
367                                 dev_dbg(&client->dev, "Increasing fan %d "
368                                         "clock divider from %u to %u\n",
369                                         i, div_from_reg(data->fan_div[i]),
370                                         div_from_reg(data->fan_div[i] + 1));
371                                 data->fan_div[i]++;
372                                 w83627ehf_write_fan_div(client, i);
373                                 /* Preserve min limit if possible */
374                                 if (data->fan_min[i] >= 2
375                                  && data->fan_min[i] != 255)
376                                         w83627ehf_write_value(client,
377                                                 W83627EHF_REG_FAN_MIN[i],
378                                                 (data->fan_min[i] /= 2));
379                         }
380                 }
381
382                 /* Measured temperatures and limits */
383                 data->temp1 = w83627ehf_read_value(client,
384                               W83627EHF_REG_TEMP1);
385                 data->temp1_max = w83627ehf_read_value(client,
386                                   W83627EHF_REG_TEMP1_OVER);
387                 data->temp1_max_hyst = w83627ehf_read_value(client,
388                                        W83627EHF_REG_TEMP1_HYST);
389                 for (i = 0; i < 2; i++) {
390                         data->temp[i] = w83627ehf_read_value(client,
391                                         W83627EHF_REG_TEMP[i]);
392                         data->temp_max[i] = w83627ehf_read_value(client,
393                                             W83627EHF_REG_TEMP_OVER[i]);
394                         data->temp_max_hyst[i] = w83627ehf_read_value(client,
395                                                  W83627EHF_REG_TEMP_HYST[i]);
396                 }
397
398                 data->last_updated = jiffies;
399                 data->valid = 1;
400         }
401
402         mutex_unlock(&data->update_lock);
403         return data;
404 }
405
406 /*
407  * Sysfs callback functions
408  */
409
410 #define show_fan_reg(reg) \
411 static ssize_t \
412 show_##reg(struct device *dev, struct device_attribute *attr, \
413            char *buf) \
414 { \
415         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
416         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
417         int nr = sensor_attr->index; \
418         return sprintf(buf, "%d\n", \
419                        fan_from_reg(data->reg[nr], \
420                                     div_from_reg(data->fan_div[nr]))); \
421 }
422 show_fan_reg(fan);
423 show_fan_reg(fan_min);
424
425 static ssize_t
426 show_fan_div(struct device *dev, struct device_attribute *attr,
427              char *buf)
428 {
429         struct w83627ehf_data *data = w83627ehf_update_device(dev);
430         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
431         int nr = sensor_attr->index;
432         return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
433 }
434
435 static ssize_t
436 store_fan_min(struct device *dev, struct device_attribute *attr,
437               const char *buf, size_t count)
438 {
439         struct i2c_client *client = to_i2c_client(dev);
440         struct w83627ehf_data *data = i2c_get_clientdata(client);
441         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
442         int nr = sensor_attr->index;
443         unsigned int val = simple_strtoul(buf, NULL, 10);
444         unsigned int reg;
445         u8 new_div;
446
447         mutex_lock(&data->update_lock);
448         if (!val) {
449                 /* No min limit, alarm disabled */
450                 data->fan_min[nr] = 255;
451                 new_div = data->fan_div[nr]; /* No change */
452                 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
453         } else if ((reg = 1350000U / val) >= 128 * 255) {
454                 /* Speed below this value cannot possibly be represented,
455                    even with the highest divider (128) */
456                 data->fan_min[nr] = 254;
457                 new_div = 7; /* 128 == (1 << 7) */
458                 dev_warn(dev, "fan%u low limit %u below minimum %u, set to "
459                          "minimum\n", nr + 1, val, fan_from_reg(254, 128));
460         } else if (!reg) {
461                 /* Speed above this value cannot possibly be represented,
462                    even with the lowest divider (1) */
463                 data->fan_min[nr] = 1;
464                 new_div = 0; /* 1 == (1 << 0) */
465                 dev_warn(dev, "fan%u low limit %u above maximum %u, set to "
466                          "maximum\n", nr + 1, val, fan_from_reg(1, 1));
467         } else {
468                 /* Automatically pick the best divider, i.e. the one such
469                    that the min limit will correspond to a register value
470                    in the 96..192 range */
471                 new_div = 0;
472                 while (reg > 192 && new_div < 7) {
473                         reg >>= 1;
474                         new_div++;
475                 }
476                 data->fan_min[nr] = reg;
477         }
478
479         /* Write both the fan clock divider (if it changed) and the new
480            fan min (unconditionally) */
481         if (new_div != data->fan_div[nr]) {
482                 if (new_div > data->fan_div[nr])
483                         data->fan[nr] >>= (data->fan_div[nr] - new_div);
484                 else
485                         data->fan[nr] <<= (new_div - data->fan_div[nr]);
486
487                 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
488                         nr + 1, div_from_reg(data->fan_div[nr]),
489                         div_from_reg(new_div));
490                 data->fan_div[nr] = new_div;
491                 w83627ehf_write_fan_div(client, nr);
492         }
493         w83627ehf_write_value(client, W83627EHF_REG_FAN_MIN[nr],
494                               data->fan_min[nr]);
495         mutex_unlock(&data->update_lock);
496
497         return count;
498 }
499
500 static struct sensor_device_attribute sda_fan_input[] = {
501         SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
502         SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
503         SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
504         SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
505         SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
506 };
507
508 static struct sensor_device_attribute sda_fan_min[] = {
509         SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
510                     store_fan_min, 0),
511         SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
512                     store_fan_min, 1),
513         SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
514                     store_fan_min, 2),
515         SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
516                     store_fan_min, 3),
517         SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO, show_fan_min,
518                     store_fan_min, 4),
519 };
520
521 static struct sensor_device_attribute sda_fan_div[] = {
522         SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
523         SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
524         SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
525         SENSOR_ATTR(fan4_div, S_IRUGO, show_fan_div, NULL, 3),
526         SENSOR_ATTR(fan5_div, S_IRUGO, show_fan_div, NULL, 4),
527 };
528
529 static void device_create_file_fan(struct device *dev, int i)
530 {
531         device_create_file(dev, &sda_fan_input[i].dev_attr);
532         device_create_file(dev, &sda_fan_div[i].dev_attr);
533         device_create_file(dev, &sda_fan_min[i].dev_attr);
534 }
535
536 #define show_temp1_reg(reg) \
537 static ssize_t \
538 show_##reg(struct device *dev, struct device_attribute *attr, \
539            char *buf) \
540 { \
541         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
542         return sprintf(buf, "%d\n", temp1_from_reg(data->reg)); \
543 }
544 show_temp1_reg(temp1);
545 show_temp1_reg(temp1_max);
546 show_temp1_reg(temp1_max_hyst);
547
548 #define store_temp1_reg(REG, reg) \
549 static ssize_t \
550 store_temp1_##reg(struct device *dev, struct device_attribute *attr, \
551                   const char *buf, size_t count) \
552 { \
553         struct i2c_client *client = to_i2c_client(dev); \
554         struct w83627ehf_data *data = i2c_get_clientdata(client); \
555         u32 val = simple_strtoul(buf, NULL, 10); \
556  \
557         mutex_lock(&data->update_lock); \
558         data->temp1_##reg = temp1_to_reg(val); \
559         w83627ehf_write_value(client, W83627EHF_REG_TEMP1_##REG, \
560                               data->temp1_##reg); \
561         mutex_unlock(&data->update_lock); \
562         return count; \
563 }
564 store_temp1_reg(OVER, max);
565 store_temp1_reg(HYST, max_hyst);
566
567 #define show_temp_reg(reg) \
568 static ssize_t \
569 show_##reg(struct device *dev, struct device_attribute *attr, \
570            char *buf) \
571 { \
572         struct w83627ehf_data *data = w83627ehf_update_device(dev); \
573         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
574         int nr = sensor_attr->index; \
575         return sprintf(buf, "%d\n", \
576                        LM75_TEMP_FROM_REG(data->reg[nr])); \
577 }
578 show_temp_reg(temp);
579 show_temp_reg(temp_max);
580 show_temp_reg(temp_max_hyst);
581
582 #define store_temp_reg(REG, reg) \
583 static ssize_t \
584 store_##reg(struct device *dev, struct device_attribute *attr, \
585             const char *buf, size_t count) \
586 { \
587         struct i2c_client *client = to_i2c_client(dev); \
588         struct w83627ehf_data *data = i2c_get_clientdata(client); \
589         struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
590         int nr = sensor_attr->index; \
591         u32 val = simple_strtoul(buf, NULL, 10); \
592  \
593         mutex_lock(&data->update_lock); \
594         data->reg[nr] = LM75_TEMP_TO_REG(val); \
595         w83627ehf_write_value(client, W83627EHF_REG_TEMP_##REG[nr], \
596                               data->reg[nr]); \
597         mutex_unlock(&data->update_lock); \
598         return count; \
599 }
600 store_temp_reg(OVER, temp_max);
601 store_temp_reg(HYST, temp_max_hyst);
602
603 static struct sensor_device_attribute sda_temp[] = {
604         SENSOR_ATTR(temp1_input, S_IRUGO, show_temp1, NULL, 0),
605         SENSOR_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 0),
606         SENSOR_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 1),
607         SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp1_max,
608                     store_temp1_max, 0),
609         SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
610                     store_temp_max, 0),
611         SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
612                     store_temp_max, 1),
613         SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp1_max_hyst,
614                     store_temp1_max_hyst, 0),
615         SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
616                     store_temp_max_hyst, 0),
617         SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
618                     store_temp_max_hyst, 1),
619 };
620
621 /*
622  * Driver and client management
623  */
624
625 static struct i2c_driver w83627ehf_driver;
626
627 static void w83627ehf_init_client(struct i2c_client *client)
628 {
629         int i;
630         u8 tmp;
631
632         /* Start monitoring is needed */
633         tmp = w83627ehf_read_value(client, W83627EHF_REG_CONFIG);
634         if (!(tmp & 0x01))
635                 w83627ehf_write_value(client, W83627EHF_REG_CONFIG,
636                                       tmp | 0x01);
637
638         /* Enable temp2 and temp3 if needed */
639         for (i = 0; i < 2; i++) {
640                 tmp = w83627ehf_read_value(client,
641                                            W83627EHF_REG_TEMP_CONFIG[i]);
642                 if (tmp & 0x01)
643                         w83627ehf_write_value(client,
644                                               W83627EHF_REG_TEMP_CONFIG[i],
645                                               tmp & 0xfe);
646         }
647 }
648
649 static int w83627ehf_detect(struct i2c_adapter *adapter)
650 {
651         struct i2c_client *client;
652         struct w83627ehf_data *data;
653         struct device *dev;
654         int i, err = 0;
655
656         if (!request_region(address + REGION_OFFSET, REGION_LENGTH,
657                             w83627ehf_driver.driver.name)) {
658                 err = -EBUSY;
659                 goto exit;
660         }
661
662         if (!(data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL))) {
663                 err = -ENOMEM;
664                 goto exit_release;
665         }
666
667         client = &data->client;
668         i2c_set_clientdata(client, data);
669         client->addr = address;
670         mutex_init(&data->lock);
671         client->adapter = adapter;
672         client->driver = &w83627ehf_driver;
673         client->flags = 0;
674         dev = &client->dev;
675
676         strlcpy(client->name, "w83627ehf", I2C_NAME_SIZE);
677         data->valid = 0;
678         mutex_init(&data->update_lock);
679
680         /* Tell the i2c layer a new client has arrived */
681         if ((err = i2c_attach_client(client)))
682                 goto exit_free;
683
684         /* Initialize the chip */
685         w83627ehf_init_client(client);
686
687         /* A few vars need to be filled upon startup */
688         for (i = 0; i < 5; i++)
689                 data->fan_min[i] = w83627ehf_read_value(client,
690                                    W83627EHF_REG_FAN_MIN[i]);
691
692         /* It looks like fan4 and fan5 pins can be alternatively used
693            as fan on/off switches */
694         data->has_fan = 0x07; /* fan1, fan2 and fan3 */
695         i = w83627ehf_read_value(client, W83627EHF_REG_FANDIV1);
696         if (i & (1 << 2))
697                 data->has_fan |= (1 << 3);
698         if (i & (1 << 0))
699                 data->has_fan |= (1 << 4);
700
701         /* Register sysfs hooks */
702         data->class_dev = hwmon_device_register(dev);
703         if (IS_ERR(data->class_dev)) {
704                 err = PTR_ERR(data->class_dev);
705                 goto exit_detach;
706         }
707
708         for (i = 0; i < 5; i++) {
709                 if (data->has_fan & (1 << i))
710                         device_create_file_fan(dev, i);
711         }
712         for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
713                 device_create_file(dev, &sda_temp[i].dev_attr);
714
715         return 0;
716
717 exit_detach:
718         i2c_detach_client(client);
719 exit_free:
720         kfree(data);
721 exit_release:
722         release_region(address + REGION_OFFSET, REGION_LENGTH);
723 exit:
724         return err;
725 }
726
727 static int w83627ehf_detach_client(struct i2c_client *client)
728 {
729         struct w83627ehf_data *data = i2c_get_clientdata(client);
730         int err;
731
732         hwmon_device_unregister(data->class_dev);
733
734         if ((err = i2c_detach_client(client)))
735                 return err;
736         release_region(client->addr + REGION_OFFSET, REGION_LENGTH);
737         kfree(data);
738
739         return 0;
740 }
741
742 static struct i2c_driver w83627ehf_driver = {
743         .driver = {
744                 .name   = "w83627ehf",
745         },
746         .attach_adapter = w83627ehf_detect,
747         .detach_client  = w83627ehf_detach_client,
748 };
749
750 static int __init w83627ehf_find(int sioaddr, unsigned short *addr)
751 {
752         u16 val;
753
754         REG = sioaddr;
755         VAL = sioaddr + 1;
756         superio_enter();
757
758         val = (superio_inb(SIO_REG_DEVID) << 8)
759             | superio_inb(SIO_REG_DEVID + 1);
760         if ((val & SIO_ID_MASK) != SIO_W83627EHF_ID) {
761                 superio_exit();
762                 return -ENODEV;
763         }
764
765         superio_select(W83627EHF_LD_HWM);
766         val = (superio_inb(SIO_REG_ADDR) << 8)
767             | superio_inb(SIO_REG_ADDR + 1);
768         *addr = val & REGION_ALIGNMENT;
769         if (*addr == 0) {
770                 superio_exit();
771                 return -ENODEV;
772         }
773
774         /* Activate logical device if needed */
775         val = superio_inb(SIO_REG_ENABLE);
776         if (!(val & 0x01))
777                 superio_outb(SIO_REG_ENABLE, val | 0x01);
778
779         superio_exit();
780         return 0;
781 }
782
783 static int __init sensors_w83627ehf_init(void)
784 {
785         if (w83627ehf_find(0x2e, &address)
786          && w83627ehf_find(0x4e, &address))
787                 return -ENODEV;
788
789         return i2c_isa_add_driver(&w83627ehf_driver);
790 }
791
792 static void __exit sensors_w83627ehf_exit(void)
793 {
794         i2c_isa_del_driver(&w83627ehf_driver);
795 }
796
797 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
798 MODULE_DESCRIPTION("W83627EHF driver");
799 MODULE_LICENSE("GPL");
800
801 module_init(sensors_w83627ehf_init);
802 module_exit(sensors_w83627ehf_exit);