[PATCH] Fix manual binding infinite loop
[linux-2.6] / drivers / hwmon / lm87.c
1 /*
2  * lm87.c
3  *
4  * Copyright (C) 2000       Frodo Looijaard <frodol@dds.nl>
5  *                          Philip Edelbrock <phil@netroedge.com>
6  *                          Stephen Rousset <stephen.rousset@rocketlogix.com>
7  *                          Dan Eaton <dan.eaton@rocketlogix.com>
8  * Copyright (C) 2004       Jean Delvare <khali@linux-fr.org>
9  *
10  * Original port to Linux 2.6 by Jeff Oliver.
11  *
12  * The LM87 is a sensor chip made by National Semiconductor. It monitors up
13  * to 8 voltages (including its own power source), up to three temperatures
14  * (its own plus up to two external ones) and up to two fans. The default
15  * configuration is 6 voltages, two temperatures and two fans (see below).
16  * Voltages are scaled internally with ratios such that the nominal value of
17  * each voltage correspond to a register value of 192 (which means a
18  * resolution of about 0.5% of the nominal value). Temperature values are
19  * reported with a 1 deg resolution and a 3-4 deg accuracy. Complete
20  * datasheet can be obtained from National's website at:
21  *   http://www.national.com/pf/LM/LM87.html
22  *
23  * Some functions share pins, so not all functions are available at the same
24  * time. Which are depends on the hardware setup. This driver assumes that
25  * the BIOS configured the chip correctly. In that respect, it  differs from
26  * the original driver (from lm_sensors for Linux 2.4), which would force the
27  * LM87 to an arbitrary, compile-time chosen mode, regardless of the actual
28  * chipset wiring.
29  * For reference, here is the list of exclusive functions:
30  *  - in0+in5 (default) or temp3
31  *  - fan1 (default) or in6
32  *  - fan2 (default) or in7
33  *  - VID lines (default) or IRQ lines (not handled by this driver)
34  *
35  * The LM87 additionally features an analog output, supposedly usable to
36  * control the speed of a fan. All new chips use pulse width modulation
37  * instead. The LM87 is the only hardware monitoring chipset I know of
38  * which uses amplitude modulation. Be careful when using this feature.
39  *
40  * This program is free software; you can redistribute it and/or modify
41  * it under the terms of the GNU General Public License as published by
42  * the Free Software Foundation; either version 2 of the License, or
43  * (at your option) any later version.
44  *
45  * This program is distributed in the hope that it will be useful,
46  * but WITHOUT ANY WARRANTY; without even the implied warranty of
47  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
48  * GNU General Public License for more details.
49  *
50  * You should have received a copy of the GNU General Public License
51  * along with this program; if not, write to the Free Software
52  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
53  */
54
55 #include <linux/module.h>
56 #include <linux/init.h>
57 #include <linux/slab.h>
58 #include <linux/jiffies.h>
59 #include <linux/i2c.h>
60 #include <linux/i2c-sensor.h>
61 #include <linux/i2c-vid.h>
62
63 /*
64  * Addresses to scan
65  * LM87 has three possible addresses: 0x2c, 0x2d and 0x2e.
66  */
67
68 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
69 static unsigned int normal_isa[] = { I2C_CLIENT_ISA_END };
70
71 /*
72  * Insmod parameters
73  */
74
75 SENSORS_INSMOD_1(lm87);
76
77 /*
78  * The LM87 registers
79  */
80
81 /* nr in 0..5 */
82 #define LM87_REG_IN(nr)                 (0x20 + (nr))
83 #define LM87_REG_IN_MAX(nr)             (0x2B + (nr) * 2)
84 #define LM87_REG_IN_MIN(nr)             (0x2C + (nr) * 2)
85 /* nr in 0..1 */
86 #define LM87_REG_AIN(nr)                (0x28 + (nr))
87 #define LM87_REG_AIN_MIN(nr)            (0x1A + (nr))
88 #define LM87_REG_AIN_MAX(nr)            (0x3B + (nr))
89
90 static u8 LM87_REG_TEMP[3] = { 0x27, 0x26, 0x20 };
91 static u8 LM87_REG_TEMP_HIGH[3] = { 0x39, 0x37, 0x2B };
92 static u8 LM87_REG_TEMP_LOW[3] = { 0x3A, 0x38, 0x2C };
93
94 #define LM87_REG_TEMP_HW_INT_LOCK       0x13
95 #define LM87_REG_TEMP_HW_EXT_LOCK       0x14
96 #define LM87_REG_TEMP_HW_INT            0x17
97 #define LM87_REG_TEMP_HW_EXT            0x18
98
99 /* nr in 0..1 */
100 #define LM87_REG_FAN(nr)                (0x28 + (nr))
101 #define LM87_REG_FAN_MIN(nr)            (0x3B + (nr))
102 #define LM87_REG_AOUT                   0x19
103
104 #define LM87_REG_CONFIG                 0x40
105 #define LM87_REG_CHANNEL_MODE           0x16
106 #define LM87_REG_VID_FAN_DIV            0x47
107 #define LM87_REG_VID4                   0x49
108
109 #define LM87_REG_ALARMS1                0x41
110 #define LM87_REG_ALARMS2                0x42
111
112 #define LM87_REG_COMPANY_ID             0x3E
113 #define LM87_REG_REVISION               0x3F
114
115 /*
116  * Conversions and various macros
117  * The LM87 uses signed 8-bit values for temperatures.
118  */
119
120 #define IN_FROM_REG(reg,scale)  (((reg) * (scale) + 96) / 192)
121 #define IN_TO_REG(val,scale)    ((val) <= 0 ? 0 : \
122                                  (val) * 192 >= (scale) * 255 ? 255 : \
123                                  ((val) * 192 + (scale)/2) / (scale))
124
125 #define TEMP_FROM_REG(reg)      ((reg) * 1000)
126 #define TEMP_TO_REG(val)        ((val) <= -127500 ? -128 : \
127                                  (val) >= 126500 ? 127 : \
128                                  (((val) < 0 ? (val)-500 : (val)+500) / 1000))
129
130 #define FAN_FROM_REG(reg,div)   ((reg) == 255 || (reg) == 0 ? 0 : \
131                                  1350000 + (reg)*(div) / 2) / ((reg)*(div))
132 #define FAN_TO_REG(val,div)     ((val)*(div) * 255 <= 1350000 ? 255 : \
133                                  (1350000 + (val)*(div) / 2) / ((val)*(div)))
134
135 #define FAN_DIV_FROM_REG(reg)   (1 << (reg))
136
137 /* analog out is 9.80mV/LSB */
138 #define AOUT_FROM_REG(reg)      (((reg) * 98 + 5) / 10)
139 #define AOUT_TO_REG(val)        ((val) <= 0 ? 0 : \
140                                  (val) >= 2500 ? 255 : \
141                                  ((val) * 10 + 49) / 98)
142
143 /* nr in 0..1 */
144 #define CHAN_NO_FAN(nr)         (1 << (nr))
145 #define CHAN_TEMP3              (1 << 2)
146 #define CHAN_VCC_5V             (1 << 3)
147 #define CHAN_NO_VID             (1 << 8)
148
149 /*
150  * Functions declaration
151  */
152
153 static int lm87_attach_adapter(struct i2c_adapter *adapter);
154 static int lm87_detect(struct i2c_adapter *adapter, int address, int kind);
155 static void lm87_init_client(struct i2c_client *client);
156 static int lm87_detach_client(struct i2c_client *client);
157 static struct lm87_data *lm87_update_device(struct device *dev);
158
159 /*
160  * Driver data (common to all clients)
161  */
162
163 static struct i2c_driver lm87_driver = {
164         .owner          = THIS_MODULE,
165         .name           = "lm87",
166         .id             = I2C_DRIVERID_LM87,
167         .flags          = I2C_DF_NOTIFY,
168         .attach_adapter = lm87_attach_adapter,
169         .detach_client  = lm87_detach_client,
170 };
171
172 /*
173  * Client data (each client gets its own)
174  */
175
176 struct lm87_data {
177         struct i2c_client client;
178         struct semaphore update_lock;
179         char valid; /* zero until following fields are valid */
180         unsigned long last_updated; /* In jiffies */
181
182         u8 channel;             /* register value */
183
184         u8 in[8];               /* register value */
185         u8 in_max[8];           /* register value */
186         u8 in_min[8];           /* register value */
187         u16 in_scale[8];
188
189         s8 temp[3];             /* register value */
190         s8 temp_high[3];        /* register value */
191         s8 temp_low[3];         /* register value */
192         s8 temp_crit_int;       /* min of two register values */
193         s8 temp_crit_ext;       /* min of two register values */
194
195         u8 fan[2];              /* register value */
196         u8 fan_min[2];          /* register value */
197         u8 fan_div[2];          /* register value, shifted right */
198         u8 aout;                /* register value */
199
200         u16 alarms;             /* register values, combined */
201         u8 vid;                 /* register values, combined */
202         u8 vrm;
203 };
204
205 /*
206  * Sysfs stuff
207  */
208
209 static inline int lm87_read_value(struct i2c_client *client, u8 reg)
210 {
211         return i2c_smbus_read_byte_data(client, reg);
212 }
213
214 static inline int lm87_write_value(struct i2c_client *client, u8 reg, u8 value)
215 {
216         return i2c_smbus_write_byte_data(client, reg, value);
217 }
218
219 #define show_in(offset) \
220 static ssize_t show_in##offset##_input(struct device *dev, struct device_attribute *attr, char *buf) \
221 { \
222         struct lm87_data *data = lm87_update_device(dev); \
223         return sprintf(buf, "%u\n", IN_FROM_REG(data->in[offset], \
224                        data->in_scale[offset])); \
225 } \
226 static ssize_t show_in##offset##_min(struct device *dev, struct device_attribute *attr, char *buf) \
227 { \
228         struct lm87_data *data = lm87_update_device(dev); \
229         return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[offset], \
230                        data->in_scale[offset])); \
231 } \
232 static ssize_t show_in##offset##_max(struct device *dev, struct device_attribute *attr, char *buf) \
233 { \
234         struct lm87_data *data = lm87_update_device(dev); \
235         return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[offset], \
236                        data->in_scale[offset])); \
237 } \
238 static DEVICE_ATTR(in##offset##_input, S_IRUGO, \
239                 show_in##offset##_input, NULL);
240 show_in(0);
241 show_in(1);
242 show_in(2);
243 show_in(3);
244 show_in(4);
245 show_in(5);
246 show_in(6);
247 show_in(7);
248
249 static void set_in_min(struct device *dev, const char *buf, int nr)
250 {
251         struct i2c_client *client = to_i2c_client(dev);
252         struct lm87_data *data = i2c_get_clientdata(client);
253         long val = simple_strtol(buf, NULL, 10);
254
255         down(&data->update_lock);
256         data->in_min[nr] = IN_TO_REG(val, data->in_scale[nr]);
257         lm87_write_value(client, nr<6 ? LM87_REG_IN_MIN(nr) :
258                          LM87_REG_AIN_MIN(nr-6), data->in_min[nr]);
259         up(&data->update_lock);
260 }
261
262 static void set_in_max(struct device *dev, const char *buf, int nr)
263 {
264         struct i2c_client *client = to_i2c_client(dev);
265         struct lm87_data *data = i2c_get_clientdata(client);
266         long val = simple_strtol(buf, NULL, 10);
267
268         down(&data->update_lock);
269         data->in_max[nr] = IN_TO_REG(val, data->in_scale[nr]);
270         lm87_write_value(client, nr<6 ? LM87_REG_IN_MAX(nr) :
271                          LM87_REG_AIN_MAX(nr-6), data->in_max[nr]);
272         up(&data->update_lock);
273 }
274
275 #define set_in(offset) \
276 static ssize_t set_in##offset##_min(struct device *dev, struct device_attribute *attr, \
277                 const char *buf, size_t count) \
278 { \
279         set_in_min(dev, buf, offset); \
280         return count; \
281 } \
282 static ssize_t set_in##offset##_max(struct device *dev, struct device_attribute *attr, \
283                 const char *buf, size_t count) \
284 { \
285         set_in_max(dev, buf, offset); \
286         return count; \
287 } \
288 static DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
289                 show_in##offset##_min, set_in##offset##_min); \
290 static DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
291                 show_in##offset##_max, set_in##offset##_max);
292 set_in(0);
293 set_in(1);
294 set_in(2);
295 set_in(3);
296 set_in(4);
297 set_in(5);
298 set_in(6);
299 set_in(7);
300
301 #define show_temp(offset) \
302 static ssize_t show_temp##offset##_input(struct device *dev, struct device_attribute *attr, char *buf) \
303 { \
304         struct lm87_data *data = lm87_update_device(dev); \
305         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[offset-1])); \
306 } \
307 static ssize_t show_temp##offset##_low(struct device *dev, struct device_attribute *attr, char *buf) \
308 { \
309         struct lm87_data *data = lm87_update_device(dev); \
310         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_low[offset-1])); \
311 } \
312 static ssize_t show_temp##offset##_high(struct device *dev, struct device_attribute *attr, char *buf) \
313 { \
314         struct lm87_data *data = lm87_update_device(dev); \
315         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_high[offset-1])); \
316 }\
317 static DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
318                 show_temp##offset##_input, NULL);
319 show_temp(1);
320 show_temp(2);
321 show_temp(3);
322
323 static void set_temp_low(struct device *dev, const char *buf, int nr)
324 {
325         struct i2c_client *client = to_i2c_client(dev);
326         struct lm87_data *data = i2c_get_clientdata(client);
327         long val = simple_strtol(buf, NULL, 10);
328
329         down(&data->update_lock);
330         data->temp_low[nr] = TEMP_TO_REG(val);
331         lm87_write_value(client, LM87_REG_TEMP_LOW[nr], data->temp_low[nr]);
332         up(&data->update_lock);
333 }
334
335 static void set_temp_high(struct device *dev, const char *buf, int nr)
336 {
337         struct i2c_client *client = to_i2c_client(dev);
338         struct lm87_data *data = i2c_get_clientdata(client);
339         long val = simple_strtol(buf, NULL, 10);
340
341         down(&data->update_lock);
342         data->temp_high[nr] = TEMP_TO_REG(val);
343         lm87_write_value(client, LM87_REG_TEMP_HIGH[nr], data->temp_high[nr]);
344         up(&data->update_lock);
345 }
346
347 #define set_temp(offset) \
348 static ssize_t set_temp##offset##_low(struct device *dev, struct device_attribute *attr, \
349                 const char *buf, size_t count) \
350 { \
351         set_temp_low(dev, buf, offset-1); \
352         return count; \
353 } \
354 static ssize_t set_temp##offset##_high(struct device *dev, struct device_attribute *attr, \
355                 const char *buf, size_t count) \
356 { \
357         set_temp_high(dev, buf, offset-1); \
358         return count; \
359 } \
360 static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
361                 show_temp##offset##_high, set_temp##offset##_high); \
362 static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \
363                 show_temp##offset##_low, set_temp##offset##_low);
364 set_temp(1);
365 set_temp(2);
366 set_temp(3);
367
368 static ssize_t show_temp_crit_int(struct device *dev, struct device_attribute *attr, char *buf)
369 {
370         struct lm87_data *data = lm87_update_device(dev);
371         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit_int));
372 }
373
374 static ssize_t show_temp_crit_ext(struct device *dev, struct device_attribute *attr, char *buf)
375 {
376         struct lm87_data *data = lm87_update_device(dev);
377         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit_ext));
378 }
379
380 static DEVICE_ATTR(temp1_crit, S_IRUGO, show_temp_crit_int, NULL);
381 static DEVICE_ATTR(temp2_crit, S_IRUGO, show_temp_crit_ext, NULL);
382 static DEVICE_ATTR(temp3_crit, S_IRUGO, show_temp_crit_ext, NULL);
383
384 #define show_fan(offset) \
385 static ssize_t show_fan##offset##_input(struct device *dev, struct device_attribute *attr, char *buf) \
386 { \
387         struct lm87_data *data = lm87_update_device(dev); \
388         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[offset-1], \
389                        FAN_DIV_FROM_REG(data->fan_div[offset-1]))); \
390 } \
391 static ssize_t show_fan##offset##_min(struct device *dev, struct device_attribute *attr, char *buf) \
392 { \
393         struct lm87_data *data = lm87_update_device(dev); \
394         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[offset-1], \
395                        FAN_DIV_FROM_REG(data->fan_div[offset-1]))); \
396 } \
397 static ssize_t show_fan##offset##_div(struct device *dev, struct device_attribute *attr, char *buf) \
398 { \
399         struct lm87_data *data = lm87_update_device(dev); \
400         return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[offset-1])); \
401 } \
402 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
403                 show_fan##offset##_input, NULL);
404 show_fan(1);
405 show_fan(2);
406
407 static void set_fan_min(struct device *dev, const char *buf, int nr)
408 {
409         struct i2c_client *client = to_i2c_client(dev);
410         struct lm87_data *data = i2c_get_clientdata(client);
411         long val = simple_strtol(buf, NULL, 10);
412
413         down(&data->update_lock);
414         data->fan_min[nr] = FAN_TO_REG(val,
415                             FAN_DIV_FROM_REG(data->fan_div[nr]));
416         lm87_write_value(client, LM87_REG_FAN_MIN(nr), data->fan_min[nr]);
417         up(&data->update_lock);
418 }
419
420 /* Note: we save and restore the fan minimum here, because its value is
421    determined in part by the fan clock divider.  This follows the principle
422    of least suprise; the user doesn't expect the fan minimum to change just
423    because the divider changed. */
424 static ssize_t set_fan_div(struct device *dev, const char *buf,
425                 size_t count, int nr)
426 {
427         struct i2c_client *client = to_i2c_client(dev);
428         struct lm87_data *data = i2c_get_clientdata(client);
429         long val = simple_strtol(buf, NULL, 10);
430         unsigned long min;
431         u8 reg;
432
433         down(&data->update_lock);
434         min = FAN_FROM_REG(data->fan_min[nr],
435                            FAN_DIV_FROM_REG(data->fan_div[nr]));
436
437         switch (val) {
438         case 1: data->fan_div[nr] = 0; break;
439         case 2: data->fan_div[nr] = 1; break;
440         case 4: data->fan_div[nr] = 2; break;
441         case 8: data->fan_div[nr] = 3; break;
442         default:
443                 up(&data->update_lock);
444                 return -EINVAL;
445         }
446
447         reg = lm87_read_value(client, LM87_REG_VID_FAN_DIV);
448         switch (nr) {
449         case 0:
450             reg = (reg & 0xCF) | (data->fan_div[0] << 4);
451             break;
452         case 1:
453             reg = (reg & 0x3F) | (data->fan_div[1] << 6);
454             break;
455         }
456         lm87_write_value(client, LM87_REG_VID_FAN_DIV, reg);
457
458         data->fan_min[nr] = FAN_TO_REG(min, val);
459         lm87_write_value(client, LM87_REG_FAN_MIN(nr),
460                          data->fan_min[nr]);
461         up(&data->update_lock);
462
463         return count;
464 }
465
466 #define set_fan(offset) \
467 static ssize_t set_fan##offset##_min(struct device *dev, struct device_attribute *attr, const char *buf, \
468                 size_t count) \
469 { \
470         set_fan_min(dev, buf, offset-1); \
471         return count; \
472 } \
473 static ssize_t set_fan##offset##_div(struct device *dev, struct device_attribute *attr, const char *buf, \
474                 size_t count) \
475 { \
476         return set_fan_div(dev, buf, count, offset-1); \
477 } \
478 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
479                 show_fan##offset##_min, set_fan##offset##_min); \
480 static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
481                 show_fan##offset##_div, set_fan##offset##_div);
482 set_fan(1);
483 set_fan(2);
484
485 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
486 {
487         struct lm87_data *data = lm87_update_device(dev);
488         return sprintf(buf, "%d\n", data->alarms);
489 }
490 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
491
492 static ssize_t show_vid(struct device *dev, struct device_attribute *attr, char *buf)
493 {
494         struct lm87_data *data = lm87_update_device(dev);
495         return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
496 }
497 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
498
499 static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, char *buf)
500 {
501         struct lm87_data *data = lm87_update_device(dev);
502         return sprintf(buf, "%d\n", data->vrm);
503 }
504 static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
505 {
506         struct i2c_client *client = to_i2c_client(dev);
507         struct lm87_data *data = i2c_get_clientdata(client);
508         data->vrm = simple_strtoul(buf, NULL, 10);
509         return count;
510 }
511 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm, set_vrm);
512
513 static ssize_t show_aout(struct device *dev, struct device_attribute *attr, char *buf)
514 {
515         struct lm87_data *data = lm87_update_device(dev);
516         return sprintf(buf, "%d\n", AOUT_FROM_REG(data->aout));
517 }
518 static ssize_t set_aout(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
519 {
520         struct i2c_client *client = to_i2c_client(dev);
521         struct lm87_data *data = i2c_get_clientdata(client);
522         long val = simple_strtol(buf, NULL, 10);
523
524         down(&data->update_lock);
525         data->aout = AOUT_TO_REG(val);
526         lm87_write_value(client, LM87_REG_AOUT, data->aout);
527         up(&data->update_lock);
528         return count;
529 }
530 static DEVICE_ATTR(aout_output, S_IRUGO | S_IWUSR, show_aout, set_aout);
531
532 /*
533  * Real code
534  */
535
536 static int lm87_attach_adapter(struct i2c_adapter *adapter)
537 {
538         if (!(adapter->class & I2C_CLASS_HWMON))
539                 return 0;
540         return i2c_detect(adapter, &addr_data, lm87_detect);
541 }
542
543 /*
544  * The following function does more than just detection. If detection
545  * succeeds, it also registers the new chip.
546  */
547 static int lm87_detect(struct i2c_adapter *adapter, int address, int kind)
548 {
549         struct i2c_client *new_client;
550         struct lm87_data *data;
551         int err = 0;
552
553         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
554                 goto exit;
555
556         if (!(data = kmalloc(sizeof(struct lm87_data), GFP_KERNEL))) {
557                 err = -ENOMEM;
558                 goto exit;
559         }
560         memset(data, 0, sizeof(struct lm87_data));
561
562         /* The common I2C client data is placed right before the
563            LM87-specific data. */
564         new_client = &data->client;
565         i2c_set_clientdata(new_client, data);
566         new_client->addr = address;
567         new_client->adapter = adapter;
568         new_client->driver = &lm87_driver;
569         new_client->flags = 0;
570
571         /* Default to an LM87 if forced */
572         if (kind == 0)
573                 kind = lm87;
574
575         /* Now, we do the remaining detection. */
576         if (kind < 0) {
577                 u8 rev = lm87_read_value(new_client, LM87_REG_REVISION);
578
579                 if (rev < 0x01 || rev > 0x08
580                  || (lm87_read_value(new_client, LM87_REG_CONFIG) & 0x80)
581                  || lm87_read_value(new_client, LM87_REG_COMPANY_ID) != 0x02) {
582                         dev_dbg(&adapter->dev,
583                                 "LM87 detection failed at 0x%02x.\n",
584                                 address);
585                         goto exit_free;
586                 }
587         }
588
589         /* We can fill in the remaining client fields */
590         strlcpy(new_client->name, "lm87", I2C_NAME_SIZE);
591         data->valid = 0;
592         init_MUTEX(&data->update_lock);
593
594         /* Tell the I2C layer a new client has arrived */
595         if ((err = i2c_attach_client(new_client)))
596                 goto exit_free;
597
598         /* Initialize the LM87 chip */
599         lm87_init_client(new_client);
600
601         data->in_scale[0] = 2500;
602         data->in_scale[1] = 2700;
603         data->in_scale[2] = (data->channel & CHAN_VCC_5V) ? 5000 : 3300;
604         data->in_scale[3] = 5000;
605         data->in_scale[4] = 12000;
606         data->in_scale[5] = 2700;
607         data->in_scale[6] = 1875;
608         data->in_scale[7] = 1875;
609
610         /* Register sysfs hooks */
611         device_create_file(&new_client->dev, &dev_attr_in1_input);
612         device_create_file(&new_client->dev, &dev_attr_in1_min);
613         device_create_file(&new_client->dev, &dev_attr_in1_max);
614         device_create_file(&new_client->dev, &dev_attr_in2_input);
615         device_create_file(&new_client->dev, &dev_attr_in2_min);
616         device_create_file(&new_client->dev, &dev_attr_in2_max);
617         device_create_file(&new_client->dev, &dev_attr_in3_input);
618         device_create_file(&new_client->dev, &dev_attr_in3_min);
619         device_create_file(&new_client->dev, &dev_attr_in3_max);
620         device_create_file(&new_client->dev, &dev_attr_in4_input);
621         device_create_file(&new_client->dev, &dev_attr_in4_min);
622         device_create_file(&new_client->dev, &dev_attr_in4_max);
623
624         if (data->channel & CHAN_NO_FAN(0)) {
625                 device_create_file(&new_client->dev, &dev_attr_in6_input);
626                 device_create_file(&new_client->dev, &dev_attr_in6_min);
627                 device_create_file(&new_client->dev, &dev_attr_in6_max);
628         } else {
629                 device_create_file(&new_client->dev, &dev_attr_fan1_input);
630                 device_create_file(&new_client->dev, &dev_attr_fan1_min);
631                 device_create_file(&new_client->dev, &dev_attr_fan1_div);
632         }
633         if (data->channel & CHAN_NO_FAN(1)) {
634                 device_create_file(&new_client->dev, &dev_attr_in7_input);
635                 device_create_file(&new_client->dev, &dev_attr_in7_min);
636                 device_create_file(&new_client->dev, &dev_attr_in7_max);
637         } else {
638                 device_create_file(&new_client->dev, &dev_attr_fan2_input);
639                 device_create_file(&new_client->dev, &dev_attr_fan2_min);
640                 device_create_file(&new_client->dev, &dev_attr_fan2_div);
641         }
642
643         device_create_file(&new_client->dev, &dev_attr_temp1_input);
644         device_create_file(&new_client->dev, &dev_attr_temp1_max);
645         device_create_file(&new_client->dev, &dev_attr_temp1_min);
646         device_create_file(&new_client->dev, &dev_attr_temp1_crit);
647         device_create_file(&new_client->dev, &dev_attr_temp2_input);
648         device_create_file(&new_client->dev, &dev_attr_temp2_max);
649         device_create_file(&new_client->dev, &dev_attr_temp2_min);
650         device_create_file(&new_client->dev, &dev_attr_temp2_crit);
651
652         if (data->channel & CHAN_TEMP3) {
653                 device_create_file(&new_client->dev, &dev_attr_temp3_input);
654                 device_create_file(&new_client->dev, &dev_attr_temp3_max);
655                 device_create_file(&new_client->dev, &dev_attr_temp3_min);
656                 device_create_file(&new_client->dev, &dev_attr_temp3_crit);
657         } else {
658                 device_create_file(&new_client->dev, &dev_attr_in0_input);
659                 device_create_file(&new_client->dev, &dev_attr_in0_min);
660                 device_create_file(&new_client->dev, &dev_attr_in0_max);
661                 device_create_file(&new_client->dev, &dev_attr_in5_input);
662                 device_create_file(&new_client->dev, &dev_attr_in5_min);
663                 device_create_file(&new_client->dev, &dev_attr_in5_max);
664         }
665
666         if (!(data->channel & CHAN_NO_VID)) {
667                 device_create_file(&new_client->dev, &dev_attr_cpu0_vid);
668                 device_create_file(&new_client->dev, &dev_attr_vrm);
669         }
670
671         device_create_file(&new_client->dev, &dev_attr_alarms);
672         device_create_file(&new_client->dev, &dev_attr_aout_output);
673
674         return 0;
675
676 exit_free:
677         kfree(data);
678 exit:
679         return err;
680 }
681
682 static void lm87_init_client(struct i2c_client *client)
683 {
684         struct lm87_data *data = i2c_get_clientdata(client);
685         u8 config;
686
687         data->channel = lm87_read_value(client, LM87_REG_CHANNEL_MODE);
688         data->vrm = i2c_which_vrm();
689
690         config = lm87_read_value(client, LM87_REG_CONFIG);
691         if (!(config & 0x01)) {
692                 int i;
693
694                 /* Limits are left uninitialized after power-up */
695                 for (i = 1; i < 6; i++) {
696                         lm87_write_value(client, LM87_REG_IN_MIN(i), 0x00);
697                         lm87_write_value(client, LM87_REG_IN_MAX(i), 0xFF);
698                 }
699                 for (i = 0; i < 2; i++) {
700                         lm87_write_value(client, LM87_REG_TEMP_HIGH[i], 0x7F);
701                         lm87_write_value(client, LM87_REG_TEMP_LOW[i], 0x00);
702                         lm87_write_value(client, LM87_REG_AIN_MIN(i), 0x00);
703                         lm87_write_value(client, LM87_REG_AIN_MAX(i), 0xFF);
704                 }
705                 if (data->channel & CHAN_TEMP3) {
706                         lm87_write_value(client, LM87_REG_TEMP_HIGH[2], 0x7F);
707                         lm87_write_value(client, LM87_REG_TEMP_LOW[2], 0x00);
708                 } else {
709                         lm87_write_value(client, LM87_REG_IN_MIN(0), 0x00);
710                         lm87_write_value(client, LM87_REG_IN_MAX(0), 0xFF);
711                 }
712         }
713         if ((config & 0x81) != 0x01) {
714                 /* Start monitoring */
715                 lm87_write_value(client, LM87_REG_CONFIG,
716                                  (config & 0xF7) | 0x01);
717         }
718 }
719
720 static int lm87_detach_client(struct i2c_client *client)
721 {
722         int err;
723
724         if ((err = i2c_detach_client(client))) {
725                 dev_err(&client->dev, "Client deregistration failed, "
726                         "client not detached.\n");
727                 return err;
728         }
729
730         kfree(i2c_get_clientdata(client));
731         return 0;
732 }
733
734 static struct lm87_data *lm87_update_device(struct device *dev)
735 {
736         struct i2c_client *client = to_i2c_client(dev);
737         struct lm87_data *data = i2c_get_clientdata(client);
738
739         down(&data->update_lock);
740
741         if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
742                 int i, j;
743
744                 dev_dbg(&client->dev, "Updating data.\n");
745
746                 i = (data->channel & CHAN_TEMP3) ? 1 : 0;
747                 j = (data->channel & CHAN_TEMP3) ? 5 : 6;
748                 for (; i < j; i++) {
749                         data->in[i] = lm87_read_value(client,
750                                       LM87_REG_IN(i));
751                         data->in_min[i] = lm87_read_value(client,
752                                           LM87_REG_IN_MIN(i));
753                         data->in_max[i] = lm87_read_value(client,
754                                           LM87_REG_IN_MAX(i));
755                 }
756
757                 for (i = 0; i < 2; i++) {
758                         if (data->channel & CHAN_NO_FAN(i)) {
759                                 data->in[6+i] = lm87_read_value(client,
760                                                 LM87_REG_AIN(i));
761                                 data->in_max[6+i] = lm87_read_value(client,
762                                                     LM87_REG_AIN_MAX(i));
763                                 data->in_min[6+i] = lm87_read_value(client,
764                                                     LM87_REG_AIN_MIN(i));
765
766                         } else {
767                                 data->fan[i] = lm87_read_value(client,
768                                                LM87_REG_FAN(i));
769                                 data->fan_min[i] = lm87_read_value(client,
770                                                    LM87_REG_FAN_MIN(i));
771                         }
772                 }
773
774                 j = (data->channel & CHAN_TEMP3) ? 3 : 2;
775                 for (i = 0 ; i < j; i++) {
776                         data->temp[i] = lm87_read_value(client,
777                                         LM87_REG_TEMP[i]);
778                         data->temp_high[i] = lm87_read_value(client,
779                                              LM87_REG_TEMP_HIGH[i]);
780                         data->temp_low[i] = lm87_read_value(client,
781                                             LM87_REG_TEMP_LOW[i]);
782                 }
783
784                 i = lm87_read_value(client, LM87_REG_TEMP_HW_INT_LOCK);
785                 j = lm87_read_value(client, LM87_REG_TEMP_HW_INT);
786                 data->temp_crit_int = min(i, j);
787
788                 i = lm87_read_value(client, LM87_REG_TEMP_HW_EXT_LOCK);
789                 j = lm87_read_value(client, LM87_REG_TEMP_HW_EXT);
790                 data->temp_crit_ext = min(i, j);
791
792                 i = lm87_read_value(client, LM87_REG_VID_FAN_DIV);
793                 data->fan_div[0] = (i >> 4) & 0x03;
794                 data->fan_div[1] = (i >> 6) & 0x03;
795                 data->vid = (i & 0x0F)
796                           | (lm87_read_value(client, LM87_REG_VID4) & 0x01)
797                              << 4;
798
799                 data->alarms = lm87_read_value(client, LM87_REG_ALARMS1)
800                              | (lm87_read_value(client, LM87_REG_ALARMS2)
801                                 << 8);
802                 data->aout = lm87_read_value(client, LM87_REG_AOUT);
803
804                 data->last_updated = jiffies;
805                 data->valid = 1;
806         }
807
808         up(&data->update_lock);
809
810         return data;
811 }
812
813 static int __init sensors_lm87_init(void)
814 {
815         return i2c_add_driver(&lm87_driver);
816 }
817
818 static void __exit sensors_lm87_exit(void)
819 {
820         i2c_del_driver(&lm87_driver);
821 }
822
823 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org> and others");
824 MODULE_DESCRIPTION("LM87 driver");
825 MODULE_LICENSE("GPL");
826
827 module_init(sensors_lm87_init);
828 module_exit(sensors_lm87_exit);