firewire: fw-sbp2: fix refcounting
[linux-2.6] / drivers / hwmon / adt7470.c
1 /*
2  * A hwmon driver for the Analog Devices ADT7470
3  * Copyright (C) 2007 IBM
4  *
5  * Author: Darrick J. Wong <djwong@us.ibm.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20  */
21
22 #include <linux/module.h>
23 #include <linux/jiffies.h>
24 #include <linux/i2c.h>
25 #include <linux/hwmon.h>
26 #include <linux/hwmon-sysfs.h>
27 #include <linux/err.h>
28 #include <linux/mutex.h>
29 #include <linux/delay.h>
30 #include <linux/log2.h>
31
32 /* Addresses to scan */
33 static unsigned short normal_i2c[] = { 0x2C, 0x2E, 0x2F, I2C_CLIENT_END };
34
35 /* Insmod parameters */
36 I2C_CLIENT_INSMOD_1(adt7470);
37
38 /* ADT7470 registers */
39 #define ADT7470_REG_BASE_ADDR                   0x20
40 #define ADT7470_REG_TEMP_BASE_ADDR              0x20
41 #define ADT7470_REG_TEMP_MAX_ADDR               0x29
42 #define ADT7470_REG_FAN_BASE_ADDR               0x2A
43 #define ADT7470_REG_FAN_MAX_ADDR                0x31
44 #define ADT7470_REG_PWM_BASE_ADDR               0x32
45 #define ADT7470_REG_PWM_MAX_ADDR                0x35
46 #define ADT7470_REG_PWM_MAX_BASE_ADDR           0x38
47 #define ADT7470_REG_PWM_MAX_MAX_ADDR            0x3B
48 #define ADT7470_REG_CFG                         0x40
49 #define         ADT7470_FSPD_MASK               0x04
50 #define ADT7470_REG_ALARM1                      0x41
51 #define ADT7470_REG_ALARM2                      0x42
52 #define ADT7470_REG_TEMP_LIMITS_BASE_ADDR       0x44
53 #define ADT7470_REG_TEMP_LIMITS_MAX_ADDR        0x57
54 #define ADT7470_REG_FAN_MIN_BASE_ADDR           0x58
55 #define ADT7470_REG_FAN_MIN_MAX_ADDR            0x5F
56 #define ADT7470_REG_FAN_MAX_BASE_ADDR           0x60
57 #define ADT7470_REG_FAN_MAX_MAX_ADDR            0x67
58 #define ADT7470_REG_PWM_CFG_BASE_ADDR           0x68
59 #define ADT7470_REG_PWM12_CFG                   0x68
60 #define         ADT7470_PWM2_AUTO_MASK          0x40
61 #define         ADT7470_PWM1_AUTO_MASK          0x80
62 #define ADT7470_REG_PWM34_CFG                   0x69
63 #define         ADT7470_PWM3_AUTO_MASK          0x40
64 #define         ADT7470_PWM4_AUTO_MASK          0x80
65 #define ADT7470_REG_PWM_MIN_BASE_ADDR           0x6A
66 #define ADT7470_REG_PWM_MIN_MAX_ADDR            0x6D
67 #define ADT7470_REG_PWM_TEMP_MIN_BASE_ADDR      0x6E
68 #define ADT7470_REG_PWM_TEMP_MIN_MAX_ADDR       0x71
69 #define ADT7470_REG_ACOUSTICS12                 0x75
70 #define ADT7470_REG_ACOUSTICS34                 0x76
71 #define ADT7470_REG_DEVICE                      0x3D
72 #define ADT7470_REG_VENDOR                      0x3E
73 #define ADT7470_REG_REVISION                    0x3F
74 #define ADT7470_REG_ALARM1_MASK                 0x72
75 #define ADT7470_REG_ALARM2_MASK                 0x73
76 #define ADT7470_REG_PWM_AUTO_TEMP_BASE_ADDR     0x7C
77 #define ADT7470_REG_PWM_AUTO_TEMP_MAX_ADDR      0x7D
78 #define ADT7470_REG_MAX_ADDR                    0x81
79
80 #define ADT7470_TEMP_COUNT      10
81 #define ADT7470_TEMP_REG(x)     (ADT7470_REG_TEMP_BASE_ADDR + (x))
82 #define ADT7470_TEMP_MIN_REG(x) (ADT7470_REG_TEMP_LIMITS_BASE_ADDR + ((x) * 2))
83 #define ADT7470_TEMP_MAX_REG(x) (ADT7470_REG_TEMP_LIMITS_BASE_ADDR + \
84                                 ((x) * 2) + 1)
85
86 #define ADT7470_FAN_COUNT       4
87 #define ADT7470_REG_FAN(x)      (ADT7470_REG_FAN_BASE_ADDR + ((x) * 2))
88 #define ADT7470_REG_FAN_MIN(x)  (ADT7470_REG_FAN_MIN_BASE_ADDR + ((x) * 2))
89 #define ADT7470_REG_FAN_MAX(x)  (ADT7470_REG_FAN_MAX_BASE_ADDR + ((x) * 2))
90
91 #define ADT7470_PWM_COUNT       4
92 #define ADT7470_REG_PWM(x)      (ADT7470_REG_PWM_BASE_ADDR + (x))
93 #define ADT7470_REG_PWM_MAX(x)  (ADT7470_REG_PWM_MAX_BASE_ADDR + (x))
94 #define ADT7470_REG_PWM_MIN(x)  (ADT7470_REG_PWM_MIN_BASE_ADDR + (x))
95 #define ADT7470_REG_PWM_TMIN(x) (ADT7470_REG_PWM_TEMP_MIN_BASE_ADDR + (x))
96 #define ADT7470_REG_PWM_CFG(x)  (ADT7470_REG_PWM_CFG_BASE_ADDR + ((x) / 2))
97 #define ADT7470_REG_PWM_AUTO_TEMP(x)    (ADT7470_REG_PWM_AUTO_TEMP_BASE_ADDR + \
98                                         ((x) / 2))
99
100 #define ADT7470_VENDOR          0x41
101 #define ADT7470_DEVICE          0x70
102 /* datasheet only mentions a revision 2 */
103 #define ADT7470_REVISION        0x02
104
105 /* "all temps" according to hwmon sysfs interface spec */
106 #define ADT7470_PWM_ALL_TEMPS   0x3FF
107
108 /* How often do we reread sensors values? (In jiffies) */
109 #define SENSOR_REFRESH_INTERVAL (5 * HZ)
110
111 /* How often do we reread sensor limit values? (In jiffies) */
112 #define LIMIT_REFRESH_INTERVAL  (60 * HZ)
113
114 /* sleep 1s while gathering temperature data */
115 #define TEMP_COLLECTION_TIME    1000
116
117 #define power_of_2(x)   (((x) & ((x) - 1)) == 0)
118
119 /* datasheet says to divide this number by the fan reading to get fan rpm */
120 #define FAN_PERIOD_TO_RPM(x)    ((90000 * 60) / (x))
121 #define FAN_RPM_TO_PERIOD       FAN_PERIOD_TO_RPM
122 #define FAN_PERIOD_INVALID      65535
123 #define FAN_DATA_VALID(x)       ((x) && (x) != FAN_PERIOD_INVALID)
124
125 struct adt7470_data {
126         struct i2c_client       client;
127         struct device           *hwmon_dev;
128         struct attribute_group  attrs;
129         struct mutex            lock;
130         char                    sensors_valid;
131         char                    limits_valid;
132         unsigned long           sensors_last_updated;   /* In jiffies */
133         unsigned long           limits_last_updated;    /* In jiffies */
134
135         s8                      temp[ADT7470_TEMP_COUNT];
136         s8                      temp_min[ADT7470_TEMP_COUNT];
137         s8                      temp_max[ADT7470_TEMP_COUNT];
138         u16                     fan[ADT7470_FAN_COUNT];
139         u16                     fan_min[ADT7470_FAN_COUNT];
140         u16                     fan_max[ADT7470_FAN_COUNT];
141         u16                     alarms, alarms_mask;
142         u8                      force_pwm_max;
143         u8                      pwm[ADT7470_PWM_COUNT];
144         u8                      pwm_max[ADT7470_PWM_COUNT];
145         u8                      pwm_automatic[ADT7470_PWM_COUNT];
146         u8                      pwm_min[ADT7470_PWM_COUNT];
147         s8                      pwm_tmin[ADT7470_PWM_COUNT];
148         u8                      pwm_auto_temp[ADT7470_PWM_COUNT];
149 };
150
151 static int adt7470_attach_adapter(struct i2c_adapter *adapter);
152 static int adt7470_detect(struct i2c_adapter *adapter, int address, int kind);
153 static int adt7470_detach_client(struct i2c_client *client);
154
155 static struct i2c_driver adt7470_driver = {
156         .driver = {
157                 .name   = "adt7470",
158         },
159         .attach_adapter = adt7470_attach_adapter,
160         .detach_client  = adt7470_detach_client,
161 };
162
163 /*
164  * 16-bit registers on the ADT7470 are low-byte first.  The data sheet says
165  * that the low byte must be read before the high byte.
166  */
167 static inline int adt7470_read_word_data(struct i2c_client *client, u8 reg)
168 {
169         u16 foo;
170         foo = i2c_smbus_read_byte_data(client, reg);
171         foo |= ((u16)i2c_smbus_read_byte_data(client, reg + 1) << 8);
172         return foo;
173 }
174
175 static inline int adt7470_write_word_data(struct i2c_client *client, u8 reg,
176                                           u16 value)
177 {
178         return i2c_smbus_write_byte_data(client, reg, value & 0xFF)
179                && i2c_smbus_write_byte_data(client, reg + 1, value >> 8);
180 }
181
182 static void adt7470_init_client(struct i2c_client *client)
183 {
184         int reg = i2c_smbus_read_byte_data(client, ADT7470_REG_CFG);
185
186         if (reg < 0) {
187                 dev_err(&client->dev, "cannot read configuration register\n");
188         } else {
189                 /* start monitoring (and do a self-test) */
190                 i2c_smbus_write_byte_data(client, ADT7470_REG_CFG, reg | 3);
191         }
192 }
193
194 static struct adt7470_data *adt7470_update_device(struct device *dev)
195 {
196         struct i2c_client *client = to_i2c_client(dev);
197         struct adt7470_data *data = i2c_get_clientdata(client);
198         unsigned long local_jiffies = jiffies;
199         u8 cfg;
200         int i;
201
202         mutex_lock(&data->lock);
203         if (time_before(local_jiffies, data->sensors_last_updated +
204                 SENSOR_REFRESH_INTERVAL)
205                 && data->sensors_valid)
206                 goto no_sensor_update;
207
208         /* start reading temperature sensors */
209         cfg = i2c_smbus_read_byte_data(client, ADT7470_REG_CFG);
210         cfg |= 0x80;
211         i2c_smbus_write_byte_data(client, ADT7470_REG_CFG, cfg);
212
213         /*
214          * Delay is 200ms * number of tmp05 sensors.  Too bad
215          * there's no way to figure out how many are connected.
216          * For now, assume 1s will work.
217          */
218         msleep(TEMP_COLLECTION_TIME);
219
220         /* done reading temperature sensors */
221         cfg = i2c_smbus_read_byte_data(client, ADT7470_REG_CFG);
222         cfg &= ~0x80;
223         i2c_smbus_write_byte_data(client, ADT7470_REG_CFG, cfg);
224
225         for (i = 0; i < ADT7470_TEMP_COUNT; i++)
226                 data->temp[i] = i2c_smbus_read_byte_data(client,
227                                                 ADT7470_TEMP_REG(i));
228
229         for (i = 0; i < ADT7470_FAN_COUNT; i++)
230                 data->fan[i] = adt7470_read_word_data(client,
231                                                 ADT7470_REG_FAN(i));
232
233         for (i = 0; i < ADT7470_PWM_COUNT; i++) {
234                 int reg;
235                 int reg_mask;
236
237                 data->pwm[i] = i2c_smbus_read_byte_data(client,
238                                                 ADT7470_REG_PWM(i));
239
240                 if (i % 2)
241                         reg_mask = ADT7470_PWM2_AUTO_MASK;
242                 else
243                         reg_mask = ADT7470_PWM1_AUTO_MASK;
244
245                 reg = ADT7470_REG_PWM_CFG(i);
246                 if (i2c_smbus_read_byte_data(client, reg) & reg_mask)
247                         data->pwm_automatic[i] = 1;
248                 else
249                         data->pwm_automatic[i] = 0;
250
251                 reg = ADT7470_REG_PWM_AUTO_TEMP(i);
252                 cfg = i2c_smbus_read_byte_data(client, reg);
253                 if (!(i % 2))
254                         data->pwm_auto_temp[i] = cfg >> 4;
255                 else
256                         data->pwm_auto_temp[i] = cfg & 0xF;
257         }
258
259         if (i2c_smbus_read_byte_data(client, ADT7470_REG_CFG) &
260             ADT7470_FSPD_MASK)
261                 data->force_pwm_max = 1;
262         else
263                 data->force_pwm_max = 0;
264
265         data->alarms = adt7470_read_word_data(client, ADT7470_REG_ALARM1);
266         data->alarms_mask = adt7470_read_word_data(client,
267                                                    ADT7470_REG_ALARM1_MASK);
268
269         data->sensors_last_updated = local_jiffies;
270         data->sensors_valid = 1;
271
272 no_sensor_update:
273         if (time_before(local_jiffies, data->limits_last_updated +
274                 LIMIT_REFRESH_INTERVAL)
275                 && data->limits_valid)
276                 goto out;
277
278         for (i = 0; i < ADT7470_TEMP_COUNT; i++) {
279                 data->temp_min[i] = i2c_smbus_read_byte_data(client,
280                                                 ADT7470_TEMP_MIN_REG(i));
281                 data->temp_max[i] = i2c_smbus_read_byte_data(client,
282                                                 ADT7470_TEMP_MAX_REG(i));
283         }
284
285         for (i = 0; i < ADT7470_FAN_COUNT; i++) {
286                 data->fan_min[i] = adt7470_read_word_data(client,
287                                                 ADT7470_REG_FAN_MIN(i));
288                 data->fan_max[i] = adt7470_read_word_data(client,
289                                                 ADT7470_REG_FAN_MAX(i));
290         }
291
292         for (i = 0; i < ADT7470_PWM_COUNT; i++) {
293                 data->pwm_max[i] = i2c_smbus_read_byte_data(client,
294                                                 ADT7470_REG_PWM_MAX(i));
295                 data->pwm_min[i] = i2c_smbus_read_byte_data(client,
296                                                 ADT7470_REG_PWM_MIN(i));
297                 data->pwm_tmin[i] = i2c_smbus_read_byte_data(client,
298                                                 ADT7470_REG_PWM_TMIN(i));
299         }
300
301         data->limits_last_updated = local_jiffies;
302         data->limits_valid = 1;
303
304 out:
305         mutex_unlock(&data->lock);
306         return data;
307 }
308
309 static ssize_t show_temp_min(struct device *dev,
310                              struct device_attribute *devattr,
311                              char *buf)
312 {
313         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
314         struct adt7470_data *data = adt7470_update_device(dev);
315         return sprintf(buf, "%d\n", 1000 * data->temp_min[attr->index]);
316 }
317
318 static ssize_t set_temp_min(struct device *dev,
319                             struct device_attribute *devattr,
320                             const char *buf,
321                             size_t count)
322 {
323         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
324         struct i2c_client *client = to_i2c_client(dev);
325         struct adt7470_data *data = i2c_get_clientdata(client);
326         int temp = simple_strtol(buf, NULL, 10) / 1000;
327
328         mutex_lock(&data->lock);
329         data->temp_min[attr->index] = temp;
330         i2c_smbus_write_byte_data(client, ADT7470_TEMP_MIN_REG(attr->index),
331                                   temp);
332         mutex_unlock(&data->lock);
333
334         return count;
335 }
336
337 static ssize_t show_temp_max(struct device *dev,
338                              struct device_attribute *devattr,
339                              char *buf)
340 {
341         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
342         struct adt7470_data *data = adt7470_update_device(dev);
343         return sprintf(buf, "%d\n", 1000 * data->temp_max[attr->index]);
344 }
345
346 static ssize_t set_temp_max(struct device *dev,
347                             struct device_attribute *devattr,
348                             const char *buf,
349                             size_t count)
350 {
351         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
352         struct i2c_client *client = to_i2c_client(dev);
353         struct adt7470_data *data = i2c_get_clientdata(client);
354         int temp = simple_strtol(buf, NULL, 10) / 1000;
355
356         mutex_lock(&data->lock);
357         data->temp_max[attr->index] = temp;
358         i2c_smbus_write_byte_data(client, ADT7470_TEMP_MAX_REG(attr->index),
359                                   temp);
360         mutex_unlock(&data->lock);
361
362         return count;
363 }
364
365 static ssize_t show_temp(struct device *dev, struct device_attribute *devattr,
366                          char *buf)
367 {
368         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
369         struct adt7470_data *data = adt7470_update_device(dev);
370         return sprintf(buf, "%d\n", 1000 * data->temp[attr->index]);
371 }
372
373 static ssize_t show_alarms(struct device *dev,
374                            struct device_attribute *devattr,
375                            char *buf)
376 {
377         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
378         struct adt7470_data *data = adt7470_update_device(dev);
379
380         if (attr->index)
381                 return sprintf(buf, "%x\n", data->alarms);
382         else
383                 return sprintf(buf, "%x\n", data->alarms_mask);
384 }
385
386 static ssize_t show_fan_max(struct device *dev,
387                             struct device_attribute *devattr,
388                             char *buf)
389 {
390         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
391         struct adt7470_data *data = adt7470_update_device(dev);
392
393         if (FAN_DATA_VALID(data->fan_max[attr->index]))
394                 return sprintf(buf, "%d\n",
395                                FAN_PERIOD_TO_RPM(data->fan_max[attr->index]));
396         else
397                 return sprintf(buf, "0\n");
398 }
399
400 static ssize_t set_fan_max(struct device *dev,
401                            struct device_attribute *devattr,
402                            const char *buf, size_t count)
403 {
404         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
405         struct i2c_client *client = to_i2c_client(dev);
406         struct adt7470_data *data = i2c_get_clientdata(client);
407         int temp = simple_strtol(buf, NULL, 10);
408
409         if (!temp)
410                 return -EINVAL;
411         temp = FAN_RPM_TO_PERIOD(temp);
412
413         mutex_lock(&data->lock);
414         data->fan_max[attr->index] = temp;
415         adt7470_write_word_data(client, ADT7470_REG_FAN_MAX(attr->index), temp);
416         mutex_unlock(&data->lock);
417
418         return count;
419 }
420
421 static ssize_t show_fan_min(struct device *dev,
422                             struct device_attribute *devattr,
423                             char *buf)
424 {
425         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
426         struct adt7470_data *data = adt7470_update_device(dev);
427
428         if (FAN_DATA_VALID(data->fan_min[attr->index]))
429                 return sprintf(buf, "%d\n",
430                                FAN_PERIOD_TO_RPM(data->fan_min[attr->index]));
431         else
432                 return sprintf(buf, "0\n");
433 }
434
435 static ssize_t set_fan_min(struct device *dev,
436                            struct device_attribute *devattr,
437                            const char *buf, size_t count)
438 {
439         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
440         struct i2c_client *client = to_i2c_client(dev);
441         struct adt7470_data *data = i2c_get_clientdata(client);
442         int temp = simple_strtol(buf, NULL, 10);
443
444         if (!temp)
445                 return -EINVAL;
446         temp = FAN_RPM_TO_PERIOD(temp);
447
448         mutex_lock(&data->lock);
449         data->fan_min[attr->index] = temp;
450         adt7470_write_word_data(client, ADT7470_REG_FAN_MIN(attr->index), temp);
451         mutex_unlock(&data->lock);
452
453         return count;
454 }
455
456 static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
457                         char *buf)
458 {
459         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
460         struct adt7470_data *data = adt7470_update_device(dev);
461
462         if (FAN_DATA_VALID(data->fan[attr->index]))
463                 return sprintf(buf, "%d\n",
464                                FAN_PERIOD_TO_RPM(data->fan[attr->index]));
465         else
466                 return sprintf(buf, "0\n");
467 }
468
469 static ssize_t show_force_pwm_max(struct device *dev,
470                                   struct device_attribute *devattr,
471                                   char *buf)
472 {
473         struct adt7470_data *data = adt7470_update_device(dev);
474         return sprintf(buf, "%d\n", data->force_pwm_max);
475 }
476
477 static ssize_t set_force_pwm_max(struct device *dev,
478                                  struct device_attribute *devattr,
479                                  const char *buf,
480                                  size_t count)
481 {
482         struct i2c_client *client = to_i2c_client(dev);
483         struct adt7470_data *data = i2c_get_clientdata(client);
484         int temp = simple_strtol(buf, NULL, 10);
485         u8 reg;
486
487         mutex_lock(&data->lock);
488         data->force_pwm_max = temp;
489         reg = i2c_smbus_read_byte_data(client, ADT7470_REG_CFG);
490         if (temp)
491                 reg |= ADT7470_FSPD_MASK;
492         else
493                 reg &= ~ADT7470_FSPD_MASK;
494         i2c_smbus_write_byte_data(client, ADT7470_REG_CFG, reg);
495         mutex_unlock(&data->lock);
496
497         return count;
498 }
499
500 static ssize_t show_pwm(struct device *dev, struct device_attribute *devattr,
501                         char *buf)
502 {
503         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
504         struct adt7470_data *data = adt7470_update_device(dev);
505         return sprintf(buf, "%d\n", data->pwm[attr->index]);
506 }
507
508 static ssize_t set_pwm(struct device *dev, struct device_attribute *devattr,
509                         const char *buf, size_t count)
510 {
511         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
512         struct i2c_client *client = to_i2c_client(dev);
513         struct adt7470_data *data = i2c_get_clientdata(client);
514         int temp = simple_strtol(buf, NULL, 10);
515
516         mutex_lock(&data->lock);
517         data->pwm[attr->index] = temp;
518         i2c_smbus_write_byte_data(client, ADT7470_REG_PWM(attr->index), temp);
519         mutex_unlock(&data->lock);
520
521         return count;
522 }
523
524 static ssize_t show_pwm_max(struct device *dev,
525                             struct device_attribute *devattr,
526                             char *buf)
527 {
528         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
529         struct adt7470_data *data = adt7470_update_device(dev);
530         return sprintf(buf, "%d\n", data->pwm_max[attr->index]);
531 }
532
533 static ssize_t set_pwm_max(struct device *dev,
534                            struct device_attribute *devattr,
535                            const char *buf,
536                            size_t count)
537 {
538         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
539         struct i2c_client *client = to_i2c_client(dev);
540         struct adt7470_data *data = i2c_get_clientdata(client);
541         int temp = simple_strtol(buf, NULL, 10);
542
543         mutex_lock(&data->lock);
544         data->pwm_max[attr->index] = temp;
545         i2c_smbus_write_byte_data(client, ADT7470_REG_PWM_MAX(attr->index),
546                                   temp);
547         mutex_unlock(&data->lock);
548
549         return count;
550 }
551
552 static ssize_t show_pwm_min(struct device *dev,
553                             struct device_attribute *devattr,
554                             char *buf)
555 {
556         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
557         struct adt7470_data *data = adt7470_update_device(dev);
558         return sprintf(buf, "%d\n", data->pwm_min[attr->index]);
559 }
560
561 static ssize_t set_pwm_min(struct device *dev,
562                            struct device_attribute *devattr,
563                            const char *buf,
564                            size_t count)
565 {
566         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
567         struct i2c_client *client = to_i2c_client(dev);
568         struct adt7470_data *data = i2c_get_clientdata(client);
569         int temp = simple_strtol(buf, NULL, 10);
570
571         mutex_lock(&data->lock);
572         data->pwm_min[attr->index] = temp;
573         i2c_smbus_write_byte_data(client, ADT7470_REG_PWM_MIN(attr->index),
574                                   temp);
575         mutex_unlock(&data->lock);
576
577         return count;
578 }
579
580 static ssize_t show_pwm_tmax(struct device *dev,
581                              struct device_attribute *devattr,
582                              char *buf)
583 {
584         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
585         struct adt7470_data *data = adt7470_update_device(dev);
586         /* the datasheet says that tmax = tmin + 20C */
587         return sprintf(buf, "%d\n", 1000 * (20 + data->pwm_tmin[attr->index]));
588 }
589
590 static ssize_t show_pwm_tmin(struct device *dev,
591                              struct device_attribute *devattr,
592                              char *buf)
593 {
594         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
595         struct adt7470_data *data = adt7470_update_device(dev);
596         return sprintf(buf, "%d\n", 1000 * data->pwm_tmin[attr->index]);
597 }
598
599 static ssize_t set_pwm_tmin(struct device *dev,
600                             struct device_attribute *devattr,
601                             const char *buf,
602                             size_t count)
603 {
604         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
605         struct i2c_client *client = to_i2c_client(dev);
606         struct adt7470_data *data = i2c_get_clientdata(client);
607         int temp = simple_strtol(buf, NULL, 10) / 1000;
608
609         mutex_lock(&data->lock);
610         data->pwm_tmin[attr->index] = temp;
611         i2c_smbus_write_byte_data(client, ADT7470_REG_PWM_TMIN(attr->index),
612                                   temp);
613         mutex_unlock(&data->lock);
614
615         return count;
616 }
617
618 static ssize_t show_pwm_auto(struct device *dev,
619                              struct device_attribute *devattr,
620                              char *buf)
621 {
622         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
623         struct adt7470_data *data = adt7470_update_device(dev);
624         return sprintf(buf, "%d\n", 1 + data->pwm_automatic[attr->index]);
625 }
626
627 static ssize_t set_pwm_auto(struct device *dev,
628                             struct device_attribute *devattr,
629                             const char *buf,
630                             size_t count)
631 {
632         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
633         struct i2c_client *client = to_i2c_client(dev);
634         struct adt7470_data *data = i2c_get_clientdata(client);
635         int temp = simple_strtol(buf, NULL, 10);
636         int pwm_auto_reg = ADT7470_REG_PWM_CFG(attr->index);
637         int pwm_auto_reg_mask;
638         u8 reg;
639
640         if (attr->index % 2)
641                 pwm_auto_reg_mask = ADT7470_PWM2_AUTO_MASK;
642         else
643                 pwm_auto_reg_mask = ADT7470_PWM1_AUTO_MASK;
644
645         if (temp != 2 && temp != 1)
646                 return -EINVAL;
647         temp--;
648
649         mutex_lock(&data->lock);
650         data->pwm_automatic[attr->index] = temp;
651         reg = i2c_smbus_read_byte_data(client, pwm_auto_reg);
652         if (temp)
653                 reg |= pwm_auto_reg_mask;
654         else
655                 reg &= ~pwm_auto_reg_mask;
656         i2c_smbus_write_byte_data(client, pwm_auto_reg, reg);
657         mutex_unlock(&data->lock);
658
659         return count;
660 }
661
662 static ssize_t show_pwm_auto_temp(struct device *dev,
663                                   struct device_attribute *devattr,
664                                   char *buf)
665 {
666         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
667         struct adt7470_data *data = adt7470_update_device(dev);
668         u8 ctrl = data->pwm_auto_temp[attr->index];
669
670         if (ctrl)
671                 return sprintf(buf, "%d\n", 1 << (ctrl - 1));
672         else
673                 return sprintf(buf, "%d\n", ADT7470_PWM_ALL_TEMPS);
674 }
675
676 static int cvt_auto_temp(int input)
677 {
678         if (input == ADT7470_PWM_ALL_TEMPS)
679                 return 0;
680         if (input < 1 || !power_of_2(input))
681                 return -EINVAL;
682         return ilog2(input) + 1;
683 }
684
685 static ssize_t set_pwm_auto_temp(struct device *dev,
686                                  struct device_attribute *devattr,
687                                  const char *buf,
688                                  size_t count)
689 {
690         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
691         struct i2c_client *client = to_i2c_client(dev);
692         struct adt7470_data *data = i2c_get_clientdata(client);
693         int temp = cvt_auto_temp(simple_strtol(buf, NULL, 10));
694         int pwm_auto_reg = ADT7470_REG_PWM_AUTO_TEMP(attr->index);
695         u8 reg;
696
697         if (temp < 0)
698                 return temp;
699
700         mutex_lock(&data->lock);
701         data->pwm_automatic[attr->index] = temp;
702         reg = i2c_smbus_read_byte_data(client, pwm_auto_reg);
703
704         if (!(attr->index % 2)) {
705                 reg &= 0xF;
706                 reg |= (temp << 4) & 0xF0;
707         } else {
708                 reg &= 0xF0;
709                 reg |= temp & 0xF;
710         }
711
712         i2c_smbus_write_byte_data(client, pwm_auto_reg, reg);
713         mutex_unlock(&data->lock);
714
715         return count;
716 }
717
718 static SENSOR_DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL, 0);
719 static SENSOR_DEVICE_ATTR(alarm_mask, S_IRUGO, show_alarms, NULL, 1);
720
721 static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_max,
722                     set_temp_max, 0);
723 static SENSOR_DEVICE_ATTR(temp2_max, S_IWUSR | S_IRUGO, show_temp_max,
724                     set_temp_max, 1);
725 static SENSOR_DEVICE_ATTR(temp3_max, S_IWUSR | S_IRUGO, show_temp_max,
726                     set_temp_max, 2);
727 static SENSOR_DEVICE_ATTR(temp4_max, S_IWUSR | S_IRUGO, show_temp_max,
728                     set_temp_max, 3);
729 static SENSOR_DEVICE_ATTR(temp5_max, S_IWUSR | S_IRUGO, show_temp_max,
730                     set_temp_max, 4);
731 static SENSOR_DEVICE_ATTR(temp6_max, S_IWUSR | S_IRUGO, show_temp_max,
732                     set_temp_max, 5);
733 static SENSOR_DEVICE_ATTR(temp7_max, S_IWUSR | S_IRUGO, show_temp_max,
734                     set_temp_max, 6);
735 static SENSOR_DEVICE_ATTR(temp8_max, S_IWUSR | S_IRUGO, show_temp_max,
736                     set_temp_max, 7);
737 static SENSOR_DEVICE_ATTR(temp9_max, S_IWUSR | S_IRUGO, show_temp_max,
738                     set_temp_max, 8);
739 static SENSOR_DEVICE_ATTR(temp10_max, S_IWUSR | S_IRUGO, show_temp_max,
740                     set_temp_max, 9);
741
742 static SENSOR_DEVICE_ATTR(temp1_min, S_IWUSR | S_IRUGO, show_temp_min,
743                     set_temp_min, 0);
744 static SENSOR_DEVICE_ATTR(temp2_min, S_IWUSR | S_IRUGO, show_temp_min,
745                     set_temp_min, 1);
746 static SENSOR_DEVICE_ATTR(temp3_min, S_IWUSR | S_IRUGO, show_temp_min,
747                     set_temp_min, 2);
748 static SENSOR_DEVICE_ATTR(temp4_min, S_IWUSR | S_IRUGO, show_temp_min,
749                     set_temp_min, 3);
750 static SENSOR_DEVICE_ATTR(temp5_min, S_IWUSR | S_IRUGO, show_temp_min,
751                     set_temp_min, 4);
752 static SENSOR_DEVICE_ATTR(temp6_min, S_IWUSR | S_IRUGO, show_temp_min,
753                     set_temp_min, 5);
754 static SENSOR_DEVICE_ATTR(temp7_min, S_IWUSR | S_IRUGO, show_temp_min,
755                     set_temp_min, 6);
756 static SENSOR_DEVICE_ATTR(temp8_min, S_IWUSR | S_IRUGO, show_temp_min,
757                     set_temp_min, 7);
758 static SENSOR_DEVICE_ATTR(temp9_min, S_IWUSR | S_IRUGO, show_temp_min,
759                     set_temp_min, 8);
760 static SENSOR_DEVICE_ATTR(temp10_min, S_IWUSR | S_IRUGO, show_temp_min,
761                     set_temp_min, 9);
762
763 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
764 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1);
765 static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2);
766 static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3);
767 static SENSOR_DEVICE_ATTR(temp5_input, S_IRUGO, show_temp, NULL, 4);
768 static SENSOR_DEVICE_ATTR(temp6_input, S_IRUGO, show_temp, NULL, 5);
769 static SENSOR_DEVICE_ATTR(temp7_input, S_IRUGO, show_temp, NULL, 6);
770 static SENSOR_DEVICE_ATTR(temp8_input, S_IRUGO, show_temp, NULL, 7);
771 static SENSOR_DEVICE_ATTR(temp9_input, S_IRUGO, show_temp, NULL, 8);
772 static SENSOR_DEVICE_ATTR(temp10_input, S_IRUGO, show_temp, NULL, 9);
773
774 static SENSOR_DEVICE_ATTR(fan1_max, S_IWUSR | S_IRUGO, show_fan_max,
775                     set_fan_max, 0);
776 static SENSOR_DEVICE_ATTR(fan2_max, S_IWUSR | S_IRUGO, show_fan_max,
777                     set_fan_max, 1);
778 static SENSOR_DEVICE_ATTR(fan3_max, S_IWUSR | S_IRUGO, show_fan_max,
779                     set_fan_max, 2);
780 static SENSOR_DEVICE_ATTR(fan4_max, S_IWUSR | S_IRUGO, show_fan_max,
781                     set_fan_max, 3);
782
783 static SENSOR_DEVICE_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
784                     set_fan_min, 0);
785 static SENSOR_DEVICE_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
786                     set_fan_min, 1);
787 static SENSOR_DEVICE_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
788                     set_fan_min, 2);
789 static SENSOR_DEVICE_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
790                     set_fan_min, 3);
791
792 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
793 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
794 static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
795 static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3);
796
797 static SENSOR_DEVICE_ATTR(force_pwm_max, S_IWUSR | S_IRUGO,
798                     show_force_pwm_max, set_force_pwm_max, 0);
799
800 static SENSOR_DEVICE_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 0);
801 static SENSOR_DEVICE_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 1);
802 static SENSOR_DEVICE_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 2);
803 static SENSOR_DEVICE_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 3);
804
805 static SENSOR_DEVICE_ATTR(pwm1_auto_point1_pwm, S_IWUSR | S_IRUGO,
806                     show_pwm_min, set_pwm_min, 0);
807 static SENSOR_DEVICE_ATTR(pwm2_auto_point1_pwm, S_IWUSR | S_IRUGO,
808                     show_pwm_min, set_pwm_min, 1);
809 static SENSOR_DEVICE_ATTR(pwm3_auto_point1_pwm, S_IWUSR | S_IRUGO,
810                     show_pwm_min, set_pwm_min, 2);
811 static SENSOR_DEVICE_ATTR(pwm4_auto_point1_pwm, S_IWUSR | S_IRUGO,
812                     show_pwm_min, set_pwm_min, 3);
813
814 static SENSOR_DEVICE_ATTR(pwm1_auto_point2_pwm, S_IWUSR | S_IRUGO,
815                     show_pwm_max, set_pwm_max, 0);
816 static SENSOR_DEVICE_ATTR(pwm2_auto_point2_pwm, S_IWUSR | S_IRUGO,
817                     show_pwm_max, set_pwm_max, 1);
818 static SENSOR_DEVICE_ATTR(pwm3_auto_point2_pwm, S_IWUSR | S_IRUGO,
819                     show_pwm_max, set_pwm_max, 2);
820 static SENSOR_DEVICE_ATTR(pwm4_auto_point2_pwm, S_IWUSR | S_IRUGO,
821                     show_pwm_max, set_pwm_max, 3);
822
823 static SENSOR_DEVICE_ATTR(pwm1_auto_point1_temp, S_IWUSR | S_IRUGO,
824                     show_pwm_tmin, set_pwm_tmin, 0);
825 static SENSOR_DEVICE_ATTR(pwm2_auto_point1_temp, S_IWUSR | S_IRUGO,
826                     show_pwm_tmin, set_pwm_tmin, 1);
827 static SENSOR_DEVICE_ATTR(pwm3_auto_point1_temp, S_IWUSR | S_IRUGO,
828                     show_pwm_tmin, set_pwm_tmin, 2);
829 static SENSOR_DEVICE_ATTR(pwm4_auto_point1_temp, S_IWUSR | S_IRUGO,
830                     show_pwm_tmin, set_pwm_tmin, 3);
831
832 static SENSOR_DEVICE_ATTR(pwm1_auto_point2_temp, S_IRUGO, show_pwm_tmax,
833                     NULL, 0);
834 static SENSOR_DEVICE_ATTR(pwm2_auto_point2_temp, S_IRUGO, show_pwm_tmax,
835                     NULL, 1);
836 static SENSOR_DEVICE_ATTR(pwm3_auto_point2_temp, S_IRUGO, show_pwm_tmax,
837                     NULL, 2);
838 static SENSOR_DEVICE_ATTR(pwm4_auto_point2_temp, S_IRUGO, show_pwm_tmax,
839                     NULL, 3);
840
841 static SENSOR_DEVICE_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_auto,
842                     set_pwm_auto, 0);
843 static SENSOR_DEVICE_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_auto,
844                     set_pwm_auto, 1);
845 static SENSOR_DEVICE_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_auto,
846                     set_pwm_auto, 2);
847 static SENSOR_DEVICE_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_auto,
848                     set_pwm_auto, 3);
849
850 static SENSOR_DEVICE_ATTR(pwm1_auto_channels_temp, S_IWUSR | S_IRUGO,
851                     show_pwm_auto_temp, set_pwm_auto_temp, 0);
852 static SENSOR_DEVICE_ATTR(pwm2_auto_channels_temp, S_IWUSR | S_IRUGO,
853                     show_pwm_auto_temp, set_pwm_auto_temp, 1);
854 static SENSOR_DEVICE_ATTR(pwm3_auto_channels_temp, S_IWUSR | S_IRUGO,
855                     show_pwm_auto_temp, set_pwm_auto_temp, 2);
856 static SENSOR_DEVICE_ATTR(pwm4_auto_channels_temp, S_IWUSR | S_IRUGO,
857                     show_pwm_auto_temp, set_pwm_auto_temp, 3);
858
859 static struct attribute *adt7470_attr[] =
860 {
861         &sensor_dev_attr_alarms.dev_attr.attr,
862         &sensor_dev_attr_alarm_mask.dev_attr.attr,
863         &sensor_dev_attr_temp1_max.dev_attr.attr,
864         &sensor_dev_attr_temp2_max.dev_attr.attr,
865         &sensor_dev_attr_temp3_max.dev_attr.attr,
866         &sensor_dev_attr_temp4_max.dev_attr.attr,
867         &sensor_dev_attr_temp5_max.dev_attr.attr,
868         &sensor_dev_attr_temp6_max.dev_attr.attr,
869         &sensor_dev_attr_temp7_max.dev_attr.attr,
870         &sensor_dev_attr_temp8_max.dev_attr.attr,
871         &sensor_dev_attr_temp9_max.dev_attr.attr,
872         &sensor_dev_attr_temp10_max.dev_attr.attr,
873         &sensor_dev_attr_temp1_min.dev_attr.attr,
874         &sensor_dev_attr_temp2_min.dev_attr.attr,
875         &sensor_dev_attr_temp3_min.dev_attr.attr,
876         &sensor_dev_attr_temp4_min.dev_attr.attr,
877         &sensor_dev_attr_temp5_min.dev_attr.attr,
878         &sensor_dev_attr_temp6_min.dev_attr.attr,
879         &sensor_dev_attr_temp7_min.dev_attr.attr,
880         &sensor_dev_attr_temp8_min.dev_attr.attr,
881         &sensor_dev_attr_temp9_min.dev_attr.attr,
882         &sensor_dev_attr_temp10_min.dev_attr.attr,
883         &sensor_dev_attr_temp1_input.dev_attr.attr,
884         &sensor_dev_attr_temp2_input.dev_attr.attr,
885         &sensor_dev_attr_temp3_input.dev_attr.attr,
886         &sensor_dev_attr_temp4_input.dev_attr.attr,
887         &sensor_dev_attr_temp5_input.dev_attr.attr,
888         &sensor_dev_attr_temp6_input.dev_attr.attr,
889         &sensor_dev_attr_temp7_input.dev_attr.attr,
890         &sensor_dev_attr_temp8_input.dev_attr.attr,
891         &sensor_dev_attr_temp9_input.dev_attr.attr,
892         &sensor_dev_attr_temp10_input.dev_attr.attr,
893         &sensor_dev_attr_fan1_max.dev_attr.attr,
894         &sensor_dev_attr_fan2_max.dev_attr.attr,
895         &sensor_dev_attr_fan3_max.dev_attr.attr,
896         &sensor_dev_attr_fan4_max.dev_attr.attr,
897         &sensor_dev_attr_fan1_min.dev_attr.attr,
898         &sensor_dev_attr_fan2_min.dev_attr.attr,
899         &sensor_dev_attr_fan3_min.dev_attr.attr,
900         &sensor_dev_attr_fan4_min.dev_attr.attr,
901         &sensor_dev_attr_fan1_input.dev_attr.attr,
902         &sensor_dev_attr_fan2_input.dev_attr.attr,
903         &sensor_dev_attr_fan3_input.dev_attr.attr,
904         &sensor_dev_attr_fan4_input.dev_attr.attr,
905         &sensor_dev_attr_force_pwm_max.dev_attr.attr,
906         &sensor_dev_attr_pwm1.dev_attr.attr,
907         &sensor_dev_attr_pwm2.dev_attr.attr,
908         &sensor_dev_attr_pwm3.dev_attr.attr,
909         &sensor_dev_attr_pwm4.dev_attr.attr,
910         &sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
911         &sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
912         &sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
913         &sensor_dev_attr_pwm4_auto_point1_pwm.dev_attr.attr,
914         &sensor_dev_attr_pwm1_auto_point2_pwm.dev_attr.attr,
915         &sensor_dev_attr_pwm2_auto_point2_pwm.dev_attr.attr,
916         &sensor_dev_attr_pwm3_auto_point2_pwm.dev_attr.attr,
917         &sensor_dev_attr_pwm4_auto_point2_pwm.dev_attr.attr,
918         &sensor_dev_attr_pwm1_auto_point1_temp.dev_attr.attr,
919         &sensor_dev_attr_pwm2_auto_point1_temp.dev_attr.attr,
920         &sensor_dev_attr_pwm3_auto_point1_temp.dev_attr.attr,
921         &sensor_dev_attr_pwm4_auto_point1_temp.dev_attr.attr,
922         &sensor_dev_attr_pwm1_auto_point2_temp.dev_attr.attr,
923         &sensor_dev_attr_pwm2_auto_point2_temp.dev_attr.attr,
924         &sensor_dev_attr_pwm3_auto_point2_temp.dev_attr.attr,
925         &sensor_dev_attr_pwm4_auto_point2_temp.dev_attr.attr,
926         &sensor_dev_attr_pwm1_enable.dev_attr.attr,
927         &sensor_dev_attr_pwm2_enable.dev_attr.attr,
928         &sensor_dev_attr_pwm3_enable.dev_attr.attr,
929         &sensor_dev_attr_pwm4_enable.dev_attr.attr,
930         &sensor_dev_attr_pwm1_auto_channels_temp.dev_attr.attr,
931         &sensor_dev_attr_pwm2_auto_channels_temp.dev_attr.attr,
932         &sensor_dev_attr_pwm3_auto_channels_temp.dev_attr.attr,
933         &sensor_dev_attr_pwm4_auto_channels_temp.dev_attr.attr,
934         NULL
935 };
936
937 static int adt7470_attach_adapter(struct i2c_adapter *adapter)
938 {
939         if (!(adapter->class & I2C_CLASS_HWMON))
940                 return 0;
941         return i2c_probe(adapter, &addr_data, adt7470_detect);
942 }
943
944 static int adt7470_detect(struct i2c_adapter *adapter, int address, int kind)
945 {
946         struct i2c_client *client;
947         struct adt7470_data *data;
948         int err = 0;
949
950         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
951                 goto exit;
952
953         if (!(data = kzalloc(sizeof(struct adt7470_data), GFP_KERNEL))) {
954                 err = -ENOMEM;
955                 goto exit;
956         }
957
958         client = &data->client;
959         client->addr = address;
960         client->adapter = adapter;
961         client->driver = &adt7470_driver;
962
963         i2c_set_clientdata(client, data);
964
965         mutex_init(&data->lock);
966
967         if (kind <= 0) {
968                 int vendor, device, revision;
969
970                 vendor = i2c_smbus_read_byte_data(client, ADT7470_REG_VENDOR);
971                 if (vendor != ADT7470_VENDOR) {
972                         err = -ENODEV;
973                         goto exit_free;
974                 }
975
976                 device = i2c_smbus_read_byte_data(client, ADT7470_REG_DEVICE);
977                 if (device != ADT7470_DEVICE) {
978                         err = -ENODEV;
979                         goto exit_free;
980                 }
981
982                 revision = i2c_smbus_read_byte_data(client,
983                                                     ADT7470_REG_REVISION);
984                 if (revision != ADT7470_REVISION) {
985                         err = -ENODEV;
986                         goto exit_free;
987                 }
988         } else
989                 dev_dbg(&adapter->dev, "detection forced\n");
990
991         strlcpy(client->name, "adt7470", I2C_NAME_SIZE);
992
993         if ((err = i2c_attach_client(client)))
994                 goto exit_free;
995
996         dev_info(&client->dev, "%s chip found\n", client->name);
997
998         /* Initialize the ADT7470 chip */
999         adt7470_init_client(client);
1000
1001         /* Register sysfs hooks */
1002         data->attrs.attrs = adt7470_attr;
1003         if ((err = sysfs_create_group(&client->dev.kobj, &data->attrs)))
1004                 goto exit_detach;
1005
1006         data->hwmon_dev = hwmon_device_register(&client->dev);
1007         if (IS_ERR(data->hwmon_dev)) {
1008                 err = PTR_ERR(data->hwmon_dev);
1009                 goto exit_remove;
1010         }
1011
1012         return 0;
1013
1014 exit_remove:
1015         sysfs_remove_group(&client->dev.kobj, &data->attrs);
1016 exit_detach:
1017         i2c_detach_client(client);
1018 exit_free:
1019         kfree(data);
1020 exit:
1021         return err;
1022 }
1023
1024 static int adt7470_detach_client(struct i2c_client *client)
1025 {
1026         struct adt7470_data *data = i2c_get_clientdata(client);
1027
1028         hwmon_device_unregister(data->hwmon_dev);
1029         sysfs_remove_group(&client->dev.kobj, &data->attrs);
1030         i2c_detach_client(client);
1031         kfree(data);
1032         return 0;
1033 }
1034
1035 static int __init adt7470_init(void)
1036 {
1037         return i2c_add_driver(&adt7470_driver);
1038 }
1039
1040 static void __exit adt7470_exit(void)
1041 {
1042         i2c_del_driver(&adt7470_driver);
1043 }
1044
1045 MODULE_AUTHOR("Darrick J. Wong <djwong@us.ibm.com>");
1046 MODULE_DESCRIPTION("ADT7470 driver");
1047 MODULE_LICENSE("GPL");
1048
1049 module_init(adt7470_init);
1050 module_exit(adt7470_exit);