IB/srp: Fix memory leak on reconnect
[linux-2.6] / drivers / hwmon / adm9240.c
1 /*
2  * adm9240.c    Part of lm_sensors, Linux kernel modules for hardware
3  *              monitoring
4  *
5  * Copyright (C) 1999   Frodo Looijaard <frodol@dds.nl>
6  *                      Philip Edelbrock <phil@netroedge.com>
7  * Copyright (C) 2003   Michiel Rook <michiel@grendelproject.nl>
8  * Copyright (C) 2005   Grant Coady <gcoady.lk@gmail.com> with valuable
9  *                              guidance from Jean Delvare
10  *
11  * Driver supports      Analog Devices          ADM9240
12  *                      Dallas Semiconductor    DS1780
13  *                      National Semiconductor  LM81
14  *
15  * ADM9240 is the reference, DS1780 and LM81 are register compatibles
16  *
17  * Voltage      Six inputs are scaled by chip, VID also reported
18  * Temperature  Chip temperature to 0.5'C, maximum and max_hysteris
19  * Fans         2 fans, low speed alarm, automatic fan clock divider
20  * Alarms       16-bit map of active alarms
21  * Analog Out   0..1250 mV output
22  *
23  * Chassis Intrusion: clear CI latch with 'echo 1 > chassis_clear'
24  *
25  * Test hardware: Intel SE440BX-2 desktop motherboard --Grant
26  *
27  * LM81 extended temp reading not implemented
28  *
29  * This program is free software; you can redistribute it and/or modify
30  * it under the terms of the GNU General Public License as published by
31  * the Free Software Foundation; either version 2 of the License, or
32  * (at your option) any later version.
33  *
34  * This program is distributed in the hope that it will be useful,
35  * but WITHOUT ANY WARRANTY; without even the implied warranty of
36  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
37  * GNU General Public License for more details.
38  *
39  * You should have received a copy of the GNU General Public License
40  * along with this program; if not, write to the Free Software
41  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
42  */
43
44 #include <linux/init.h>
45 #include <linux/module.h>
46 #include <linux/slab.h>
47 #include <linux/i2c.h>
48 #include <linux/hwmon-sysfs.h>
49 #include <linux/hwmon.h>
50 #include <linux/hwmon-vid.h>
51 #include <linux/err.h>
52 #include <linux/mutex.h>
53
54 /* Addresses to scan */
55 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, 0x2f,
56                                         I2C_CLIENT_END };
57
58 /* Insmod parameters */
59 I2C_CLIENT_INSMOD_3(adm9240, ds1780, lm81);
60
61 /* ADM9240 registers */
62 #define ADM9240_REG_MAN_ID              0x3e
63 #define ADM9240_REG_DIE_REV             0x3f
64 #define ADM9240_REG_CONFIG              0x40
65
66 #define ADM9240_REG_IN(nr)              (0x20 + (nr))   /* 0..5 */
67 #define ADM9240_REG_IN_MAX(nr)          (0x2b + (nr) * 2)
68 #define ADM9240_REG_IN_MIN(nr)          (0x2c + (nr) * 2)
69 #define ADM9240_REG_FAN(nr)             (0x28 + (nr))   /* 0..1 */
70 #define ADM9240_REG_FAN_MIN(nr)         (0x3b + (nr))
71 #define ADM9240_REG_INT(nr)             (0x41 + (nr))
72 #define ADM9240_REG_INT_MASK(nr)        (0x43 + (nr))
73 #define ADM9240_REG_TEMP                0x27
74 #define ADM9240_REG_TEMP_MAX(nr)        (0x39 + (nr)) /* 0, 1 = high, hyst */
75 #define ADM9240_REG_ANALOG_OUT          0x19
76 #define ADM9240_REG_CHASSIS_CLEAR       0x46
77 #define ADM9240_REG_VID_FAN_DIV         0x47
78 #define ADM9240_REG_I2C_ADDR            0x48
79 #define ADM9240_REG_VID4                0x49
80 #define ADM9240_REG_TEMP_CONF           0x4b
81
82 /* generalised scaling with integer rounding */
83 static inline int SCALE(long val, int mul, int div)
84 {
85         if (val < 0)
86                 return (val * mul - div / 2) / div;
87         else
88                 return (val * mul + div / 2) / div;
89 }
90
91 /* adm9240 internally scales voltage measurements */
92 static const u16 nom_mv[] = { 2500, 2700, 3300, 5000, 12000, 2700 };
93
94 static inline unsigned int IN_FROM_REG(u8 reg, int n)
95 {
96         return SCALE(reg, nom_mv[n], 192);
97 }
98
99 static inline u8 IN_TO_REG(unsigned long val, int n)
100 {
101         return SENSORS_LIMIT(SCALE(val, 192, nom_mv[n]), 0, 255);
102 }
103
104 /* temperature range: -40..125, 127 disables temperature alarm */
105 static inline s8 TEMP_TO_REG(long val)
106 {
107         return SENSORS_LIMIT(SCALE(val, 1, 1000), -40, 127);
108 }
109
110 /* two fans, each with low fan speed limit */
111 static inline unsigned int FAN_FROM_REG(u8 reg, u8 div)
112 {
113         if (!reg) /* error */
114                 return -1;
115
116         if (reg == 255)
117                 return 0;
118
119         return SCALE(1350000, 1, reg * div);
120 }
121
122 /* analog out 0..1250mV */
123 static inline u8 AOUT_TO_REG(unsigned long val)
124 {
125         return SENSORS_LIMIT(SCALE(val, 255, 1250), 0, 255);
126 }
127
128 static inline unsigned int AOUT_FROM_REG(u8 reg)
129 {
130         return SCALE(reg, 1250, 255);
131 }
132
133 static int adm9240_attach_adapter(struct i2c_adapter *adapter);
134 static int adm9240_detect(struct i2c_adapter *adapter, int address, int kind);
135 static void adm9240_init_client(struct i2c_client *client);
136 static int adm9240_detach_client(struct i2c_client *client);
137 static struct adm9240_data *adm9240_update_device(struct device *dev);
138
139 /* driver data */
140 static struct i2c_driver adm9240_driver = {
141         .driver = {
142                 .name   = "adm9240",
143         },
144         .id             = I2C_DRIVERID_ADM9240,
145         .attach_adapter = adm9240_attach_adapter,
146         .detach_client  = adm9240_detach_client,
147 };
148
149 /* per client data */
150 struct adm9240_data {
151         enum chips type;
152         struct i2c_client client;
153         struct class_device *class_dev;
154         struct mutex update_lock;
155         char valid;
156         unsigned long last_updated_measure;
157         unsigned long last_updated_config;
158
159         u8 in[6];               /* ro   in0_input */
160         u8 in_max[6];           /* rw   in0_max */
161         u8 in_min[6];           /* rw   in0_min */
162         u8 fan[2];              /* ro   fan1_input */
163         u8 fan_min[2];          /* rw   fan1_min */
164         u8 fan_div[2];          /* rw   fan1_div, read-only accessor */
165         s16 temp;               /* ro   temp1_input, 9-bit sign-extended */
166         s8 temp_max[2];         /* rw   0 -> temp_max, 1 -> temp_max_hyst */
167         u16 alarms;             /* ro   alarms */
168         u8 aout;                /* rw   aout_output */
169         u8 vid;                 /* ro   vid */
170         u8 vrm;                 /* --   vrm set on startup, no accessor */
171 };
172
173 /*** sysfs accessors ***/
174
175 /* temperature */
176 static ssize_t show_temp(struct device *dev, struct device_attribute *dummy,
177                 char *buf)
178 {
179         struct adm9240_data *data = adm9240_update_device(dev);
180         return sprintf(buf, "%d\n", data->temp * 500); /* 9-bit value */
181 }
182
183 static ssize_t show_max(struct device *dev, struct device_attribute *devattr,
184                 char *buf)
185 {
186         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
187         struct adm9240_data *data = adm9240_update_device(dev);
188         return sprintf(buf, "%d\n", data->temp_max[attr->index] * 1000);
189 }
190
191 static ssize_t set_max(struct device *dev, struct device_attribute *devattr,
192                 const char *buf, size_t count)
193 {
194         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
195         struct i2c_client *client = to_i2c_client(dev);
196         struct adm9240_data *data = i2c_get_clientdata(client);
197         long val = simple_strtol(buf, NULL, 10);
198
199         mutex_lock(&data->update_lock);
200         data->temp_max[attr->index] = TEMP_TO_REG(val);
201         i2c_smbus_write_byte_data(client, ADM9240_REG_TEMP_MAX(attr->index),
202                         data->temp_max[attr->index]);
203         mutex_unlock(&data->update_lock);
204         return count;
205 }
206
207 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
208 static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO,
209                 show_max, set_max, 0);
210 static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO,
211                 show_max, set_max, 1);
212
213 /* voltage */
214 static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
215                 char *buf)
216 {
217         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
218         struct adm9240_data *data = adm9240_update_device(dev);
219         return sprintf(buf, "%d\n", IN_FROM_REG(data->in[attr->index],
220                                 attr->index));
221 }
222
223 static ssize_t show_in_min(struct device *dev,
224                 struct device_attribute *devattr, char *buf)
225 {
226         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
227         struct adm9240_data *data = adm9240_update_device(dev);
228         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[attr->index],
229                                 attr->index));
230 }
231
232 static ssize_t show_in_max(struct device *dev,
233                 struct device_attribute *devattr, char *buf)
234 {
235         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
236         struct adm9240_data *data = adm9240_update_device(dev);
237         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[attr->index],
238                                 attr->index));
239 }
240
241 static ssize_t set_in_min(struct device *dev,
242                 struct device_attribute *devattr,
243                 const char *buf, size_t count)
244 {
245         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
246         struct i2c_client *client = to_i2c_client(dev);
247         struct adm9240_data *data = i2c_get_clientdata(client);
248         unsigned long val = simple_strtoul(buf, NULL, 10);
249
250         mutex_lock(&data->update_lock);
251         data->in_min[attr->index] = IN_TO_REG(val, attr->index);
252         i2c_smbus_write_byte_data(client, ADM9240_REG_IN_MIN(attr->index),
253                         data->in_min[attr->index]);
254         mutex_unlock(&data->update_lock);
255         return count;
256 }
257
258 static ssize_t set_in_max(struct device *dev,
259                 struct device_attribute *devattr,
260                 const char *buf, size_t count)
261 {
262         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
263         struct i2c_client *client = to_i2c_client(dev);
264         struct adm9240_data *data = i2c_get_clientdata(client);
265         unsigned long val = simple_strtoul(buf, NULL, 10);
266
267         mutex_lock(&data->update_lock);
268         data->in_max[attr->index] = IN_TO_REG(val, attr->index);
269         i2c_smbus_write_byte_data(client, ADM9240_REG_IN_MAX(attr->index),
270                         data->in_max[attr->index]);
271         mutex_unlock(&data->update_lock);
272         return count;
273 }
274
275 #define vin(nr)                                                 \
276 static SENSOR_DEVICE_ATTR(in##nr##_input, S_IRUGO,              \
277                 show_in, NULL, nr);                             \
278 static SENSOR_DEVICE_ATTR(in##nr##_min, S_IRUGO | S_IWUSR,      \
279                 show_in_min, set_in_min, nr);                   \
280 static SENSOR_DEVICE_ATTR(in##nr##_max, S_IRUGO | S_IWUSR,      \
281                 show_in_max, set_in_max, nr);
282
283 vin(0);
284 vin(1);
285 vin(2);
286 vin(3);
287 vin(4);
288 vin(5);
289
290 /* fans */
291 static ssize_t show_fan(struct device *dev,
292                 struct device_attribute *devattr, char *buf)
293 {
294         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
295         struct adm9240_data *data = adm9240_update_device(dev);
296         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[attr->index],
297                                 1 << data->fan_div[attr->index]));
298 }
299
300 static ssize_t show_fan_min(struct device *dev,
301                 struct device_attribute *devattr, char *buf)
302 {
303         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
304         struct adm9240_data *data = adm9240_update_device(dev);
305         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[attr->index],
306                                 1 << data->fan_div[attr->index]));
307 }
308
309 static ssize_t show_fan_div(struct device *dev,
310                 struct device_attribute *devattr, char *buf)
311 {
312         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
313         struct adm9240_data *data = adm9240_update_device(dev);
314         return sprintf(buf, "%d\n", 1 << data->fan_div[attr->index]);
315 }
316
317 /* write new fan div, callers must hold data->update_lock */
318 static void adm9240_write_fan_div(struct i2c_client *client, int nr,
319                 u8 fan_div)
320 {
321         u8 reg, old, shift = (nr + 2) * 2;
322
323         reg = i2c_smbus_read_byte_data(client, ADM9240_REG_VID_FAN_DIV);
324         old = (reg >> shift) & 3;
325         reg &= ~(3 << shift);
326         reg |= (fan_div << shift);
327         i2c_smbus_write_byte_data(client, ADM9240_REG_VID_FAN_DIV, reg);
328         dev_dbg(&client->dev, "fan%d clock divider changed from %u "
329                         "to %u\n", nr + 1, 1 << old, 1 << fan_div);
330 }
331
332 /*
333  * set fan speed low limit:
334  *
335  * - value is zero: disable fan speed low limit alarm
336  *
337  * - value is below fan speed measurement range: enable fan speed low
338  *   limit alarm to be asserted while fan speed too slow to measure
339  *
340  * - otherwise: select fan clock divider to suit fan speed low limit,
341  *   measurement code may adjust registers to ensure fan speed reading
342  */
343 static ssize_t set_fan_min(struct device *dev,
344                 struct device_attribute *devattr,
345                 const char *buf, size_t count)
346 {
347         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
348         struct i2c_client *client = to_i2c_client(dev);
349         struct adm9240_data *data = i2c_get_clientdata(client);
350         unsigned long val = simple_strtoul(buf, NULL, 10);
351         int nr = attr->index;
352         u8 new_div;
353
354         mutex_lock(&data->update_lock);
355
356         if (!val) {
357                 data->fan_min[nr] = 255;
358                 new_div = data->fan_div[nr];
359
360                 dev_dbg(&client->dev, "fan%u low limit set disabled\n",
361                                 nr + 1);
362
363         } else if (val < 1350000 / (8 * 254)) {
364                 new_div = 3;
365                 data->fan_min[nr] = 254;
366
367                 dev_dbg(&client->dev, "fan%u low limit set minimum %u\n",
368                                 nr + 1, FAN_FROM_REG(254, 1 << new_div));
369
370         } else {
371                 unsigned int new_min = 1350000 / val;
372
373                 new_div = 0;
374                 while (new_min > 192 && new_div < 3) {
375                         new_div++;
376                         new_min /= 2;
377                 }
378                 if (!new_min) /* keep > 0 */
379                         new_min++;
380
381                 data->fan_min[nr] = new_min;
382
383                 dev_dbg(&client->dev, "fan%u low limit set fan speed %u\n",
384                                 nr + 1, FAN_FROM_REG(new_min, 1 << new_div));
385         }
386
387         if (new_div != data->fan_div[nr]) {
388                 data->fan_div[nr] = new_div;
389                 adm9240_write_fan_div(client, nr, new_div);
390         }
391         i2c_smbus_write_byte_data(client, ADM9240_REG_FAN_MIN(nr),
392                         data->fan_min[nr]);
393
394         mutex_unlock(&data->update_lock);
395         return count;
396 }
397
398 #define fan(nr)                                                 \
399 static SENSOR_DEVICE_ATTR(fan##nr##_input, S_IRUGO,             \
400                 show_fan, NULL, nr - 1);                        \
401 static SENSOR_DEVICE_ATTR(fan##nr##_div, S_IRUGO,               \
402                 show_fan_div, NULL, nr - 1);                    \
403 static SENSOR_DEVICE_ATTR(fan##nr##_min, S_IRUGO | S_IWUSR,     \
404                 show_fan_min, set_fan_min, nr - 1);
405
406 fan(1);
407 fan(2);
408
409 /* alarms */
410 static ssize_t show_alarms(struct device *dev,
411                 struct device_attribute *attr, char *buf)
412 {
413         struct adm9240_data *data = adm9240_update_device(dev);
414         return sprintf(buf, "%u\n", data->alarms);
415 }
416 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
417
418 /* vid */
419 static ssize_t show_vid(struct device *dev,
420                 struct device_attribute *attr, char *buf)
421 {
422         struct adm9240_data *data = adm9240_update_device(dev);
423         return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
424 }
425 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
426
427 /* analog output */
428 static ssize_t show_aout(struct device *dev,
429                 struct device_attribute *attr, char *buf)
430 {
431         struct adm9240_data *data = adm9240_update_device(dev);
432         return sprintf(buf, "%d\n", AOUT_FROM_REG(data->aout));
433 }
434
435 static ssize_t set_aout(struct device *dev,
436                 struct device_attribute *attr,
437                 const char *buf, size_t count)
438 {
439         struct i2c_client *client = to_i2c_client(dev);
440         struct adm9240_data *data = i2c_get_clientdata(client);
441         unsigned long val = simple_strtol(buf, NULL, 10);
442
443         mutex_lock(&data->update_lock);
444         data->aout = AOUT_TO_REG(val);
445         i2c_smbus_write_byte_data(client, ADM9240_REG_ANALOG_OUT, data->aout);
446         mutex_unlock(&data->update_lock);
447         return count;
448 }
449 static DEVICE_ATTR(aout_output, S_IRUGO | S_IWUSR, show_aout, set_aout);
450
451 /* chassis_clear */
452 static ssize_t chassis_clear(struct device *dev,
453                 struct device_attribute *attr,
454                 const char *buf, size_t count)
455 {
456         struct i2c_client *client = to_i2c_client(dev);
457         unsigned long val = simple_strtol(buf, NULL, 10);
458
459         if (val == 1) {
460                 i2c_smbus_write_byte_data(client,
461                                 ADM9240_REG_CHASSIS_CLEAR, 0x80);
462                 dev_dbg(&client->dev, "chassis intrusion latch cleared\n");
463         }
464         return count;
465 }
466 static DEVICE_ATTR(chassis_clear, S_IWUSR, NULL, chassis_clear);
467
468 static struct attribute *adm9240_attributes[] = {
469         &sensor_dev_attr_in0_input.dev_attr.attr,
470         &sensor_dev_attr_in0_min.dev_attr.attr,
471         &sensor_dev_attr_in0_max.dev_attr.attr,
472         &sensor_dev_attr_in1_input.dev_attr.attr,
473         &sensor_dev_attr_in1_min.dev_attr.attr,
474         &sensor_dev_attr_in1_max.dev_attr.attr,
475         &sensor_dev_attr_in2_input.dev_attr.attr,
476         &sensor_dev_attr_in2_min.dev_attr.attr,
477         &sensor_dev_attr_in2_max.dev_attr.attr,
478         &sensor_dev_attr_in3_input.dev_attr.attr,
479         &sensor_dev_attr_in3_min.dev_attr.attr,
480         &sensor_dev_attr_in3_max.dev_attr.attr,
481         &sensor_dev_attr_in4_input.dev_attr.attr,
482         &sensor_dev_attr_in4_min.dev_attr.attr,
483         &sensor_dev_attr_in4_max.dev_attr.attr,
484         &sensor_dev_attr_in5_input.dev_attr.attr,
485         &sensor_dev_attr_in5_min.dev_attr.attr,
486         &sensor_dev_attr_in5_max.dev_attr.attr,
487         &dev_attr_temp1_input.attr,
488         &sensor_dev_attr_temp1_max.dev_attr.attr,
489         &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
490         &sensor_dev_attr_fan1_input.dev_attr.attr,
491         &sensor_dev_attr_fan1_div.dev_attr.attr,
492         &sensor_dev_attr_fan1_min.dev_attr.attr,
493         &sensor_dev_attr_fan2_input.dev_attr.attr,
494         &sensor_dev_attr_fan2_div.dev_attr.attr,
495         &sensor_dev_attr_fan2_min.dev_attr.attr,
496         &dev_attr_alarms.attr,
497         &dev_attr_aout_output.attr,
498         &dev_attr_chassis_clear.attr,
499         &dev_attr_cpu0_vid.attr,
500         NULL
501 };
502
503 static const struct attribute_group adm9240_group = {
504         .attrs = adm9240_attributes,
505 };
506
507
508 /*** sensor chip detect and driver install ***/
509
510 static int adm9240_detect(struct i2c_adapter *adapter, int address, int kind)
511 {
512         struct i2c_client *new_client;
513         struct adm9240_data *data;
514         int err = 0;
515         const char *name = "";
516         u8 man_id, die_rev;
517
518         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
519                 goto exit;
520
521         if (!(data = kzalloc(sizeof(*data), GFP_KERNEL))) {
522                 err = -ENOMEM;
523                 goto exit;
524         }
525
526         new_client = &data->client;
527         i2c_set_clientdata(new_client, data);
528         new_client->addr = address;
529         new_client->adapter = adapter;
530         new_client->driver = &adm9240_driver;
531         new_client->flags = 0;
532
533         if (kind == 0) {
534                 kind = adm9240;
535         }
536
537         if (kind < 0) {
538
539                 /* verify chip: reg address should match i2c address */
540                 if (i2c_smbus_read_byte_data(new_client, ADM9240_REG_I2C_ADDR)
541                                 != address) {
542                         dev_err(&adapter->dev, "detect fail: address match, "
543                                         "0x%02x\n", address);
544                         goto exit_free;
545                 }
546
547                 /* check known chip manufacturer */
548                 man_id = i2c_smbus_read_byte_data(new_client,
549                                 ADM9240_REG_MAN_ID);
550                 if (man_id == 0x23) {
551                         kind = adm9240;
552                 } else if (man_id == 0xda) {
553                         kind = ds1780;
554                 } else if (man_id == 0x01) {
555                         kind = lm81;
556                 } else {
557                         dev_err(&adapter->dev, "detect fail: unknown manuf, "
558                                         "0x%02x\n", man_id);
559                         goto exit_free;
560                 }
561
562                 /* successful detect, print chip info */
563                 die_rev = i2c_smbus_read_byte_data(new_client,
564                                 ADM9240_REG_DIE_REV);
565                 dev_info(&adapter->dev, "found %s revision %u\n",
566                                 man_id == 0x23 ? "ADM9240" :
567                                 man_id == 0xda ? "DS1780" : "LM81", die_rev);
568         }
569
570         /* either forced or detected chip kind */
571         if (kind == adm9240) {
572                 name = "adm9240";
573         } else if (kind == ds1780) {
574                 name = "ds1780";
575         } else if (kind == lm81) {
576                 name = "lm81";
577         }
578
579         /* fill in the remaining client fields and attach */
580         strlcpy(new_client->name, name, I2C_NAME_SIZE);
581         data->type = kind;
582         mutex_init(&data->update_lock);
583
584         if ((err = i2c_attach_client(new_client)))
585                 goto exit_free;
586
587         adm9240_init_client(new_client);
588
589         /* populate sysfs filesystem */
590         if ((err = sysfs_create_group(&new_client->dev.kobj, &adm9240_group)))
591                 goto exit_detach;
592
593         data->class_dev = hwmon_device_register(&new_client->dev);
594         if (IS_ERR(data->class_dev)) {
595                 err = PTR_ERR(data->class_dev);
596                 goto exit_remove;
597         }
598
599         return 0;
600
601 exit_remove:
602         sysfs_remove_group(&new_client->dev.kobj, &adm9240_group);
603 exit_detach:
604         i2c_detach_client(new_client);
605 exit_free:
606         kfree(data);
607 exit:
608         return err;
609 }
610
611 static int adm9240_attach_adapter(struct i2c_adapter *adapter)
612 {
613         if (!(adapter->class & I2C_CLASS_HWMON))
614                 return 0;
615         return i2c_probe(adapter, &addr_data, adm9240_detect);
616 }
617
618 static int adm9240_detach_client(struct i2c_client *client)
619 {
620         struct adm9240_data *data = i2c_get_clientdata(client);
621         int err;
622
623         hwmon_device_unregister(data->class_dev);
624         sysfs_remove_group(&client->dev.kobj, &adm9240_group);
625
626         if ((err = i2c_detach_client(client)))
627                 return err;
628
629         kfree(data);
630         return 0;
631 }
632
633 static void adm9240_init_client(struct i2c_client *client)
634 {
635         struct adm9240_data *data = i2c_get_clientdata(client);
636         u8 conf = i2c_smbus_read_byte_data(client, ADM9240_REG_CONFIG);
637         u8 mode = i2c_smbus_read_byte_data(client, ADM9240_REG_TEMP_CONF) & 3;
638
639         data->vrm = vid_which_vrm(); /* need this to report vid as mV */
640
641         dev_info(&client->dev, "Using VRM: %d.%d\n", data->vrm / 10,
642                         data->vrm % 10);
643
644         if (conf & 1) { /* measurement cycle running: report state */
645
646                 dev_info(&client->dev, "status: config 0x%02x mode %u\n",
647                                 conf, mode);
648
649         } else { /* cold start: open limits before starting chip */
650                 int i;
651
652                 for (i = 0; i < 6; i++)
653                 {
654                         i2c_smbus_write_byte_data(client,
655                                         ADM9240_REG_IN_MIN(i), 0);
656                         i2c_smbus_write_byte_data(client,
657                                         ADM9240_REG_IN_MAX(i), 255);
658                 }
659                 i2c_smbus_write_byte_data(client,
660                                 ADM9240_REG_FAN_MIN(0), 255);
661                 i2c_smbus_write_byte_data(client,
662                                 ADM9240_REG_FAN_MIN(1), 255);
663                 i2c_smbus_write_byte_data(client,
664                                 ADM9240_REG_TEMP_MAX(0), 127);
665                 i2c_smbus_write_byte_data(client,
666                                 ADM9240_REG_TEMP_MAX(1), 127);
667
668                 /* start measurement cycle */
669                 i2c_smbus_write_byte_data(client, ADM9240_REG_CONFIG, 1);
670
671                 dev_info(&client->dev, "cold start: config was 0x%02x "
672                                 "mode %u\n", conf, mode);
673         }
674 }
675
676 static struct adm9240_data *adm9240_update_device(struct device *dev)
677 {
678         struct i2c_client *client = to_i2c_client(dev);
679         struct adm9240_data *data = i2c_get_clientdata(client);
680         int i;
681
682         mutex_lock(&data->update_lock);
683
684         /* minimum measurement cycle: 1.75 seconds */
685         if (time_after(jiffies, data->last_updated_measure + (HZ * 7 / 4))
686                         || !data->valid) {
687
688                 for (i = 0; i < 6; i++) /* read voltages */
689                 {
690                         data->in[i] = i2c_smbus_read_byte_data(client,
691                                         ADM9240_REG_IN(i));
692                 }
693                 data->alarms = i2c_smbus_read_byte_data(client,
694                                         ADM9240_REG_INT(0)) |
695                                         i2c_smbus_read_byte_data(client,
696                                         ADM9240_REG_INT(1)) << 8;
697
698                 /* read temperature: assume temperature changes less than
699                  * 0.5'C per two measurement cycles thus ignore possible
700                  * but unlikely aliasing error on lsb reading. --Grant */
701                 data->temp = ((i2c_smbus_read_byte_data(client,
702                                         ADM9240_REG_TEMP) << 8) |
703                                         i2c_smbus_read_byte_data(client,
704                                         ADM9240_REG_TEMP_CONF)) / 128;
705
706                 for (i = 0; i < 2; i++) /* read fans */
707                 {
708                         data->fan[i] = i2c_smbus_read_byte_data(client,
709                                         ADM9240_REG_FAN(i));
710
711                         /* adjust fan clock divider on overflow */
712                         if (data->valid && data->fan[i] == 255 &&
713                                         data->fan_div[i] < 3) {
714
715                                 adm9240_write_fan_div(client, i,
716                                                 ++data->fan_div[i]);
717
718                                 /* adjust fan_min if active, but not to 0 */
719                                 if (data->fan_min[i] < 255 &&
720                                                 data->fan_min[i] >= 2)
721                                         data->fan_min[i] /= 2;
722                         }
723                 }
724                 data->last_updated_measure = jiffies;
725         }
726
727         /* minimum config reading cycle: 300 seconds */
728         if (time_after(jiffies, data->last_updated_config + (HZ * 300))
729                         || !data->valid) {
730
731                 for (i = 0; i < 6; i++)
732                 {
733                         data->in_min[i] = i2c_smbus_read_byte_data(client,
734                                         ADM9240_REG_IN_MIN(i));
735                         data->in_max[i] = i2c_smbus_read_byte_data(client,
736                                         ADM9240_REG_IN_MAX(i));
737                 }
738                 for (i = 0; i < 2; i++)
739                 {
740                         data->fan_min[i] = i2c_smbus_read_byte_data(client,
741                                         ADM9240_REG_FAN_MIN(i));
742                 }
743                 data->temp_max[0] = i2c_smbus_read_byte_data(client,
744                                 ADM9240_REG_TEMP_MAX(0));
745                 data->temp_max[1] = i2c_smbus_read_byte_data(client,
746                                 ADM9240_REG_TEMP_MAX(1));
747
748                 /* read fan divs and 5-bit VID */
749                 i = i2c_smbus_read_byte_data(client, ADM9240_REG_VID_FAN_DIV);
750                 data->fan_div[0] = (i >> 4) & 3;
751                 data->fan_div[1] = (i >> 6) & 3;
752                 data->vid = i & 0x0f;
753                 data->vid |= (i2c_smbus_read_byte_data(client,
754                                         ADM9240_REG_VID4) & 1) << 4;
755                 /* read analog out */
756                 data->aout = i2c_smbus_read_byte_data(client,
757                                 ADM9240_REG_ANALOG_OUT);
758
759                 data->last_updated_config = jiffies;
760                 data->valid = 1;
761         }
762         mutex_unlock(&data->update_lock);
763         return data;
764 }
765
766 static int __init sensors_adm9240_init(void)
767 {
768         return i2c_add_driver(&adm9240_driver);
769 }
770
771 static void __exit sensors_adm9240_exit(void)
772 {
773         i2c_del_driver(&adm9240_driver);
774 }
775
776 MODULE_AUTHOR("Michiel Rook <michiel@grendelproject.nl>, "
777                 "Grant Coady <gcoady.lk@gmail.com> and others");
778 MODULE_DESCRIPTION("ADM9240/DS1780/LM81 driver");
779 MODULE_LICENSE("GPL");
780
781 module_init(sensors_adm9240_init);
782 module_exit(sensors_adm9240_exit);
783