netns xfrm: fix "ip xfrm state|policy count" misreport
[safe/jmp/linux-2.6] / 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/hwmon-sysfs.h>
31 #include <linux/err.h>
32 #include <linux/mutex.h>
33
34 /* Following macros takes channel parameter starting from 0 to 2 */
35 #define ADM1031_REG_FAN_SPEED(nr)       (0x08 + (nr))
36 #define ADM1031_REG_FAN_DIV(nr)         (0x20 + (nr))
37 #define ADM1031_REG_PWM                 (0x22)
38 #define ADM1031_REG_FAN_MIN(nr)         (0x10 + (nr))
39
40 #define ADM1031_REG_TEMP_OFFSET(nr)     (0x0d + (nr))
41 #define ADM1031_REG_TEMP_MAX(nr)        (0x14 + 4 * (nr))
42 #define ADM1031_REG_TEMP_MIN(nr)        (0x15 + 4 * (nr))
43 #define ADM1031_REG_TEMP_CRIT(nr)       (0x16 + 4 * (nr))
44
45 #define ADM1031_REG_TEMP(nr)            (0x0a + (nr))
46 #define ADM1031_REG_AUTO_TEMP(nr)       (0x24 + (nr))
47
48 #define ADM1031_REG_STATUS(nr)          (0x2 + (nr))
49
50 #define ADM1031_REG_CONF1               0x00
51 #define ADM1031_REG_CONF2               0x01
52 #define ADM1031_REG_EXT_TEMP            0x06
53
54 #define ADM1031_CONF1_MONITOR_ENABLE    0x01    /* Monitoring enable */
55 #define ADM1031_CONF1_PWM_INVERT        0x08    /* PWM Invert */
56 #define ADM1031_CONF1_AUTO_MODE         0x80    /* Auto FAN */
57
58 #define ADM1031_CONF2_PWM1_ENABLE       0x01
59 #define ADM1031_CONF2_PWM2_ENABLE       0x02
60 #define ADM1031_CONF2_TACH1_ENABLE      0x04
61 #define ADM1031_CONF2_TACH2_ENABLE      0x08
62 #define ADM1031_CONF2_TEMP_ENABLE(chan) (0x10 << (chan))
63
64 /* Addresses to scan */
65 static const unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
66
67 enum chips { adm1030, adm1031 };
68
69 typedef u8 auto_chan_table_t[8][2];
70
71 /* Each client has this additional data */
72 struct adm1031_data {
73         struct device *hwmon_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         const 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_offset[3];
97         s8 temp_min[3];
98         s8 temp_max[3];
99         s8 temp_crit[3];
100 };
101
102 static int adm1031_probe(struct i2c_client *client,
103                          const struct i2c_device_id *id);
104 static int adm1031_detect(struct i2c_client *client,
105                           struct i2c_board_info *info);
106 static void adm1031_init_client(struct i2c_client *client);
107 static int adm1031_remove(struct i2c_client *client);
108 static struct adm1031_data *adm1031_update_device(struct device *dev);
109
110 static const struct i2c_device_id adm1031_id[] = {
111         { "adm1030", adm1030 },
112         { "adm1031", adm1031 },
113         { }
114 };
115 MODULE_DEVICE_TABLE(i2c, adm1031_id);
116
117 /* This is the driver that will be inserted */
118 static struct i2c_driver adm1031_driver = {
119         .class          = I2C_CLASS_HWMON,
120         .driver = {
121                 .name = "adm1031",
122         },
123         .probe          = adm1031_probe,
124         .remove         = adm1031_remove,
125         .id_table       = adm1031_id,
126         .detect         = adm1031_detect,
127         .address_list   = normal_i2c,
128 };
129
130 static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg)
131 {
132         return i2c_smbus_read_byte_data(client, reg);
133 }
134
135 static inline int
136 adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value)
137 {
138         return i2c_smbus_write_byte_data(client, reg, value);
139 }
140
141
142 #define TEMP_TO_REG(val)                (((val) < 0 ? ((val - 500) / 1000) : \
143                                         ((val + 500) / 1000)))
144
145 #define TEMP_FROM_REG(val)              ((val) * 1000)
146
147 #define TEMP_FROM_REG_EXT(val, ext)     (TEMP_FROM_REG(val) + (ext) * 125)
148
149 #define TEMP_OFFSET_TO_REG(val)         (TEMP_TO_REG(val) & 0x8f)
150 #define TEMP_OFFSET_FROM_REG(val)       TEMP_FROM_REG((val) < 0 ? \
151                                                       (val) | 0x70 : (val))
152
153 #define FAN_FROM_REG(reg, div)          ((reg) ? (11250 * 60) / ((reg) * (div)) : 0)
154
155 static int FAN_TO_REG(int reg, int div)
156 {
157         int tmp;
158         tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div);
159         return tmp > 255 ? 255 : tmp;
160 }
161
162 #define FAN_DIV_FROM_REG(reg)           (1<<(((reg)&0xc0)>>6))
163
164 #define PWM_TO_REG(val)                 (SENSORS_LIMIT((val), 0, 255) >> 4)
165 #define PWM_FROM_REG(val)               ((val) << 4)
166
167 #define FAN_CHAN_FROM_REG(reg)          (((reg) >> 5) & 7)
168 #define FAN_CHAN_TO_REG(val, reg)       \
169         (((reg) & 0x1F) | (((val) << 5) & 0xe0))
170
171 #define AUTO_TEMP_MIN_TO_REG(val, reg)  \
172         ((((val)/500) & 0xf8)|((reg) & 0x7))
173 #define AUTO_TEMP_RANGE_FROM_REG(reg)   (5000 * (1<< ((reg)&0x7)))
174 #define AUTO_TEMP_MIN_FROM_REG(reg)     (1000 * ((((reg) >> 3) & 0x1f) << 2))
175
176 #define AUTO_TEMP_MIN_FROM_REG_DEG(reg) ((((reg) >> 3) & 0x1f) << 2)
177
178 #define AUTO_TEMP_OFF_FROM_REG(reg)             \
179         (AUTO_TEMP_MIN_FROM_REG(reg) - 5000)
180
181 #define AUTO_TEMP_MAX_FROM_REG(reg)             \
182         (AUTO_TEMP_RANGE_FROM_REG(reg) +        \
183         AUTO_TEMP_MIN_FROM_REG(reg))
184
185 static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm)
186 {
187         int ret;
188         int range = val - AUTO_TEMP_MIN_FROM_REG(reg);
189
190         range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm);
191         ret = ((reg & 0xf8) |
192                (range < 10000 ? 0 :
193                 range < 20000 ? 1 :
194                 range < 40000 ? 2 : range < 80000 ? 3 : 4));
195         return ret;
196 }
197
198 /* FAN auto control */
199 #define GET_FAN_AUTO_BITFIELD(data, idx)        \
200         (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2]
201
202 /* The tables below contains the possible values for the auto fan
203  * control bitfields. the index in the table is the register value.
204  * MSb is the auto fan control enable bit, so the four first entries
205  * in the table disables auto fan control when both bitfields are zero.
206  */
207 static const auto_chan_table_t auto_channel_select_table_adm1031 = {
208         { 0, 0 }, { 0, 0 }, { 0, 0 }, { 0, 0 },
209         { 2 /* 0b010 */ , 4 /* 0b100 */ },
210         { 2 /* 0b010 */ , 2 /* 0b010 */ },
211         { 4 /* 0b100 */ , 4 /* 0b100 */ },
212         { 7 /* 0b111 */ , 7 /* 0b111 */ },
213 };
214
215 static const auto_chan_table_t auto_channel_select_table_adm1030 = {
216         { 0, 0 }, { 0, 0 }, { 0, 0 }, { 0, 0 },
217         { 2 /* 0b10 */          , 0 },
218         { 0xff /* invalid */    , 0 },
219         { 0xff /* invalid */    , 0 },
220         { 3 /* 0b11 */          , 0 },
221 };
222
223 /* That function checks if a bitfield is valid and returns the other bitfield
224  * nearest match if no exact match where found.
225  */
226 static int
227 get_fan_auto_nearest(struct adm1031_data *data,
228                      int chan, u8 val, u8 reg, u8 * new_reg)
229 {
230         int i;
231         int first_match = -1, exact_match = -1;
232         u8 other_reg_val =
233             (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1];
234
235         if (val == 0) {
236                 *new_reg = 0;
237                 return 0;
238         }
239
240         for (i = 0; i < 8; i++) {
241                 if ((val == (*data->chan_select_table)[i][chan]) &&
242                     ((*data->chan_select_table)[i][chan ? 0 : 1] ==
243                      other_reg_val)) {
244                         /* We found an exact match */
245                         exact_match = i;
246                         break;
247                 } else if (val == (*data->chan_select_table)[i][chan] &&
248                            first_match == -1) {
249                         /* Save the first match in case of an exact match has
250                          * not been found
251                          */
252                         first_match = i;
253                 }
254         }
255
256         if (exact_match >= 0) {
257                 *new_reg = exact_match;
258         } else if (first_match >= 0) {
259                 *new_reg = first_match;
260         } else {
261                 return -EINVAL;
262         }
263         return 0;
264 }
265
266 static ssize_t show_fan_auto_channel(struct device *dev,
267                                      struct device_attribute *attr, char *buf)
268 {
269         int nr = to_sensor_dev_attr(attr)->index;
270         struct adm1031_data *data = adm1031_update_device(dev);
271         return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr));
272 }
273
274 static ssize_t
275 set_fan_auto_channel(struct device *dev, struct device_attribute *attr,
276                      const char *buf, size_t count)
277 {
278         struct i2c_client *client = to_i2c_client(dev);
279         struct adm1031_data *data = i2c_get_clientdata(client);
280         int nr = to_sensor_dev_attr(attr)->index;
281         int val = simple_strtol(buf, NULL, 10);
282         u8 reg;
283         int ret;
284         u8 old_fan_mode;
285
286         old_fan_mode = data->conf1;
287
288         mutex_lock(&data->update_lock);
289
290         if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, &reg))) {
291                 mutex_unlock(&data->update_lock);
292                 return ret;
293         }
294         data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
295         if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) ^
296             (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) {
297                 if (data->conf1 & ADM1031_CONF1_AUTO_MODE){
298                         /* Switch to Auto Fan Mode
299                          * Save PWM registers
300                          * Set PWM registers to 33% Both */
301                         data->old_pwm[0] = data->pwm[0];
302                         data->old_pwm[1] = data->pwm[1];
303                         adm1031_write_value(client, ADM1031_REG_PWM, 0x55);
304                 } else {
305                         /* Switch to Manual Mode */
306                         data->pwm[0] = data->old_pwm[0];
307                         data->pwm[1] = data->old_pwm[1];
308                         /* Restore PWM registers */
309                         adm1031_write_value(client, ADM1031_REG_PWM,
310                                             data->pwm[0] | (data->pwm[1] << 4));
311                 }
312         }
313         data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
314         adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1);
315         mutex_unlock(&data->update_lock);
316         return count;
317 }
318
319 static SENSOR_DEVICE_ATTR(auto_fan1_channel, S_IRUGO | S_IWUSR,
320                 show_fan_auto_channel, set_fan_auto_channel, 0);
321 static SENSOR_DEVICE_ATTR(auto_fan2_channel, S_IRUGO | S_IWUSR,
322                 show_fan_auto_channel, set_fan_auto_channel, 1);
323
324 /* Auto Temps */
325 static ssize_t show_auto_temp_off(struct device *dev,
326                                   struct device_attribute *attr, char *buf)
327 {
328         int nr = to_sensor_dev_attr(attr)->index;
329         struct adm1031_data *data = adm1031_update_device(dev);
330         return sprintf(buf, "%d\n",
331                        AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr]));
332 }
333 static ssize_t show_auto_temp_min(struct device *dev,
334                                   struct device_attribute *attr, char *buf)
335 {
336         int nr = to_sensor_dev_attr(attr)->index;
337         struct adm1031_data *data = adm1031_update_device(dev);
338         return sprintf(buf, "%d\n",
339                        AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr]));
340 }
341 static ssize_t
342 set_auto_temp_min(struct device *dev, struct device_attribute *attr,
343                   const char *buf, size_t count)
344 {
345         struct i2c_client *client = to_i2c_client(dev);
346         struct adm1031_data *data = i2c_get_clientdata(client);
347         int nr = to_sensor_dev_attr(attr)->index;
348         int val = simple_strtol(buf, NULL, 10);
349
350         mutex_lock(&data->update_lock);
351         data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]);
352         adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
353                             data->auto_temp[nr]);
354         mutex_unlock(&data->update_lock);
355         return count;
356 }
357 static ssize_t show_auto_temp_max(struct device *dev,
358                                   struct device_attribute *attr, char *buf)
359 {
360         int nr = to_sensor_dev_attr(attr)->index;
361         struct adm1031_data *data = adm1031_update_device(dev);
362         return sprintf(buf, "%d\n",
363                        AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr]));
364 }
365 static ssize_t
366 set_auto_temp_max(struct device *dev, struct device_attribute *attr,
367                   const char *buf, size_t count)
368 {
369         struct i2c_client *client = to_i2c_client(dev);
370         struct adm1031_data *data = i2c_get_clientdata(client);
371         int nr = to_sensor_dev_attr(attr)->index;
372         int val = simple_strtol(buf, NULL, 10);
373
374         mutex_lock(&data->update_lock);
375         data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]);
376         adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
377                             data->temp_max[nr]);
378         mutex_unlock(&data->update_lock);
379         return count;
380 }
381
382 #define auto_temp_reg(offset)                                           \
383 static SENSOR_DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO,             \
384                 show_auto_temp_off, NULL, offset - 1);                  \
385 static SENSOR_DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR,   \
386                 show_auto_temp_min, set_auto_temp_min, offset - 1);     \
387 static SENSOR_DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR,   \
388                 show_auto_temp_max, set_auto_temp_max, offset - 1)
389
390 auto_temp_reg(1);
391 auto_temp_reg(2);
392 auto_temp_reg(3);
393
394 /* pwm */
395 static ssize_t show_pwm(struct device *dev,
396                         struct device_attribute *attr, char *buf)
397 {
398         int nr = to_sensor_dev_attr(attr)->index;
399         struct adm1031_data *data = adm1031_update_device(dev);
400         return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr]));
401 }
402 static ssize_t set_pwm(struct device *dev, struct device_attribute *attr,
403                        const char *buf, size_t count)
404 {
405         struct i2c_client *client = to_i2c_client(dev);
406         struct adm1031_data *data = i2c_get_clientdata(client);
407         int nr = to_sensor_dev_attr(attr)->index;
408         int val = simple_strtol(buf, NULL, 10);
409         int reg;
410
411         mutex_lock(&data->update_lock);
412         if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) &&
413             (((val>>4) & 0xf) != 5)) {
414                 /* In automatic mode, the only PWM accepted is 33% */
415                 mutex_unlock(&data->update_lock);
416                 return -EINVAL;
417         }
418         data->pwm[nr] = PWM_TO_REG(val);
419         reg = adm1031_read_value(client, ADM1031_REG_PWM);
420         adm1031_write_value(client, ADM1031_REG_PWM,
421                             nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf)
422                             : (data->pwm[nr] & 0xf) | (reg & 0xf0));
423         mutex_unlock(&data->update_lock);
424         return count;
425 }
426
427 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, set_pwm, 0);
428 static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, set_pwm, 1);
429 static SENSOR_DEVICE_ATTR(auto_fan1_min_pwm, S_IRUGO | S_IWUSR,
430                 show_pwm, set_pwm, 0);
431 static SENSOR_DEVICE_ATTR(auto_fan2_min_pwm, S_IRUGO | S_IWUSR,
432                 show_pwm, set_pwm, 1);
433
434 /* Fans */
435
436 /*
437  * That function checks the cases where the fan reading is not
438  * relevant.  It is used to provide 0 as fan reading when the fan is
439  * not supposed to run
440  */
441 static int trust_fan_readings(struct adm1031_data *data, int chan)
442 {
443         int res = 0;
444
445         if (data->conf1 & ADM1031_CONF1_AUTO_MODE) {
446                 switch (data->conf1 & 0x60) {
447                 case 0x00:      /* remote temp1 controls fan1 remote temp2 controls fan2 */
448                         res = data->temp[chan+1] >=
449                               AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]);
450                         break;
451                 case 0x20:      /* remote temp1 controls both fans */
452                         res =
453                             data->temp[1] >=
454                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]);
455                         break;
456                 case 0x40:      /* remote temp2 controls both fans */
457                         res =
458                             data->temp[2] >=
459                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]);
460                         break;
461                 case 0x60:      /* max controls both fans */
462                         res =
463                             data->temp[0] >=
464                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0])
465                             || data->temp[1] >=
466                             AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1])
467                             || (data->chip_type == adm1031
468                                 && data->temp[2] >=
469                                 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]));
470                         break;
471                 }
472         } else {
473                 res = data->pwm[chan] > 0;
474         }
475         return res;
476 }
477
478
479 static ssize_t show_fan(struct device *dev,
480                         struct device_attribute *attr, char *buf)
481 {
482         int nr = to_sensor_dev_attr(attr)->index;
483         struct adm1031_data *data = adm1031_update_device(dev);
484         int value;
485
486         value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr],
487                                  FAN_DIV_FROM_REG(data->fan_div[nr])) : 0;
488         return sprintf(buf, "%d\n", value);
489 }
490
491 static ssize_t show_fan_div(struct device *dev,
492                             struct device_attribute *attr, char *buf)
493 {
494         int nr = to_sensor_dev_attr(attr)->index;
495         struct adm1031_data *data = adm1031_update_device(dev);
496         return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr]));
497 }
498 static ssize_t show_fan_min(struct device *dev,
499                             struct device_attribute *attr, char *buf)
500 {
501         int nr = to_sensor_dev_attr(attr)->index;
502         struct adm1031_data *data = adm1031_update_device(dev);
503         return sprintf(buf, "%d\n",
504                        FAN_FROM_REG(data->fan_min[nr],
505                                     FAN_DIV_FROM_REG(data->fan_div[nr])));
506 }
507 static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
508                            const char *buf, size_t count)
509 {
510         struct i2c_client *client = to_i2c_client(dev);
511         struct adm1031_data *data = i2c_get_clientdata(client);
512         int nr = to_sensor_dev_attr(attr)->index;
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 set_fan_div(struct device *dev, struct device_attribute *attr,
527                            const char *buf, size_t count)
528 {
529         struct i2c_client *client = to_i2c_client(dev);
530         struct adm1031_data *data = i2c_get_clientdata(client);
531         int nr = to_sensor_dev_attr(attr)->index;
532         int val = simple_strtol(buf, NULL, 10);
533         u8 tmp;
534         int old_div;
535         int new_min;
536
537         tmp = val == 8 ? 0xc0 :
538               val == 4 ? 0x80 :
539               val == 2 ? 0x40 :
540               val == 1 ? 0x00 :
541               0xff;
542         if (tmp == 0xff)
543                 return -EINVAL;
544
545         mutex_lock(&data->update_lock);
546         /* Get fresh readings */
547         data->fan_div[nr] = adm1031_read_value(client,
548                                                ADM1031_REG_FAN_DIV(nr));
549         data->fan_min[nr] = adm1031_read_value(client,
550                                                ADM1031_REG_FAN_MIN(nr));
551
552         /* Write the new clock divider and fan min */
553         old_div = FAN_DIV_FROM_REG(data->fan_div[nr]);
554         data->fan_div[nr] = tmp | (0x3f & data->fan_div[nr]);
555         new_min = data->fan_min[nr] * old_div / val;
556         data->fan_min[nr] = new_min > 0xff ? 0xff : new_min;
557
558         adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr),
559                             data->fan_div[nr]);
560         adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr),
561                             data->fan_min[nr]);
562
563         /* Invalidate the cache: fan speed is no longer valid */
564         data->valid = 0;
565         mutex_unlock(&data->update_lock);
566         return count;
567 }
568
569 #define fan_offset(offset)                                              \
570 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO,                 \
571                 show_fan, NULL, offset - 1);                            \
572 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,         \
573                 show_fan_min, set_fan_min, offset - 1);                 \
574 static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,         \
575                 show_fan_div, set_fan_div, offset - 1)
576
577 fan_offset(1);
578 fan_offset(2);
579
580
581 /* Temps */
582 static ssize_t show_temp(struct device *dev,
583                          struct device_attribute *attr, char *buf)
584 {
585         int nr = to_sensor_dev_attr(attr)->index;
586         struct adm1031_data *data = adm1031_update_device(dev);
587         int ext;
588         ext = nr == 0 ?
589             ((data->ext_temp[nr] >> 6) & 0x3) * 2 :
590             (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7));
591         return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext));
592 }
593 static ssize_t show_temp_offset(struct device *dev,
594                                 struct device_attribute *attr, char *buf)
595 {
596         int nr = to_sensor_dev_attr(attr)->index;
597         struct adm1031_data *data = adm1031_update_device(dev);
598         return sprintf(buf, "%d\n",
599                        TEMP_OFFSET_FROM_REG(data->temp_offset[nr]));
600 }
601 static ssize_t show_temp_min(struct device *dev,
602                              struct device_attribute *attr, char *buf)
603 {
604         int nr = to_sensor_dev_attr(attr)->index;
605         struct adm1031_data *data = adm1031_update_device(dev);
606         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
607 }
608 static ssize_t show_temp_max(struct device *dev,
609                              struct device_attribute *attr, char *buf)
610 {
611         int nr = to_sensor_dev_attr(attr)->index;
612         struct adm1031_data *data = adm1031_update_device(dev);
613         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
614 }
615 static ssize_t show_temp_crit(struct device *dev,
616                               struct device_attribute *attr, char *buf)
617 {
618         int nr = to_sensor_dev_attr(attr)->index;
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 set_temp_offset(struct device *dev,
623                                struct device_attribute *attr, const char *buf,
624                                size_t count)
625 {
626         struct i2c_client *client = to_i2c_client(dev);
627         struct adm1031_data *data = i2c_get_clientdata(client);
628         int nr = to_sensor_dev_attr(attr)->index;
629         int val;
630
631         val = simple_strtol(buf, NULL, 10);
632         val = SENSORS_LIMIT(val, -15000, 15000);
633         mutex_lock(&data->update_lock);
634         data->temp_offset[nr] = TEMP_OFFSET_TO_REG(val);
635         adm1031_write_value(client, ADM1031_REG_TEMP_OFFSET(nr),
636                             data->temp_offset[nr]);
637         mutex_unlock(&data->update_lock);
638         return count;
639 }
640 static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
641                             const char *buf, size_t count)
642 {
643         struct i2c_client *client = to_i2c_client(dev);
644         struct adm1031_data *data = i2c_get_clientdata(client);
645         int nr = to_sensor_dev_attr(attr)->index;
646         int val;
647
648         val = simple_strtol(buf, NULL, 10);
649         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
650         mutex_lock(&data->update_lock);
651         data->temp_min[nr] = TEMP_TO_REG(val);
652         adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr),
653                             data->temp_min[nr]);
654         mutex_unlock(&data->update_lock);
655         return count;
656 }
657 static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
658                             const char *buf, size_t count)
659 {
660         struct i2c_client *client = to_i2c_client(dev);
661         struct adm1031_data *data = i2c_get_clientdata(client);
662         int nr = to_sensor_dev_attr(attr)->index;
663         int val;
664
665         val = simple_strtol(buf, NULL, 10);
666         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
667         mutex_lock(&data->update_lock);
668         data->temp_max[nr] = TEMP_TO_REG(val);
669         adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr),
670                             data->temp_max[nr]);
671         mutex_unlock(&data->update_lock);
672         return count;
673 }
674 static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr,
675                              const char *buf, size_t count)
676 {
677         struct i2c_client *client = to_i2c_client(dev);
678         struct adm1031_data *data = i2c_get_clientdata(client);
679         int nr = to_sensor_dev_attr(attr)->index;
680         int val;
681
682         val = simple_strtol(buf, NULL, 10);
683         val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
684         mutex_lock(&data->update_lock);
685         data->temp_crit[nr] = TEMP_TO_REG(val);
686         adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr),
687                             data->temp_crit[nr]);
688         mutex_unlock(&data->update_lock);
689         return count;
690 }
691
692 #define temp_reg(offset)                                                \
693 static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO,                \
694                 show_temp, NULL, offset - 1);                           \
695 static SENSOR_DEVICE_ATTR(temp##offset##_offset, S_IRUGO | S_IWUSR,     \
696                 show_temp_offset, set_temp_offset, offset - 1);         \
697 static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,        \
698                 show_temp_min, set_temp_min, offset - 1);               \
699 static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,        \
700                 show_temp_max, set_temp_max, offset - 1);               \
701 static SENSOR_DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR,       \
702                 show_temp_crit, set_temp_crit, offset - 1)
703
704 temp_reg(1);
705 temp_reg(2);
706 temp_reg(3);
707
708 /* Alarms */
709 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
710 {
711         struct adm1031_data *data = adm1031_update_device(dev);
712         return sprintf(buf, "%d\n", data->alarm);
713 }
714
715 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
716
717 static ssize_t show_alarm(struct device *dev,
718                           struct device_attribute *attr, char *buf)
719 {
720         int bitnr = to_sensor_dev_attr(attr)->index;
721         struct adm1031_data *data = adm1031_update_device(dev);
722         return sprintf(buf, "%d\n", (data->alarm >> bitnr) & 1);
723 }
724
725 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 0);
726 static SENSOR_DEVICE_ATTR(fan1_fault, S_IRUGO, show_alarm, NULL, 1);
727 static SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_alarm, NULL, 2);
728 static SENSOR_DEVICE_ATTR(temp2_min_alarm, S_IRUGO, show_alarm, NULL, 3);
729 static SENSOR_DEVICE_ATTR(temp2_crit_alarm, S_IRUGO, show_alarm, NULL, 4);
730 static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 5);
731 static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 6);
732 static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL, 7);
733 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 8);
734 static SENSOR_DEVICE_ATTR(fan2_fault, S_IRUGO, show_alarm, NULL, 9);
735 static SENSOR_DEVICE_ATTR(temp3_max_alarm, S_IRUGO, show_alarm, NULL, 10);
736 static SENSOR_DEVICE_ATTR(temp3_min_alarm, S_IRUGO, show_alarm, NULL, 11);
737 static SENSOR_DEVICE_ATTR(temp3_crit_alarm, S_IRUGO, show_alarm, NULL, 12);
738 static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 13);
739 static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 14);
740
741 static struct attribute *adm1031_attributes[] = {
742         &sensor_dev_attr_fan1_input.dev_attr.attr,
743         &sensor_dev_attr_fan1_div.dev_attr.attr,
744         &sensor_dev_attr_fan1_min.dev_attr.attr,
745         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
746         &sensor_dev_attr_fan1_fault.dev_attr.attr,
747         &sensor_dev_attr_pwm1.dev_attr.attr,
748         &sensor_dev_attr_auto_fan1_channel.dev_attr.attr,
749         &sensor_dev_attr_temp1_input.dev_attr.attr,
750         &sensor_dev_attr_temp1_offset.dev_attr.attr,
751         &sensor_dev_attr_temp1_min.dev_attr.attr,
752         &sensor_dev_attr_temp1_min_alarm.dev_attr.attr,
753         &sensor_dev_attr_temp1_max.dev_attr.attr,
754         &sensor_dev_attr_temp1_max_alarm.dev_attr.attr,
755         &sensor_dev_attr_temp1_crit.dev_attr.attr,
756         &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr,
757         &sensor_dev_attr_temp2_input.dev_attr.attr,
758         &sensor_dev_attr_temp2_offset.dev_attr.attr,
759         &sensor_dev_attr_temp2_min.dev_attr.attr,
760         &sensor_dev_attr_temp2_min_alarm.dev_attr.attr,
761         &sensor_dev_attr_temp2_max.dev_attr.attr,
762         &sensor_dev_attr_temp2_max_alarm.dev_attr.attr,
763         &sensor_dev_attr_temp2_crit.dev_attr.attr,
764         &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr,
765         &sensor_dev_attr_temp2_fault.dev_attr.attr,
766
767         &sensor_dev_attr_auto_temp1_off.dev_attr.attr,
768         &sensor_dev_attr_auto_temp1_min.dev_attr.attr,
769         &sensor_dev_attr_auto_temp1_max.dev_attr.attr,
770
771         &sensor_dev_attr_auto_temp2_off.dev_attr.attr,
772         &sensor_dev_attr_auto_temp2_min.dev_attr.attr,
773         &sensor_dev_attr_auto_temp2_max.dev_attr.attr,
774
775         &sensor_dev_attr_auto_fan1_min_pwm.dev_attr.attr,
776
777         &dev_attr_alarms.attr,
778
779         NULL
780 };
781
782 static const struct attribute_group adm1031_group = {
783         .attrs = adm1031_attributes,
784 };
785
786 static struct attribute *adm1031_attributes_opt[] = {
787         &sensor_dev_attr_fan2_input.dev_attr.attr,
788         &sensor_dev_attr_fan2_div.dev_attr.attr,
789         &sensor_dev_attr_fan2_min.dev_attr.attr,
790         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
791         &sensor_dev_attr_fan2_fault.dev_attr.attr,
792         &sensor_dev_attr_pwm2.dev_attr.attr,
793         &sensor_dev_attr_auto_fan2_channel.dev_attr.attr,
794         &sensor_dev_attr_temp3_input.dev_attr.attr,
795         &sensor_dev_attr_temp3_offset.dev_attr.attr,
796         &sensor_dev_attr_temp3_min.dev_attr.attr,
797         &sensor_dev_attr_temp3_min_alarm.dev_attr.attr,
798         &sensor_dev_attr_temp3_max.dev_attr.attr,
799         &sensor_dev_attr_temp3_max_alarm.dev_attr.attr,
800         &sensor_dev_attr_temp3_crit.dev_attr.attr,
801         &sensor_dev_attr_temp3_crit_alarm.dev_attr.attr,
802         &sensor_dev_attr_temp3_fault.dev_attr.attr,
803         &sensor_dev_attr_auto_temp3_off.dev_attr.attr,
804         &sensor_dev_attr_auto_temp3_min.dev_attr.attr,
805         &sensor_dev_attr_auto_temp3_max.dev_attr.attr,
806         &sensor_dev_attr_auto_fan2_min_pwm.dev_attr.attr,
807         NULL
808 };
809
810 static const struct attribute_group adm1031_group_opt = {
811         .attrs = adm1031_attributes_opt,
812 };
813
814 /* Return 0 if detection is successful, -ENODEV otherwise */
815 static int adm1031_detect(struct i2c_client *client,
816                           struct i2c_board_info *info)
817 {
818         struct i2c_adapter *adapter = client->adapter;
819         const char *name;
820         int id, co;
821
822         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
823                 return -ENODEV;
824
825         id = i2c_smbus_read_byte_data(client, 0x3d);
826         co = i2c_smbus_read_byte_data(client, 0x3e);
827
828         if (!((id == 0x31 || id == 0x30) && co == 0x41))
829                 return -ENODEV;
830         name = (id == 0x30) ? "adm1030" : "adm1031";
831
832         strlcpy(info->type, name, I2C_NAME_SIZE);
833
834         return 0;
835 }
836
837 static int adm1031_probe(struct i2c_client *client,
838                          const struct i2c_device_id *id)
839 {
840         struct adm1031_data *data;
841         int err;
842
843         data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL);
844         if (!data) {
845                 err = -ENOMEM;
846                 goto exit;
847         }
848
849         i2c_set_clientdata(client, data);
850         data->chip_type = id->driver_data;
851         mutex_init(&data->update_lock);
852
853         if (data->chip_type == adm1030)
854                 data->chan_select_table = &auto_channel_select_table_adm1030;
855         else
856                 data->chan_select_table = &auto_channel_select_table_adm1031;
857
858         /* Initialize the ADM1031 chip */
859         adm1031_init_client(client);
860
861         /* Register sysfs hooks */
862         if ((err = sysfs_create_group(&client->dev.kobj, &adm1031_group)))
863                 goto exit_free;
864
865         if (data->chip_type == adm1031) {
866                 if ((err = sysfs_create_group(&client->dev.kobj,
867                                                 &adm1031_group_opt)))
868                         goto exit_remove;
869         }
870
871         data->hwmon_dev = hwmon_device_register(&client->dev);
872         if (IS_ERR(data->hwmon_dev)) {
873                 err = PTR_ERR(data->hwmon_dev);
874                 goto exit_remove;
875         }
876
877         return 0;
878
879 exit_remove:
880         sysfs_remove_group(&client->dev.kobj, &adm1031_group);
881         sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt);
882 exit_free:
883         kfree(data);
884 exit:
885         return err;
886 }
887
888 static int adm1031_remove(struct i2c_client *client)
889 {
890         struct adm1031_data *data = i2c_get_clientdata(client);
891
892         hwmon_device_unregister(data->hwmon_dev);
893         sysfs_remove_group(&client->dev.kobj, &adm1031_group);
894         sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt);
895         kfree(data);
896         return 0;
897 }
898
899 static void adm1031_init_client(struct i2c_client *client)
900 {
901         unsigned int read_val;
902         unsigned int mask;
903         struct adm1031_data *data = i2c_get_clientdata(client);
904
905         mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE);
906         if (data->chip_type == adm1031) {
907                 mask |= (ADM1031_CONF2_PWM2_ENABLE |
908                         ADM1031_CONF2_TACH2_ENABLE);
909         }
910         /* Initialize the ADM1031 chip (enables fan speed reading ) */
911         read_val = adm1031_read_value(client, ADM1031_REG_CONF2);
912         if ((read_val | mask) != read_val) {
913             adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask);
914         }
915
916         read_val = adm1031_read_value(client, ADM1031_REG_CONF1);
917         if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) {
918             adm1031_write_value(client, ADM1031_REG_CONF1, read_val |
919                                 ADM1031_CONF1_MONITOR_ENABLE);
920         }
921
922 }
923
924 static struct adm1031_data *adm1031_update_device(struct device *dev)
925 {
926         struct i2c_client *client = to_i2c_client(dev);
927         struct adm1031_data *data = i2c_get_clientdata(client);
928         int chan;
929
930         mutex_lock(&data->update_lock);
931
932         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
933             || !data->valid) {
934
935                 dev_dbg(&client->dev, "Starting adm1031 update\n");
936                 for (chan = 0;
937                      chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) {
938                         u8 oldh, newh;
939
940                         oldh =
941                             adm1031_read_value(client, ADM1031_REG_TEMP(chan));
942                         data->ext_temp[chan] =
943                             adm1031_read_value(client, ADM1031_REG_EXT_TEMP);
944                         newh =
945                             adm1031_read_value(client, ADM1031_REG_TEMP(chan));
946                         if (newh != oldh) {
947                                 data->ext_temp[chan] =
948                                     adm1031_read_value(client,
949                                                        ADM1031_REG_EXT_TEMP);
950 #ifdef DEBUG
951                                 oldh =
952                                     adm1031_read_value(client,
953                                                        ADM1031_REG_TEMP(chan));
954
955                                 /* oldh is actually newer */
956                                 if (newh != oldh)
957                                         dev_warn(&client->dev,
958                                                  "Remote temperature may be "
959                                                  "wrong.\n");
960 #endif
961                         }
962                         data->temp[chan] = newh;
963
964                         data->temp_offset[chan] =
965                             adm1031_read_value(client,
966                                                ADM1031_REG_TEMP_OFFSET(chan));
967                         data->temp_min[chan] =
968                             adm1031_read_value(client,
969                                                ADM1031_REG_TEMP_MIN(chan));
970                         data->temp_max[chan] =
971                             adm1031_read_value(client,
972                                                ADM1031_REG_TEMP_MAX(chan));
973                         data->temp_crit[chan] =
974                             adm1031_read_value(client,
975                                                ADM1031_REG_TEMP_CRIT(chan));
976                         data->auto_temp[chan] =
977                             adm1031_read_value(client,
978                                                ADM1031_REG_AUTO_TEMP(chan));
979
980                 }
981
982                 data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1);
983                 data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2);
984
985                 data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0))
986                              | (adm1031_read_value(client, ADM1031_REG_STATUS(1))
987                                 << 8);
988                 if (data->chip_type == adm1030) {
989                         data->alarm &= 0xc0ff;
990                 }
991
992                 for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) {
993                         data->fan_div[chan] =
994                             adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan));
995                         data->fan_min[chan] =
996                             adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan));
997                         data->fan[chan] =
998                             adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan));
999                         data->pwm[chan] =
1000                             0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >>
1001                                    (4*chan));
1002                 }
1003                 data->last_updated = jiffies;
1004                 data->valid = 1;
1005         }
1006
1007         mutex_unlock(&data->update_lock);
1008
1009         return data;
1010 }
1011
1012 static int __init sensors_adm1031_init(void)
1013 {
1014         return i2c_add_driver(&adm1031_driver);
1015 }
1016
1017 static void __exit sensors_adm1031_exit(void)
1018 {
1019         i2c_del_driver(&adm1031_driver);
1020 }
1021
1022 MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>");
1023 MODULE_DESCRIPTION("ADM1031/ADM1030 driver");
1024 MODULE_LICENSE("GPL");
1025
1026 module_init(sensors_adm1031_init);
1027 module_exit(sensors_adm1031_exit);