[PATCH] hwmon: Semaphore to mutex conversions
[linux-2.6.git] / drivers / hwmon / adm1031.c
1 /*
2   adm1031.c - Part of lm_sensors, Linux kernel modules for hardware
3   monitoring
4   Based on lm75.c and lm85.c
5   Supports adm1030 / adm1031
6   Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org>
7   Reworked by Jean Delvare <khali@linux-fr.org>
8   
9   This program is free software; you can redistribute it and/or modify
10   it under the terms of the GNU General Public License as published by
11   the Free Software Foundation; either version 2 of the License, or
12   (at your option) any later version.
13
14   This program is distributed in the hope that it will be useful,
15   but WITHOUT ANY WARRANTY; without even the implied warranty of
16   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17   GNU General Public License for more details.
18
19   You should have received a copy of the GNU General Public License
20   along with this program; if not, write to the Free Software
21   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 */
23
24 #include <linux/module.h>
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <linux/jiffies.h>
28 #include <linux/i2c.h>
29 #include <linux/hwmon.h>
30 #include <linux/err.h>
31 #include <linux/mutex.h>
32
33 /* Following macros takes channel parameter starting from 0 to 2 */
34 #define ADM1031_REG_FAN_SPEED(nr)       (0x08 + (nr))
35 #define ADM1031_REG_FAN_DIV(nr)         (0x20  + (nr))
36 #define ADM1031_REG_PWM                 (0x22)
37 #define ADM1031_REG_FAN_MIN(nr)         (0x10 + (nr))
38
39 #define ADM1031_REG_TEMP_MAX(nr)        (0x14  + 4*(nr))
40 #define ADM1031_REG_TEMP_MIN(nr)        (0x15  + 4*(nr))
41 #define ADM1031_REG_TEMP_CRIT(nr)       (0x16  + 4*(nr))
42
43 #define ADM1031_REG_TEMP(nr)            (0xa + (nr))
44 #define ADM1031_REG_AUTO_TEMP(nr)       (0x24 + (nr))
45
46 #define ADM1031_REG_STATUS(nr)          (0x2 + (nr))
47
48 #define ADM1031_REG_CONF1               0x0
49 #define ADM1031_REG_CONF2               0x1
50 #define ADM1031_REG_EXT_TEMP            0x6
51
52 #define ADM1031_CONF1_MONITOR_ENABLE    0x01    /* Monitoring enable */
53 #define ADM1031_CONF1_PWM_INVERT        0x08    /* PWM Invert */
54 #define ADM1031_CONF1_AUTO_MODE         0x80    /* Auto FAN */
55
56 #define ADM1031_CONF2_PWM1_ENABLE       0x01
57 #define ADM1031_CONF2_PWM2_ENABLE       0x02
58 #define ADM1031_CONF2_TACH1_ENABLE      0x04
59 #define ADM1031_CONF2_TACH2_ENABLE      0x08
60 #define ADM1031_CONF2_TEMP_ENABLE(chan) (0x10 << (chan))
61
62 /* Addresses to scan */
63 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
64
65 /* Insmod parameters */
66 I2C_CLIENT_INSMOD_2(adm1030, adm1031);
67
68 typedef u8 auto_chan_table_t[8][2];
69
70 /* Each client has this additional data */
71 struct adm1031_data {
72         struct i2c_client client;
73         struct class_device *class_dev;
74         struct mutex update_lock;
75         int chip_type;
76         char valid;             /* !=0 if following fields are valid */
77         unsigned long last_updated;     /* In jiffies */
78         /* The chan_select_table contains the possible configurations for
79          * auto fan control.
80          */
81         auto_chan_table_t *chan_select_table;
82         u16 alarm;
83         u8 conf1;
84         u8 conf2;
85         u8 fan[2];
86         u8 fan_div[2];
87         u8 fan_min[2];
88         u8 pwm[2];
89         u8 old_pwm[2];
90         s8 temp[3];
91         u8 ext_temp[3];
92         u8 auto_temp[3];
93         u8 auto_temp_min[3];
94         u8 auto_temp_off[3];
95         u8 auto_temp_max[3];
96         s8 temp_min[3];
97         s8 temp_max[3];
98         s8 temp_crit[3];
99 };
100
101 static int adm1031_attach_adapter(struct i2c_adapter *adapter);
102 static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind);
103 static void adm1031_init_client(struct i2c_client *client);
104 static int adm1031_detach_client(struct i2c_client *client);
105 static struct adm1031_data *adm1031_update_device(struct device *dev);
106
107 /* This is the driver that will be inserted */
108 static struct i2c_driver adm1031_driver = {
109         .driver = {
110                 .name = "adm1031",
111         },
112         .attach_adapter = adm1031_attach_adapter,
113         .detach_client = adm1031_detach_client,
114 };
115
116 static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg)
117 {
118         return i2c_smbus_read_byte_data(client, reg);
119 }
120
121 static inline int
122 adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value)
123 {
124         return i2c_smbus_write_byte_data(client, reg, value);
125 }
126
127
128 #define TEMP_TO_REG(val)                (((val) < 0 ? ((val - 500) / 1000) : \
129                                         ((val + 500) / 1000)))
130
131 #define TEMP_FROM_REG(val)              ((val) * 1000)
132
133 #define TEMP_FROM_REG_EXT(val, ext)     (TEMP_FROM_REG(val) + (ext) * 125)
134
135 #define FAN_FROM_REG(reg, div)          ((reg) ? (11250 * 60) / ((reg) * (div)) : 0)
136
137 static int FAN_TO_REG(int reg, int div)
138 {
139         int tmp;
140         tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div);
141         return tmp > 255 ? 255 : tmp;
142 }
143
144 #define FAN_DIV_FROM_REG(reg)           (1<<(((reg)&0xc0)>>6))
145
146 #define PWM_TO_REG(val)                 (SENSORS_LIMIT((val), 0, 255) >> 4)
147 #define PWM_FROM_REG(val)               ((val) << 4)
148
149 #define FAN_CHAN_FROM_REG(reg)          (((reg) >> 5) & 7)
150 #define FAN_CHAN_TO_REG(val, reg)       \
151         (((reg) & 0x1F) | (((val) << 5) & 0xe0))
152
153 #define AUTO_TEMP_MIN_TO_REG(val, reg)  \
154         ((((val)/500) & 0xf8)|((reg) & 0x7))
155 #define AUTO_TEMP_RANGE_FROM_REG(reg)   (5000 * (1<< ((reg)&0x7)))
156 #define AUTO_TEMP_MIN_FROM_REG(reg)     (1000 * ((((reg) >> 3) & 0x1f) << 2))
157
158 #define AUTO_TEMP_MIN_FROM_REG_DEG(reg) ((((reg) >> 3) & 0x1f) << 2)
159
160 #define AUTO_TEMP_OFF_FROM_REG(reg)             \
161         (AUTO_TEMP_MIN_FROM_REG(reg) - 5000)
162
163 #define AUTO_TEMP_MAX_FROM_REG(reg)             \
164         (AUTO_TEMP_RANGE_FROM_REG(reg) +        \
165         AUTO_TEMP_MIN_FROM_REG(reg))
166
167 static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm)
168 {
169         int ret;
170         int range = val - AUTO_TEMP_MIN_FROM_REG(reg);
171
172         range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm);
173         ret = ((reg & 0xf8) |
174                (range < 10000 ? 0 :
175                 range < 20000 ? 1 :
176                 range < 40000 ? 2 : range < 80000 ? 3 : 4));
177         return ret;
178 }
179
180 /* FAN auto control */
181 #define GET_FAN_AUTO_BITFIELD(data, idx)        \
182         (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2]
183
184 /* The tables below contains the possible values for the auto fan 
185  * control bitfields. the index in the table is the register value.
186  * MSb is the auto fan control enable bit, so the four first entries
187  * in the table disables auto fan control when both bitfields are zero.
188  */
189 static auto_chan_table_t auto_channel_select_table_adm1031 = {
190         {0, 0}, {0, 0}, {0, 0}, {0, 0},
191         {2 /*0b010 */ , 4 /*0b100 */ },
192         {2 /*0b010 */ , 2 /*0b010 */ },
193         {4 /*0b100 */ , 4 /*0b100 */ },
194         {7 /*0b111 */ , 7 /*0b111 */ },
195 };
196
197 static auto_chan_table_t auto_channel_select_table_adm1030 = {
198         {0, 0}, {0, 0}, {0, 0}, {0, 0},
199         {2 /*0b10 */            , 0},
200         {0xff /*invalid */      , 0},
201         {0xff /*invalid */      , 0},
202         {3 /*0b11 */            , 0},
203 };
204
205 /* That function checks if a bitfield is valid and returns the other bitfield
206  * nearest match if no exact match where found.
207  */
208 static int
209 get_fan_auto_nearest(struct adm1031_data *data,
210                      int chan, u8 val, u8 reg, u8 * new_reg)
211 {
212         int i;
213         int first_match = -1, exact_match = -1;
214         u8 other_reg_val =
215             (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1];
216
217         if (val == 0) {
218                 *new_reg = 0;
219                 return 0;
220         }
221
222         for (i = 0; i < 8; i++) {
223                 if ((val == (*data->chan_select_table)[i][chan]) &&
224                     ((*data->chan_select_table)[i][chan ? 0 : 1] ==
225                      other_reg_val)) {
226                         /* We found an exact match */
227                         exact_match = i;
228                         break;
229                 } else if (val == (*data->chan_select_table)[i][chan] &&
230                            first_match == -1) {
231                         /* Save the first match in case of an exact match has not been
232                          * found 
233                          */
234                         first_match = i;
235                 }
236         }
237
238         if (exact_match >= 0) {
239                 *new_reg = exact_match;
240         } else if (first_match >= 0) {
241                 *new_reg = first_match;
242         } else {
243                 return -EINVAL;
244         }
245         return 0;
246 }
247
248 static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr)
249 {
250         struct adm1031_data *data = adm1031_update_device(dev);
251         return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr));
252 }
253
254 static ssize_t
255 set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr)
256 {
257         struct i2c_client *client = to_i2c_client(dev);
258         struct adm1031_data *data = i2c_get_clientdata(client);
259         int val = simple_strtol(buf, NULL, 10);
260         u8 reg;
261         int ret;
262         u8 old_fan_mode;
263
264         old_fan_mode = data->conf1;
265
266         mutex_lock(&data->update_lock);
267         
268         if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, &reg))) {
269                 mutex_unlock(&data->update_lock);
270                 return ret;
271         }
272         if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^ 
273             (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) {
274                 if (data->conf1 & ADM1031_CONF1_AUTO_MODE){
275                         /* Switch to Auto Fan Mode 
276                          * Save PWM registers 
277                          * Set PWM registers to 33% Both */
278                         data->old_pwm[0] = data->pwm[0];
279                         data->old_pwm[1] = data->pwm[1];
280                         adm1031_write_value(client, ADM1031_REG_PWM, 0x55);
281                 } else {
282                         /* Switch to Manual Mode */
283                         data->pwm[0] = data->old_pwm[0];
284                         data->pwm[1] = data->old_pwm[1];
285                         /* Restore PWM registers */
286                         adm1031_write_value(client, ADM1031_REG_PWM, 
287                                             data->pwm[0] | (data->pwm[1] << 4));
288                 }
289         }
290         data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
291         adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1);
292         mutex_unlock(&data->update_lock);
293         return count;
294 }
295
296 #define fan_auto_channel_offset(offset)                                         \
297 static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf)    \
298 {                                                                               \
299         return show_fan_auto_channel(dev, buf, offset - 1);                     \
300 }                                                                               \
301 static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr,                \
302         const char *buf, size_t count)                                          \
303 {                                                                               \
304         return set_fan_auto_channel(dev, buf, count, offset - 1);               \
305 }                                                                               \
306 static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR,               \
307                    show_fan_auto_channel_##offset,                              \
308                    set_fan_auto_channel_##offset)
309
310 fan_auto_channel_offset(1);
311 fan_auto_channel_offset(2);
312
313 /* Auto Temps */
314 static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr)
315 {
316         struct adm1031_data *data = adm1031_update_device(dev);
317         return sprintf(buf, "%d\n", 
318                        AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr]));
319 }
320 static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr)
321 {
322         struct adm1031_data *data = adm1031_update_device(dev);
323         return sprintf(buf, "%d\n",
324                        AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr]));
325 }
326 static ssize_t
327 set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr)
328 {
329         struct i2c_client *client = to_i2c_client(dev);
330         struct adm1031_data *data = i2c_get_clientdata(client);
331         int val = simple_strtol(buf, NULL, 10);
332
333         mutex_lock(&data->update_lock);
334         data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]);
335         adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
336                             data->auto_temp[nr]);
337         mutex_unlock(&data->update_lock);
338         return count;
339 }
340 static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr)
341 {
342         struct adm1031_data *data = adm1031_update_device(dev);
343         return sprintf(buf, "%d\n",
344                        AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr]));
345 }
346 static ssize_t
347 set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr)
348 {
349         struct i2c_client *client = to_i2c_client(dev);
350         struct adm1031_data *data = i2c_get_clientdata(client);
351         int val = simple_strtol(buf, NULL, 10);
352
353         mutex_lock(&data->update_lock);
354         data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]);
355         adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
356                             data->temp_max[nr]);
357         mutex_unlock(&data->update_lock);
358         return count;
359 }
360
361 #define auto_temp_reg(offset)                                                   \
362 static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf)     \
363 {                                                                               \
364         return show_auto_temp_off(dev, buf, offset - 1);                        \
365 }                                                                               \
366 static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)     \
367 {                                                                               \
368         return show_auto_temp_min(dev, buf, offset - 1);                        \
369 }                                                                               \
370 static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)     \
371 {                                                                               \
372         return show_auto_temp_max(dev, buf, offset - 1);                        \
373 }                                                                               \
374 static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr,         \
375                                              const char *buf, size_t count)     \
376 {                                                                               \
377         return set_auto_temp_min(dev, buf, count, offset - 1);          \
378 }                                                                               \
379 static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr,         \
380                                              const char *buf, size_t count)     \
381 {                                                                               \
382         return set_auto_temp_max(dev, buf, count, offset - 1);          \
383 }                                                                               \
384 static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO,                            \
385                    show_auto_temp_##offset##_off, NULL);                        \
386 static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR,                  \
387                    show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\
388 static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR,                  \
389                    show_auto_temp_##offset##_max, set_auto_temp_##offset##_max)
390
391 auto_temp_reg(1);
392 auto_temp_reg(2);
393 auto_temp_reg(3);
394
395 /* pwm */
396 static ssize_t show_pwm(struct device *dev, char *buf, int nr)
397 {
398         struct adm1031_data *data = adm1031_update_device(dev);
399         return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr]));
400 }
401 static ssize_t
402 set_pwm(struct device *dev, const char *buf, size_t count, int nr)
403 {
404         struct i2c_client *client = to_i2c_client(dev);
405         struct adm1031_data *data = i2c_get_clientdata(client);
406         int val = simple_strtol(buf, NULL, 10);
407         int reg;
408
409         mutex_lock(&data->update_lock);
410         if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) && 
411             (((val>>4) & 0xf) != 5)) {
412                 /* In automatic mode, the only PWM accepted is 33% */
413                 mutex_unlock(&data->update_lock);
414                 return -EINVAL;
415         }
416         data->pwm[nr] = PWM_TO_REG(val);
417         reg = adm1031_read_value(client, ADM1031_REG_PWM);
418         adm1031_write_value(client, ADM1031_REG_PWM,
419                             nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf)
420                             : (data->pwm[nr] & 0xf) | (reg & 0xf0));
421         mutex_unlock(&data->update_lock);
422         return count;
423 }
424
425 #define pwm_reg(offset)                                                 \
426 static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
427 {                                                                       \
428         return show_pwm(dev, buf, offset - 1);                  \
429 }                                                                       \
430 static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr,                     \
431                                  const char *buf, size_t count)         \
432 {                                                                       \
433         return set_pwm(dev, buf, count, offset - 1);            \
434 }                                                                       \
435 static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR,                      \
436                    show_pwm_##offset, set_pwm_##offset)
437
438 pwm_reg(1);
439 pwm_reg(2);
440
441 /* Fans */
442
443 /*
444  * That function checks the cases where the fan reading is not
445  * relevant.  It is used to provide 0 as fan reading when the fan is
446  * not supposed to run
447  */
448 static int trust_fan_readings(struct adm1031_data *data, int chan)
449 {
450         int res = 0;
451
452         if (data->conf1 & ADM1031_CONF1_AUTO_MODE) {
453                 switch (data->conf1 & 0x60) {
454                 case 0x00:      /* remote temp1 controls fan1 remote temp2 controls fan2 */
455                         res = data->temp[chan+1] >=
456                               AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]);
457                         break;
458                 case 0x20:      /* remote temp1 controls both fans */
459                         res =
460                             data->temp[1] >=
461                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]);
462                         break;
463                 case 0x40:      /* remote temp2 controls both fans */
464                         res =
465                             data->temp[2] >=
466                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]);
467                         break;
468                 case 0x60:      /* max controls both fans */
469                         res =
470                             data->temp[0] >=
471                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0])
472                             || data->temp[1] >=
473                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1])
474                             || (data->chip_type == adm1031 
475                                 && data->temp[2] >=
476                                 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]));
477                         break;
478                 }
479         } else {
480                 res = data->pwm[chan] > 0;
481         }
482         return res;
483 }
484
485
486 static ssize_t show_fan(struct device *dev, char *buf, int nr)
487 {
488         struct adm1031_data *data = adm1031_update_device(dev);
489         int value;
490
491         value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr],
492                                  FAN_DIV_FROM_REG(data->fan_div[nr])) : 0;
493         return sprintf(buf, "%d\n", value);
494 }
495
496 static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
497 {
498         struct adm1031_data *data = adm1031_update_device(dev);
499         return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr]));
500 }
501 static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
502 {
503         struct adm1031_data *data = adm1031_update_device(dev);
504         return sprintf(buf, "%d\n",
505                        FAN_FROM_REG(data->fan_min[nr],
506                                     FAN_DIV_FROM_REG(data->fan_div[nr])));
507 }
508 static ssize_t
509 set_fan_min(struct device *dev, const char *buf, size_t count, int nr)
510 {
511         struct i2c_client *client = to_i2c_client(dev);
512         struct adm1031_data *data = i2c_get_clientdata(client);
513         int val = simple_strtol(buf, NULL, 10);
514
515         mutex_lock(&data->update_lock);
516         if (val) {
517                 data->fan_min[nr] = 
518                         FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr]));
519         } else {
520                 data->fan_min[nr] = 0xff;
521         }
522         adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]);
523         mutex_unlock(&data->update_lock);
524         return count;
525 }
526 static ssize_t
527 set_fan_div(struct device *dev, const char *buf, size_t count, int nr)
528 {
529         struct i2c_client *client = to_i2c_client(dev);
530         struct adm1031_data *data = i2c_get_clientdata(client);
531         int val = simple_strtol(buf, NULL, 10);
532         u8 tmp;
533         int old_div;
534         int new_min;
535
536         tmp = val == 8 ? 0xc0 :
537               val == 4 ? 0x80 :
538               val == 2 ? 0x40 : 
539               val == 1 ? 0x00 :  
540               0xff;
541         if (tmp == 0xff)
542                 return -EINVAL;
543         
544         mutex_lock(&data->update_lock);
545         old_div = FAN_DIV_FROM_REG(data->fan_div[nr]);
546         data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]);
547         new_min = data->fan_min[nr] * old_div / 
548                 FAN_DIV_FROM_REG(data->fan_div[nr]);
549         data->fan_min[nr] = new_min > 0xff ? 0xff : new_min;
550         data->fan[nr] = data->fan[nr] * old_div / 
551                 FAN_DIV_FROM_REG(data->fan_div[nr]);
552
553         adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr), 
554                             data->fan_div[nr]);
555         adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), 
556                             data->fan_min[nr]);
557         mutex_unlock(&data->update_lock);
558         return count;
559 }
560
561 #define fan_offset(offset)                                              \
562 static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
563 {                                                                       \
564         return show_fan(dev, buf, offset - 1);                  \
565 }                                                                       \
566 static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)   \
567 {                                                                       \
568         return show_fan_min(dev, buf, offset - 1);                      \
569 }                                                                       \
570 static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf)   \
571 {                                                                       \
572         return show_fan_div(dev, buf, offset - 1);                      \
573 }                                                                       \
574 static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr,               \
575         const char *buf, size_t count)                                  \
576 {                                                                       \
577         return set_fan_min(dev, buf, count, offset - 1);                \
578 }                                                                       \
579 static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr,               \
580         const char *buf, size_t count)                                  \
581 {                                                                       \
582         return set_fan_div(dev, buf, count, offset - 1);                \
583 }                                                                       \
584 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset,     \
585                    NULL);                                               \
586 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,                \
587                    show_fan_##offset##_min, set_fan_##offset##_min);    \
588 static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,                \
589                    show_fan_##offset##_div, set_fan_##offset##_div);    \
590 static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR,       \
591                    show_pwm_##offset, set_pwm_##offset)
592
593 fan_offset(1);
594 fan_offset(2);
595
596
597 /* Temps */
598 static ssize_t show_temp(struct device *dev, char *buf, int nr)
599 {
600         struct adm1031_data *data = adm1031_update_device(dev);
601         int ext;
602         ext = nr == 0 ?
603             ((data->ext_temp[nr] >> 6) & 0x3) * 2 :
604             (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7));
605         return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext));
606 }
607 static ssize_t show_temp_min(struct device *dev, char *buf, int nr)
608 {
609         struct adm1031_data *data = adm1031_update_device(dev);
610         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
611 }
612 static ssize_t show_temp_max(struct device *dev, char *buf, int nr)
613 {
614         struct adm1031_data *data = adm1031_update_device(dev);
615         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
616 }
617 static ssize_t show_temp_crit(struct device *dev, char *buf, int nr)
618 {
619         struct adm1031_data *data = adm1031_update_device(dev);
620         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr]));
621 }
622 static ssize_t
623 set_temp_min(struct device *dev, const char *buf, size_t count, int nr)
624 {
625         struct i2c_client *client = to_i2c_client(dev);
626         struct adm1031_data *data = i2c_get_clientdata(client);
627         int val;
628
629         val = simple_strtol(buf, NULL, 10);
630         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
631         mutex_lock(&data->update_lock);
632         data->temp_min[nr] = TEMP_TO_REG(val);
633         adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr),
634                             data->temp_min[nr]);
635         mutex_unlock(&data->update_lock);
636         return count;
637 }
638 static ssize_t
639 set_temp_max(struct device *dev, const char *buf, size_t count, int nr)
640 {
641         struct i2c_client *client = to_i2c_client(dev);
642         struct adm1031_data *data = i2c_get_clientdata(client);
643         int val;
644
645         val = simple_strtol(buf, NULL, 10);
646         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
647         mutex_lock(&data->update_lock);
648         data->temp_max[nr] = TEMP_TO_REG(val);
649         adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr),
650                             data->temp_max[nr]);
651         mutex_unlock(&data->update_lock);
652         return count;
653 }
654 static ssize_t
655 set_temp_crit(struct device *dev, const char *buf, size_t count, int nr)
656 {
657         struct i2c_client *client = to_i2c_client(dev);
658         struct adm1031_data *data = i2c_get_clientdata(client);
659         int val;
660
661         val = simple_strtol(buf, NULL, 10);
662         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
663         mutex_lock(&data->update_lock);
664         data->temp_crit[nr] = TEMP_TO_REG(val);
665         adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr),
666                             data->temp_crit[nr]);
667         mutex_unlock(&data->update_lock);
668         return count;
669 }
670
671 #define temp_reg(offset)                                                        \
672 static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf)                \
673 {                                                                               \
674         return show_temp(dev, buf, offset - 1);                         \
675 }                                                                               \
676 static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)          \
677 {                                                                               \
678         return show_temp_min(dev, buf, offset - 1);                             \
679 }                                                                               \
680 static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)          \
681 {                                                                               \
682         return show_temp_max(dev, buf, offset - 1);                             \
683 }                                                                               \
684 static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf) \
685 {                                                                               \
686         return show_temp_crit(dev, buf, offset - 1);                    \
687 }                                                                               \
688 static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr,                      \
689                                         const char *buf, size_t count)          \
690 {                                                                               \
691         return set_temp_min(dev, buf, count, offset - 1);                       \
692 }                                                                               \
693 static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr,                      \
694                                         const char *buf, size_t count)          \
695 {                                                                               \
696         return set_temp_max(dev, buf, count, offset - 1);                       \
697 }                                                                               \
698 static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr,                     \
699                                          const char *buf, size_t count)         \
700 {                                                                               \
701         return set_temp_crit(dev, buf, count, offset - 1);                      \
702 }                                                                               \
703 static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset,           \
704                    NULL);                                                       \
705 static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,                       \
706                    show_temp_##offset##_min, set_temp_##offset##_min);          \
707 static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,                       \
708                    show_temp_##offset##_max, set_temp_##offset##_max);          \
709 static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR,                      \
710                    show_temp_##offset##_crit, set_temp_##offset##_crit)
711
712 temp_reg(1);
713 temp_reg(2);
714 temp_reg(3);
715
716 /* Alarms */
717 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
718 {
719         struct adm1031_data *data = adm1031_update_device(dev);
720         return sprintf(buf, "%d\n", data->alarm);
721 }
722
723 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
724
725
726 static int adm1031_attach_adapter(struct i2c_adapter *adapter)
727 {
728         if (!(adapter->class & I2C_CLASS_HWMON))
729                 return 0;
730         return i2c_probe(adapter, &addr_data, adm1031_detect);
731 }
732
733 /* This function is called by i2c_probe */
734 static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind)
735 {
736         struct i2c_client *new_client;
737         struct adm1031_data *data;
738         int err = 0;
739         const char *name = "";
740
741         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
742                 goto exit;
743
744         if (!(data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL))) {
745                 err = -ENOMEM;
746                 goto exit;
747         }
748
749         new_client = &data->client;
750         i2c_set_clientdata(new_client, data);
751         new_client->addr = address;
752         new_client->adapter = adapter;
753         new_client->driver = &adm1031_driver;
754         new_client->flags = 0;
755
756         if (kind < 0) {
757                 int id, co;
758                 id = i2c_smbus_read_byte_data(new_client, 0x3d);
759                 co = i2c_smbus_read_byte_data(new_client, 0x3e);
760
761                 if (!((id == 0x31 || id == 0x30) && co == 0x41))
762                         goto exit_free;
763                 kind = (id == 0x30) ? adm1030 : adm1031;
764         }
765
766         if (kind <= 0)
767                 kind = adm1031;
768
769         /* Given the detected chip type, set the chip name and the
770          * auto fan control helper table. */
771         if (kind == adm1030) {
772                 name = "adm1030";
773                 data->chan_select_table = &auto_channel_select_table_adm1030;
774         } else if (kind == adm1031) {
775                 name = "adm1031";
776                 data->chan_select_table = &auto_channel_select_table_adm1031;
777         }
778         data->chip_type = kind;
779
780         strlcpy(new_client->name, name, I2C_NAME_SIZE);
781         data->valid = 0;
782         mutex_init(&data->update_lock);
783
784         /* Tell the I2C layer a new client has arrived */
785         if ((err = i2c_attach_client(new_client)))
786                 goto exit_free;
787
788         /* Initialize the ADM1031 chip */
789         adm1031_init_client(new_client);
790
791         /* Register sysfs hooks */
792         data->class_dev = hwmon_device_register(&new_client->dev);
793         if (IS_ERR(data->class_dev)) {
794                 err = PTR_ERR(data->class_dev);
795                 goto exit_detach;
796         }
797
798         device_create_file(&new_client->dev, &dev_attr_fan1_input);
799         device_create_file(&new_client->dev, &dev_attr_fan1_div);
800         device_create_file(&new_client->dev, &dev_attr_fan1_min);
801         device_create_file(&new_client->dev, &dev_attr_pwm1);
802         device_create_file(&new_client->dev, &dev_attr_auto_fan1_channel);
803         device_create_file(&new_client->dev, &dev_attr_temp1_input);
804         device_create_file(&new_client->dev, &dev_attr_temp1_min);
805         device_create_file(&new_client->dev, &dev_attr_temp1_max);
806         device_create_file(&new_client->dev, &dev_attr_temp1_crit);
807         device_create_file(&new_client->dev, &dev_attr_temp2_input);
808         device_create_file(&new_client->dev, &dev_attr_temp2_min);
809         device_create_file(&new_client->dev, &dev_attr_temp2_max);
810         device_create_file(&new_client->dev, &dev_attr_temp2_crit);
811
812         device_create_file(&new_client->dev, &dev_attr_auto_temp1_off);
813         device_create_file(&new_client->dev, &dev_attr_auto_temp1_min);
814         device_create_file(&new_client->dev, &dev_attr_auto_temp1_max);
815
816         device_create_file(&new_client->dev, &dev_attr_auto_temp2_off);
817         device_create_file(&new_client->dev, &dev_attr_auto_temp2_min);
818         device_create_file(&new_client->dev, &dev_attr_auto_temp2_max);
819
820         device_create_file(&new_client->dev, &dev_attr_auto_fan1_min_pwm);
821
822         device_create_file(&new_client->dev, &dev_attr_alarms);
823
824         if (kind == adm1031) {
825                 device_create_file(&new_client->dev, &dev_attr_fan2_input);
826                 device_create_file(&new_client->dev, &dev_attr_fan2_div);
827                 device_create_file(&new_client->dev, &dev_attr_fan2_min);
828                 device_create_file(&new_client->dev, &dev_attr_pwm2);
829                 device_create_file(&new_client->dev,
830                                    &dev_attr_auto_fan2_channel);
831                 device_create_file(&new_client->dev, &dev_attr_temp3_input);
832                 device_create_file(&new_client->dev, &dev_attr_temp3_min);
833                 device_create_file(&new_client->dev, &dev_attr_temp3_max);
834                 device_create_file(&new_client->dev, &dev_attr_temp3_crit);
835                 device_create_file(&new_client->dev, &dev_attr_auto_temp3_off);
836                 device_create_file(&new_client->dev, &dev_attr_auto_temp3_min);
837                 device_create_file(&new_client->dev, &dev_attr_auto_temp3_max);
838                 device_create_file(&new_client->dev, &dev_attr_auto_fan2_min_pwm);
839         }
840
841         return 0;
842
843 exit_detach:
844         i2c_detach_client(new_client);
845 exit_free:
846         kfree(data);
847 exit:
848         return err;
849 }
850
851 static int adm1031_detach_client(struct i2c_client *client)
852 {
853         struct adm1031_data *data = i2c_get_clientdata(client);
854         int ret;
855
856         hwmon_device_unregister(data->class_dev);
857         if ((ret = i2c_detach_client(client)) != 0) {
858                 return ret;
859         }
860         kfree(data);
861         return 0;
862 }
863
864 static void adm1031_init_client(struct i2c_client *client)
865 {
866         unsigned int read_val;
867         unsigned int mask;
868         struct adm1031_data *data = i2c_get_clientdata(client);
869
870         mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE);
871         if (data->chip_type == adm1031) {
872                 mask |= (ADM1031_CONF2_PWM2_ENABLE |
873                         ADM1031_CONF2_TACH2_ENABLE);
874         } 
875         /* Initialize the ADM1031 chip (enables fan speed reading ) */
876         read_val = adm1031_read_value(client, ADM1031_REG_CONF2);
877         if ((read_val | mask) != read_val) {
878             adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask);
879         }
880
881         read_val = adm1031_read_value(client, ADM1031_REG_CONF1);
882         if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) {
883             adm1031_write_value(client, ADM1031_REG_CONF1, read_val |
884                                 ADM1031_CONF1_MONITOR_ENABLE);
885         }
886
887 }
888
889 static struct adm1031_data *adm1031_update_device(struct device *dev)
890 {
891         struct i2c_client *client = to_i2c_client(dev);
892         struct adm1031_data *data = i2c_get_clientdata(client);
893         int chan;
894
895         mutex_lock(&data->update_lock);
896
897         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
898             || !data->valid) {
899
900                 dev_dbg(&client->dev, "Starting adm1031 update\n");
901                 for (chan = 0;
902                      chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) {
903                         u8 oldh, newh;
904
905                         oldh =
906                             adm1031_read_value(client, ADM1031_REG_TEMP(chan));
907                         data->ext_temp[chan] =
908                             adm1031_read_value(client, ADM1031_REG_EXT_TEMP);
909                         newh =
910                             adm1031_read_value(client, ADM1031_REG_TEMP(chan));
911                         if (newh != oldh) {
912                                 data->ext_temp[chan] =
913                                     adm1031_read_value(client,
914                                                        ADM1031_REG_EXT_TEMP);
915 #ifdef DEBUG
916                                 oldh =
917                                     adm1031_read_value(client,
918                                                        ADM1031_REG_TEMP(chan));
919
920                                 /* oldh is actually newer */
921                                 if (newh != oldh)
922                                         dev_warn(&client->dev,
923                                                  "Remote temperature may be "
924                                                  "wrong.\n");
925 #endif
926                         }
927                         data->temp[chan] = newh;
928
929                         data->temp_min[chan] =
930                             adm1031_read_value(client,
931                                                ADM1031_REG_TEMP_MIN(chan));
932                         data->temp_max[chan] =
933                             adm1031_read_value(client,
934                                                ADM1031_REG_TEMP_MAX(chan));
935                         data->temp_crit[chan] =
936                             adm1031_read_value(client,
937                                                ADM1031_REG_TEMP_CRIT(chan));
938                         data->auto_temp[chan] =
939                             adm1031_read_value(client,
940                                                ADM1031_REG_AUTO_TEMP(chan));
941
942                 }
943
944                 data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1);
945                 data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2);
946
947                 data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0))
948                              | (adm1031_read_value(client, ADM1031_REG_STATUS(1))
949                                 << 8);
950                 if (data->chip_type == adm1030) {
951                         data->alarm &= 0xc0ff;
952                 }
953                 
954                 for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) {
955                         data->fan_div[chan] =
956                             adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan));
957                         data->fan_min[chan] =
958                             adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan));
959                         data->fan[chan] =
960                             adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan));
961                         data->pwm[chan] =
962                             0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >> 
963                                    (4*chan));
964                 }
965                 data->last_updated = jiffies;
966                 data->valid = 1;
967         }
968
969         mutex_unlock(&data->update_lock);
970
971         return data;
972 }
973
974 static int __init sensors_adm1031_init(void)
975 {
976         return i2c_add_driver(&adm1031_driver);
977 }
978
979 static void __exit sensors_adm1031_exit(void)
980 {
981         i2c_del_driver(&adm1031_driver);
982 }
983
984 MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>");
985 MODULE_DESCRIPTION("ADM1031/ADM1030 driver");
986 MODULE_LICENSE("GPL");
987
988 module_init(sensors_adm1031_init);
989 module_exit(sensors_adm1031_exit);