hwmon: (adt7473) minor cleanup / refactoring
[pandora-kernel.git] / drivers / hwmon / adt7473.c
1 /*
2  * A hwmon driver for the Analog Devices ADT7473
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 const unsigned short normal_i2c[] = { 0x2C, 0x2D, 0x2E, I2C_CLIENT_END };
34
35 /* Insmod parameters */
36 I2C_CLIENT_INSMOD_1(adt7473);
37
38 /* ADT7473 registers */
39 #define ADT7473_REG_BASE_ADDR                   0x20
40
41 #define ADT7473_REG_VOLT_BASE_ADDR              0x21
42 #define ADT7473_REG_VOLT_MAX_ADDR               0x22
43 #define ADT7473_REG_VOLT_MIN_BASE_ADDR          0x46
44 #define ADT7473_REG_VOLT_MIN_MAX_ADDR           0x49
45
46 #define ADT7473_REG_TEMP_BASE_ADDR              0x25
47 #define ADT7473_REG_TEMP_MAX_ADDR               0x27
48 #define ADT7473_REG_TEMP_LIMITS_BASE_ADDR       0x4E
49 #define ADT7473_REG_TEMP_LIMITS_MAX_ADDR        0x53
50 #define ADT7473_REG_TEMP_TMIN_BASE_ADDR         0x67
51 #define ADT7473_REG_TEMP_TMIN_MAX_ADDR          0x69
52 #define ADT7473_REG_TEMP_TMAX_BASE_ADDR         0x6A
53 #define ADT7473_REG_TEMP_TMAX_MAX_ADDR          0x6C
54
55 #define ADT7473_REG_FAN_BASE_ADDR               0x28
56 #define ADT7473_REG_FAN_MAX_ADDR                0x2F
57 #define ADT7473_REG_FAN_MIN_BASE_ADDR           0x54
58 #define ADT7473_REG_FAN_MIN_MAX_ADDR            0x5B
59
60 #define ADT7473_REG_PWM_BASE_ADDR               0x30
61 #define ADT7473_REG_PWM_MAX_ADDR                0x32
62 #define ADT7473_REG_PWM_MIN_BASE_ADDR           0x64
63 #define ADT7473_REG_PWM_MIN_MAX_ADDR            0x66
64 #define ADT7473_REG_PWM_MAX_BASE_ADDR           0x38
65 #define ADT7473_REG_PWM_MAX_MAX_ADDR            0x3A
66 #define ADT7473_REG_PWM_BHVR_BASE_ADDR          0x5C
67 #define ADT7473_REG_PWM_BHVR_MAX_ADDR           0x5E
68 #define         ADT7473_PWM_BHVR_MASK           0xE0
69 #define         ADT7473_PWM_BHVR_SHIFT          5
70
71 #define ADT7473_REG_CFG1                        0x40
72 #define         ADT7473_CFG1_START              0x01
73 #define         ADT7473_CFG1_READY              0x04
74 #define ADT7473_REG_CFG2                        0x73
75 #define ADT7473_REG_CFG3                        0x78
76 #define ADT7473_REG_CFG4                        0x7D
77 #define         ADT7473_CFG4_MAX_DUTY_AT_OVT    0x08
78 #define ADT7473_REG_CFG5                        0x7C
79 #define         ADT7473_CFG5_TEMP_TWOS          0x01
80 #define         ADT7473_CFG5_TEMP_OFFSET        0x02
81
82 #define ADT7473_REG_DEVICE                      0x3D
83 #define         ADT7473_VENDOR                  0x41
84 #define ADT7473_REG_VENDOR                      0x3E
85 #define         ADT7473_DEVICE                  0x73
86 #define ADT7473_REG_REVISION                    0x3F
87 #define         ADT7473_REV_68                  0x68
88 #define         ADT7473_REV_69                  0x69
89
90 #define ADT7473_REG_ALARM1                      0x41
91 #define         ADT7473_VCCP_ALARM              0x02
92 #define         ADT7473_VCC_ALARM               0x04
93 #define         ADT7473_R1T_ALARM               0x10
94 #define         ADT7473_LT_ALARM                0x20
95 #define         ADT7473_R2T_ALARM               0x40
96 #define         ADT7473_OOL                     0x80
97 #define ADT7473_REG_ALARM2                      0x42
98 #define         ADT7473_OVT_ALARM               0x02
99 #define         ADT7473_FAN1_ALARM              0x04
100 #define         ADT7473_FAN2_ALARM              0x08
101 #define         ADT7473_FAN3_ALARM              0x10
102 #define         ADT7473_FAN4_ALARM              0x20
103 #define         ADT7473_R1T_SHORT               0x40
104 #define         ADT7473_R2T_SHORT               0x80
105 #define ADT7473_REG_MAX_ADDR                    0x80
106
107 #define ALARM2(x)       ((x) << 8)
108
109 #define ADT7473_VOLT_COUNT      2
110 #define ADT7473_REG_VOLT(x)     (ADT7473_REG_VOLT_BASE_ADDR + (x))
111 #define ADT7473_REG_VOLT_MIN(x) (ADT7473_REG_VOLT_MIN_BASE_ADDR + ((x) * 2))
112 #define ADT7473_REG_VOLT_MAX(x) (ADT7473_REG_VOLT_MIN_BASE_ADDR + \
113                                 ((x) * 2) + 1)
114
115 #define ADT7473_TEMP_COUNT      3
116 #define ADT7473_REG_TEMP(x)     (ADT7473_REG_TEMP_BASE_ADDR + (x))
117 #define ADT7473_REG_TEMP_MIN(x) (ADT7473_REG_TEMP_LIMITS_BASE_ADDR + ((x) * 2))
118 #define ADT7473_REG_TEMP_MAX(x) (ADT7473_REG_TEMP_LIMITS_BASE_ADDR + \
119                                 ((x) * 2) + 1)
120 #define ADT7473_REG_TEMP_TMIN(x)        (ADT7473_REG_TEMP_TMIN_BASE_ADDR + (x))
121 #define ADT7473_REG_TEMP_TMAX(x)        (ADT7473_REG_TEMP_TMAX_BASE_ADDR + (x))
122
123 #define ADT7473_FAN_COUNT       4
124 #define ADT7473_REG_FAN(x)      (ADT7473_REG_FAN_BASE_ADDR + ((x) * 2))
125 #define ADT7473_REG_FAN_MIN(x)  (ADT7473_REG_FAN_MIN_BASE_ADDR + ((x) * 2))
126
127 #define ADT7473_PWM_COUNT       3
128 #define ADT7473_REG_PWM(x)      (ADT7473_REG_PWM_BASE_ADDR + (x))
129 #define ADT7473_REG_PWM_MAX(x)  (ADT7473_REG_PWM_MAX_BASE_ADDR + (x))
130 #define ADT7473_REG_PWM_MIN(x)  (ADT7473_REG_PWM_MIN_BASE_ADDR + (x))
131 #define ADT7473_REG_PWM_BHVR(x) (ADT7473_REG_PWM_BHVR_BASE_ADDR + (x))
132
133 /* How often do we reread sensors values? (In jiffies) */
134 #define SENSOR_REFRESH_INTERVAL (2 * HZ)
135
136 /* How often do we reread sensor limit values? (In jiffies) */
137 #define LIMIT_REFRESH_INTERVAL  (60 * HZ)
138
139 /* datasheet says to divide this number by the fan reading to get fan rpm */
140 #define FAN_PERIOD_TO_RPM(x)    ((90000 * 60) / (x))
141 #define FAN_RPM_TO_PERIOD       FAN_PERIOD_TO_RPM
142 #define FAN_PERIOD_INVALID      65535
143 #define FAN_DATA_VALID(x)       ((x) && (x) != FAN_PERIOD_INVALID)
144
145 struct adt7473_data {
146         struct i2c_client       client;
147         struct device           *hwmon_dev;
148         struct attribute_group  attrs;
149         struct mutex            lock;
150         char                    sensors_valid;
151         char                    limits_valid;
152         unsigned long           sensors_last_updated;   /* In jiffies */
153         unsigned long           limits_last_updated;    /* In jiffies */
154
155         u8                      volt[ADT7473_VOLT_COUNT];
156         s8                      volt_min[ADT7473_VOLT_COUNT];
157         s8                      volt_max[ADT7473_VOLT_COUNT];
158
159         s8                      temp[ADT7473_TEMP_COUNT];
160         s8                      temp_min[ADT7473_TEMP_COUNT];
161         s8                      temp_max[ADT7473_TEMP_COUNT];
162         s8                      temp_tmin[ADT7473_TEMP_COUNT];
163         /* This is called the !THERM limit in the datasheet */
164         s8                      temp_tmax[ADT7473_TEMP_COUNT];
165
166         u16                     fan[ADT7473_FAN_COUNT];
167         u16                     fan_min[ADT7473_FAN_COUNT];
168
169         u8                      pwm[ADT7473_PWM_COUNT];
170         u8                      pwm_max[ADT7473_PWM_COUNT];
171         u8                      pwm_min[ADT7473_PWM_COUNT];
172         u8                      pwm_behavior[ADT7473_PWM_COUNT];
173
174         u8                      temp_twos_complement;
175         u8                      temp_offset;
176
177         u16                     alarm;
178         u8                      max_duty_at_overheat;
179 };
180
181 static int adt7473_attach_adapter(struct i2c_adapter *adapter);
182 static int adt7473_detect(struct i2c_adapter *adapter, int address, int kind);
183 static int adt7473_detach_client(struct i2c_client *client);
184
185 static struct i2c_driver adt7473_driver = {
186         .driver = {
187                 .name   = "adt7473",
188         },
189         .attach_adapter = adt7473_attach_adapter,
190         .detach_client  = adt7473_detach_client,
191 };
192
193 /*
194  * 16-bit registers on the ADT7473 are low-byte first.  The data sheet says
195  * that the low byte must be read before the high byte.
196  */
197 static inline int adt7473_read_word_data(struct i2c_client *client, u8 reg)
198 {
199         u16 foo;
200         foo = i2c_smbus_read_byte_data(client, reg);
201         foo |= ((u16)i2c_smbus_read_byte_data(client, reg + 1) << 8);
202         return foo;
203 }
204
205 static inline int adt7473_write_word_data(struct i2c_client *client, u8 reg,
206                                           u16 value)
207 {
208         return i2c_smbus_write_byte_data(client, reg, value & 0xFF)
209                && i2c_smbus_write_byte_data(client, reg + 1, value >> 8);
210 }
211
212 static void adt7473_init_client(struct i2c_client *client)
213 {
214         int reg = i2c_smbus_read_byte_data(client, ADT7473_REG_CFG1);
215
216         if (!(reg & ADT7473_CFG1_READY)) {
217                 dev_err(&client->dev, "Chip not ready.\n");
218         } else {
219                 /* start monitoring */
220                 i2c_smbus_write_byte_data(client, ADT7473_REG_CFG1,
221                                           reg | ADT7473_CFG1_START);
222         }
223 }
224
225 static struct adt7473_data *adt7473_update_device(struct device *dev)
226 {
227         struct i2c_client *client = to_i2c_client(dev);
228         struct adt7473_data *data = i2c_get_clientdata(client);
229         unsigned long local_jiffies = jiffies;
230         u8 cfg;
231         int i;
232
233         mutex_lock(&data->lock);
234         if (time_before(local_jiffies, data->sensors_last_updated +
235                 SENSOR_REFRESH_INTERVAL)
236                 && data->sensors_valid)
237                 goto no_sensor_update;
238
239         for (i = 0; i < ADT7473_VOLT_COUNT; i++)
240                 data->volt[i] = i2c_smbus_read_byte_data(client,
241                                                 ADT7473_REG_VOLT(i));
242
243         /* Determine temperature encoding */
244         cfg = i2c_smbus_read_byte_data(client, ADT7473_REG_CFG5);
245         data->temp_twos_complement = (cfg & ADT7473_CFG5_TEMP_TWOS);
246
247         /*
248          * What does this do? it implies a variable temperature sensor
249          * offset, but the datasheet doesn't say anything about this bit
250          * and other parts of the datasheet imply that "offset64" mode
251          * means that you shift temp values by -64 if the above bit was set.
252          */
253         data->temp_offset = (cfg & ADT7473_CFG5_TEMP_OFFSET);
254
255         for (i = 0; i < ADT7473_TEMP_COUNT; i++)
256                 data->temp[i] = i2c_smbus_read_byte_data(client,
257                                                          ADT7473_REG_TEMP(i));
258
259         for (i = 0; i < ADT7473_FAN_COUNT; i++)
260                 data->fan[i] = adt7473_read_word_data(client,
261                                                 ADT7473_REG_FAN(i));
262
263         for (i = 0; i < ADT7473_PWM_COUNT; i++)
264                 data->pwm[i] = i2c_smbus_read_byte_data(client,
265                                                 ADT7473_REG_PWM(i));
266
267         data->alarm = i2c_smbus_read_byte_data(client, ADT7473_REG_ALARM1);
268         if (data->alarm & ADT7473_OOL)
269                 data->alarm |= ALARM2(i2c_smbus_read_byte_data(client,
270                                                          ADT7473_REG_ALARM2));
271
272         data->sensors_last_updated = local_jiffies;
273         data->sensors_valid = 1;
274
275 no_sensor_update:
276         if (time_before(local_jiffies, data->limits_last_updated +
277                 LIMIT_REFRESH_INTERVAL)
278                 && data->limits_valid)
279                 goto out;
280
281         for (i = 0; i < ADT7473_VOLT_COUNT; i++) {
282                 data->volt_min[i] = i2c_smbus_read_byte_data(client,
283                                                 ADT7473_REG_VOLT_MIN(i));
284                 data->volt_max[i] = i2c_smbus_read_byte_data(client,
285                                                 ADT7473_REG_VOLT_MAX(i));
286         }
287
288         for (i = 0; i < ADT7473_TEMP_COUNT; i++) {
289                 data->temp_min[i] = i2c_smbus_read_byte_data(client,
290                                                 ADT7473_REG_TEMP_MIN(i));
291                 data->temp_max[i] = i2c_smbus_read_byte_data(client,
292                                                 ADT7473_REG_TEMP_MAX(i));
293                 data->temp_tmin[i] = i2c_smbus_read_byte_data(client,
294                                                 ADT7473_REG_TEMP_TMIN(i));
295                 data->temp_tmax[i] = i2c_smbus_read_byte_data(client,
296                                                 ADT7473_REG_TEMP_TMAX(i));
297         }
298
299         for (i = 0; i < ADT7473_FAN_COUNT; i++)
300                 data->fan_min[i] = adt7473_read_word_data(client,
301                                                 ADT7473_REG_FAN_MIN(i));
302
303         for (i = 0; i < ADT7473_PWM_COUNT; i++) {
304                 data->pwm_max[i] = i2c_smbus_read_byte_data(client,
305                                                 ADT7473_REG_PWM_MAX(i));
306                 data->pwm_min[i] = i2c_smbus_read_byte_data(client,
307                                                 ADT7473_REG_PWM_MIN(i));
308                 data->pwm_behavior[i] = i2c_smbus_read_byte_data(client,
309                                                 ADT7473_REG_PWM_BHVR(i));
310         }
311
312         data->limits_last_updated = local_jiffies;
313         data->limits_valid = 1;
314
315 out:
316         mutex_unlock(&data->lock);
317         return data;
318 }
319
320 /*
321  * On this chip, voltages are given as a count of steps between a minimum
322  * and maximum voltage, not a direct voltage.
323  */
324 static const int volt_convert_table[][2] = {
325         {2997, 3},
326         {4395, 4},
327 };
328
329 static int decode_volt(int volt_index, u8 raw)
330 {
331         int cmax = volt_convert_table[volt_index][0];
332         int cmin = volt_convert_table[volt_index][1];
333         return ((raw * (cmax - cmin)) / 255) + cmin;
334 }
335
336 static u8 encode_volt(int volt_index, int cooked)
337 {
338         int cmax = volt_convert_table[volt_index][0];
339         int cmin = volt_convert_table[volt_index][1];
340         u8 x;
341
342         if (cooked > cmax)
343                 cooked = cmax;
344         else if (cooked < cmin)
345                 cooked = cmin;
346
347         x = ((cooked - cmin) * 255) / (cmax - cmin);
348
349         return x;
350 }
351
352 static ssize_t show_volt_min(struct device *dev,
353                              struct device_attribute *devattr,
354                              char *buf)
355 {
356         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
357         struct adt7473_data *data = adt7473_update_device(dev);
358         return sprintf(buf, "%d\n",
359                        decode_volt(attr->index, data->volt_min[attr->index]));
360 }
361
362 static ssize_t set_volt_min(struct device *dev,
363                             struct device_attribute *devattr,
364                             const char *buf,
365                             size_t count)
366 {
367         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
368         struct i2c_client *client = to_i2c_client(dev);
369         struct adt7473_data *data = i2c_get_clientdata(client);
370         int volt = encode_volt(attr->index, simple_strtol(buf, NULL, 10));
371
372         mutex_lock(&data->lock);
373         data->volt_min[attr->index] = volt;
374         i2c_smbus_write_byte_data(client, ADT7473_REG_VOLT_MIN(attr->index),
375                                   volt);
376         mutex_unlock(&data->lock);
377
378         return count;
379 }
380
381 static ssize_t show_volt_max(struct device *dev,
382                              struct device_attribute *devattr,
383                              char *buf)
384 {
385         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
386         struct adt7473_data *data = adt7473_update_device(dev);
387         return sprintf(buf, "%d\n",
388                        decode_volt(attr->index, data->volt_max[attr->index]));
389 }
390
391 static ssize_t set_volt_max(struct device *dev,
392                             struct device_attribute *devattr,
393                             const char *buf,
394                             size_t count)
395 {
396         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
397         struct i2c_client *client = to_i2c_client(dev);
398         struct adt7473_data *data = i2c_get_clientdata(client);
399         int volt = encode_volt(attr->index, simple_strtol(buf, NULL, 10));
400
401         mutex_lock(&data->lock);
402         data->volt_max[attr->index] = volt;
403         i2c_smbus_write_byte_data(client, ADT7473_REG_VOLT_MAX(attr->index),
404                                   volt);
405         mutex_unlock(&data->lock);
406
407         return count;
408 }
409
410 static ssize_t show_volt(struct device *dev, struct device_attribute *devattr,
411                          char *buf)
412 {
413         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
414         struct adt7473_data *data = adt7473_update_device(dev);
415
416         return sprintf(buf, "%d\n",
417                        decode_volt(attr->index, data->volt[attr->index]));
418 }
419
420 /*
421  * This chip can report temperature data either as a two's complement
422  * number in the range -128 to 127, or as an unsigned number that must
423  * be offset by 64.
424  */
425 static int decode_temp(u8 twos_complement, u8 raw)
426 {
427         return twos_complement ? (s8)raw : raw - 64;
428 }
429
430 static u8 encode_temp(u8 twos_complement, int cooked)
431 {
432         return twos_complement ? cooked & 0xFF : cooked + 64;
433 }
434
435 static ssize_t show_temp_min(struct device *dev,
436                              struct device_attribute *devattr,
437                              char *buf)
438 {
439         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
440         struct adt7473_data *data = adt7473_update_device(dev);
441         return sprintf(buf, "%d\n", 1000 * decode_temp(
442                                                 data->temp_twos_complement,
443                                                 data->temp_min[attr->index]));
444 }
445
446 static ssize_t set_temp_min(struct device *dev,
447                             struct device_attribute *devattr,
448                             const char *buf,
449                             size_t count)
450 {
451         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
452         struct i2c_client *client = to_i2c_client(dev);
453         struct adt7473_data *data = i2c_get_clientdata(client);
454         int temp = simple_strtol(buf, NULL, 10) / 1000;
455         temp = encode_temp(data->temp_twos_complement, temp);
456
457         mutex_lock(&data->lock);
458         data->temp_min[attr->index] = temp;
459         i2c_smbus_write_byte_data(client, ADT7473_REG_TEMP_MIN(attr->index),
460                                   temp);
461         mutex_unlock(&data->lock);
462
463         return count;
464 }
465
466 static ssize_t show_temp_max(struct device *dev,
467                              struct device_attribute *devattr,
468                              char *buf)
469 {
470         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
471         struct adt7473_data *data = adt7473_update_device(dev);
472         return sprintf(buf, "%d\n", 1000 * decode_temp(
473                                                 data->temp_twos_complement,
474                                                 data->temp_max[attr->index]));
475 }
476
477 static ssize_t set_temp_max(struct device *dev,
478                             struct device_attribute *devattr,
479                             const char *buf,
480                             size_t count)
481 {
482         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
483         struct i2c_client *client = to_i2c_client(dev);
484         struct adt7473_data *data = i2c_get_clientdata(client);
485         int temp = simple_strtol(buf, NULL, 10) / 1000;
486         temp = encode_temp(data->temp_twos_complement, temp);
487
488         mutex_lock(&data->lock);
489         data->temp_max[attr->index] = temp;
490         i2c_smbus_write_byte_data(client, ADT7473_REG_TEMP_MAX(attr->index),
491                                   temp);
492         mutex_unlock(&data->lock);
493
494         return count;
495 }
496
497 static ssize_t show_temp(struct device *dev, struct device_attribute *devattr,
498                          char *buf)
499 {
500         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
501         struct adt7473_data *data = adt7473_update_device(dev);
502         return sprintf(buf, "%d\n", 1000 * decode_temp(
503                                                 data->temp_twos_complement,
504                                                 data->temp[attr->index]));
505 }
506
507 static ssize_t show_fan_min(struct device *dev,
508                             struct device_attribute *devattr,
509                             char *buf)
510 {
511         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
512         struct adt7473_data *data = adt7473_update_device(dev);
513
514         if (FAN_DATA_VALID(data->fan_min[attr->index]))
515                 return sprintf(buf, "%d\n",
516                                FAN_PERIOD_TO_RPM(data->fan_min[attr->index]));
517         else
518                 return sprintf(buf, "0\n");
519 }
520
521 static ssize_t set_fan_min(struct device *dev,
522                            struct device_attribute *devattr,
523                            const char *buf, size_t count)
524 {
525         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
526         struct i2c_client *client = to_i2c_client(dev);
527         struct adt7473_data *data = i2c_get_clientdata(client);
528         int temp = simple_strtol(buf, NULL, 10);
529
530         if (!temp)
531                 return -EINVAL;
532         temp = FAN_RPM_TO_PERIOD(temp);
533
534         mutex_lock(&data->lock);
535         data->fan_min[attr->index] = temp;
536         adt7473_write_word_data(client, ADT7473_REG_FAN_MIN(attr->index), temp);
537         mutex_unlock(&data->lock);
538
539         return count;
540 }
541
542 static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
543                         char *buf)
544 {
545         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
546         struct adt7473_data *data = adt7473_update_device(dev);
547
548         if (FAN_DATA_VALID(data->fan[attr->index]))
549                 return sprintf(buf, "%d\n",
550                                FAN_PERIOD_TO_RPM(data->fan[attr->index]));
551         else
552                 return sprintf(buf, "0\n");
553 }
554
555 static ssize_t show_max_duty_at_crit(struct device *dev,
556                                      struct device_attribute *devattr,
557                                      char *buf)
558 {
559         struct adt7473_data *data = adt7473_update_device(dev);
560         return sprintf(buf, "%d\n", data->max_duty_at_overheat);
561 }
562
563 static ssize_t set_max_duty_at_crit(struct device *dev,
564                                     struct device_attribute *devattr,
565                                     const char *buf,
566                                     size_t count)
567 {
568         u8 reg;
569         struct i2c_client *client = to_i2c_client(dev);
570         struct adt7473_data *data = i2c_get_clientdata(client);
571         int temp = simple_strtol(buf, NULL, 10);
572         temp = temp && 0xFF;
573
574         mutex_lock(&data->lock);
575         data->max_duty_at_overheat = temp;
576         reg = i2c_smbus_read_byte_data(client, ADT7473_REG_CFG4);
577         if (temp)
578                 reg |= ADT7473_CFG4_MAX_DUTY_AT_OVT;
579         else
580                 reg &= ~ADT7473_CFG4_MAX_DUTY_AT_OVT;
581         i2c_smbus_write_byte_data(client, ADT7473_REG_CFG4, reg);
582         mutex_unlock(&data->lock);
583
584         return count;
585 }
586
587 static ssize_t show_pwm(struct device *dev, struct device_attribute *devattr,
588                         char *buf)
589 {
590         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
591         struct adt7473_data *data = adt7473_update_device(dev);
592         return sprintf(buf, "%d\n", data->pwm[attr->index]);
593 }
594
595 static ssize_t set_pwm(struct device *dev, struct device_attribute *devattr,
596                         const char *buf, size_t count)
597 {
598         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
599         struct i2c_client *client = to_i2c_client(dev);
600         struct adt7473_data *data = i2c_get_clientdata(client);
601         int temp = simple_strtol(buf, NULL, 10);
602
603         mutex_lock(&data->lock);
604         data->pwm[attr->index] = temp;
605         i2c_smbus_write_byte_data(client, ADT7473_REG_PWM(attr->index), temp);
606         mutex_unlock(&data->lock);
607
608         return count;
609 }
610
611 static ssize_t show_pwm_max(struct device *dev,
612                             struct device_attribute *devattr,
613                             char *buf)
614 {
615         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
616         struct adt7473_data *data = adt7473_update_device(dev);
617         return sprintf(buf, "%d\n", data->pwm_max[attr->index]);
618 }
619
620 static ssize_t set_pwm_max(struct device *dev,
621                            struct device_attribute *devattr,
622                            const char *buf,
623                            size_t count)
624 {
625         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
626         struct i2c_client *client = to_i2c_client(dev);
627         struct adt7473_data *data = i2c_get_clientdata(client);
628         int temp = simple_strtol(buf, NULL, 10);
629
630         mutex_lock(&data->lock);
631         data->pwm_max[attr->index] = temp;
632         i2c_smbus_write_byte_data(client, ADT7473_REG_PWM_MAX(attr->index),
633                                   temp);
634         mutex_unlock(&data->lock);
635
636         return count;
637 }
638
639 static ssize_t show_pwm_min(struct device *dev,
640                             struct device_attribute *devattr,
641                             char *buf)
642 {
643         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
644         struct adt7473_data *data = adt7473_update_device(dev);
645         return sprintf(buf, "%d\n", data->pwm_min[attr->index]);
646 }
647
648 static ssize_t set_pwm_min(struct device *dev,
649                            struct device_attribute *devattr,
650                            const char *buf,
651                            size_t count)
652 {
653         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
654         struct i2c_client *client = to_i2c_client(dev);
655         struct adt7473_data *data = i2c_get_clientdata(client);
656         int temp = simple_strtol(buf, NULL, 10);
657
658         mutex_lock(&data->lock);
659         data->pwm_min[attr->index] = temp;
660         i2c_smbus_write_byte_data(client, ADT7473_REG_PWM_MIN(attr->index),
661                                   temp);
662         mutex_unlock(&data->lock);
663
664         return count;
665 }
666
667 static ssize_t show_temp_tmax(struct device *dev,
668                               struct device_attribute *devattr,
669                               char *buf)
670 {
671         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
672         struct adt7473_data *data = adt7473_update_device(dev);
673         return sprintf(buf, "%d\n", 1000 * decode_temp(
674                                                 data->temp_twos_complement,
675                                                 data->temp_tmax[attr->index]));
676 }
677
678 static ssize_t set_temp_tmax(struct device *dev,
679                              struct device_attribute *devattr,
680                              const char *buf,
681                              size_t count)
682 {
683         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
684         struct i2c_client *client = to_i2c_client(dev);
685         struct adt7473_data *data = i2c_get_clientdata(client);
686         int temp = simple_strtol(buf, NULL, 10) / 1000;
687         temp = encode_temp(data->temp_twos_complement, temp);
688
689         mutex_lock(&data->lock);
690         data->temp_tmax[attr->index] = temp;
691         i2c_smbus_write_byte_data(client, ADT7473_REG_TEMP_TMAX(attr->index),
692                                   temp);
693         mutex_unlock(&data->lock);
694
695         return count;
696 }
697
698 static ssize_t show_temp_tmin(struct device *dev,
699                               struct device_attribute *devattr,
700                               char *buf)
701 {
702         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
703         struct adt7473_data *data = adt7473_update_device(dev);
704         return sprintf(buf, "%d\n", 1000 * decode_temp(
705                                                 data->temp_twos_complement,
706                                                 data->temp_tmin[attr->index]));
707 }
708
709 static ssize_t set_temp_tmin(struct device *dev,
710                              struct device_attribute *devattr,
711                              const char *buf,
712                              size_t count)
713 {
714         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
715         struct i2c_client *client = to_i2c_client(dev);
716         struct adt7473_data *data = i2c_get_clientdata(client);
717         int temp = simple_strtol(buf, NULL, 10) / 1000;
718         temp = encode_temp(data->temp_twos_complement, temp);
719
720         mutex_lock(&data->lock);
721         data->temp_tmin[attr->index] = temp;
722         i2c_smbus_write_byte_data(client, ADT7473_REG_TEMP_TMIN(attr->index),
723                                   temp);
724         mutex_unlock(&data->lock);
725
726         return count;
727 }
728
729 static ssize_t show_pwm_enable(struct device *dev,
730                                struct device_attribute *devattr,
731                                char *buf)
732 {
733         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
734         struct adt7473_data *data = adt7473_update_device(dev);
735
736         switch (data->pwm_behavior[attr->index] >> ADT7473_PWM_BHVR_SHIFT) {
737         case 3:
738                 return sprintf(buf, "0\n");
739         case 7:
740                 return sprintf(buf, "1\n");
741         default:
742                 return sprintf(buf, "2\n");
743         }
744 }
745
746 static ssize_t set_pwm_enable(struct device *dev,
747                               struct device_attribute *devattr,
748                               const char *buf,
749                               size_t count)
750 {
751         u8 reg;
752         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
753         struct i2c_client *client = to_i2c_client(dev);
754         struct adt7473_data *data = i2c_get_clientdata(client);
755         int temp = simple_strtol(buf, NULL, 10);
756
757         switch (temp) {
758         case 0:
759                 temp = 3;
760                 break;
761         case 1:
762                 temp = 7;
763                 break;
764         case 2:
765                 /* Enter automatic mode with fans off */
766                 temp = 4;
767                 break;
768         default:
769                 return -EINVAL;
770         }
771
772         mutex_lock(&data->lock);
773         reg = i2c_smbus_read_byte_data(client,
774                                        ADT7473_REG_PWM_BHVR(attr->index));
775         reg = (temp << ADT7473_PWM_BHVR_SHIFT) |
776               (reg & ~ADT7473_PWM_BHVR_MASK);
777         i2c_smbus_write_byte_data(client, ADT7473_REG_PWM_BHVR(attr->index),
778                                   reg);
779         data->pwm_behavior[attr->index] = reg;
780         mutex_unlock(&data->lock);
781
782         return count;
783 }
784
785 static ssize_t show_pwm_auto_temp(struct device *dev,
786                                   struct device_attribute *devattr,
787                                   char *buf)
788 {
789         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
790         struct adt7473_data *data = adt7473_update_device(dev);
791         int bhvr = data->pwm_behavior[attr->index] >> ADT7473_PWM_BHVR_SHIFT;
792
793         switch (bhvr) {
794         case 3:
795         case 4:
796         case 7:
797                 return sprintf(buf, "0\n");
798         case 0:
799         case 1:
800         case 5:
801         case 6:
802                 return sprintf(buf, "%d\n", bhvr + 1);
803         case 2:
804                 return sprintf(buf, "4\n");
805         }
806         /* shouldn't ever get here */
807         BUG();
808 }
809
810 static ssize_t set_pwm_auto_temp(struct device *dev,
811                                  struct device_attribute *devattr,
812                                  const char *buf,
813                                  size_t count)
814 {
815         u8 reg;
816         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
817         struct i2c_client *client = to_i2c_client(dev);
818         struct adt7473_data *data = i2c_get_clientdata(client);
819         int temp = simple_strtol(buf, NULL, 10);
820
821         switch (temp) {
822         case 1:
823         case 2:
824         case 6:
825         case 7:
826                 temp--;
827                 break;
828         case 0:
829                 temp = 4;
830                 break;
831         default:
832                 return -EINVAL;
833         }
834
835         mutex_lock(&data->lock);
836         reg = i2c_smbus_read_byte_data(client,
837                                        ADT7473_REG_PWM_BHVR(attr->index));
838         reg = (temp << ADT7473_PWM_BHVR_SHIFT) |
839               (reg & ~ADT7473_PWM_BHVR_MASK);
840         i2c_smbus_write_byte_data(client, ADT7473_REG_PWM_BHVR(attr->index),
841                                   reg);
842         data->pwm_behavior[attr->index] = reg;
843         mutex_unlock(&data->lock);
844
845         return count;
846 }
847
848 static ssize_t show_alarm(struct device *dev,
849                           struct device_attribute *devattr,
850                           char *buf)
851 {
852         struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
853         struct adt7473_data *data = adt7473_update_device(dev);
854
855         if (data->alarm & attr->index)
856                 return sprintf(buf, "1\n");
857         else
858                 return sprintf(buf, "0\n");
859 }
860
861
862 static SENSOR_DEVICE_ATTR(in1_max, S_IWUSR | S_IRUGO, show_volt_max,
863                           set_volt_max, 0);
864 static SENSOR_DEVICE_ATTR(in2_max, S_IWUSR | S_IRUGO, show_volt_max,
865                           set_volt_max, 1);
866
867 static SENSOR_DEVICE_ATTR(in1_min, S_IWUSR | S_IRUGO, show_volt_min,
868                           set_volt_min, 0);
869 static SENSOR_DEVICE_ATTR(in2_min, S_IWUSR | S_IRUGO, show_volt_min,
870                           set_volt_min, 1);
871
872 static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, show_volt, NULL, 0);
873 static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, show_volt, NULL, 1);
874
875 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL,
876                           ADT7473_VCCP_ALARM);
877 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL,
878                           ADT7473_VCC_ALARM);
879
880 static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_max,
881                           set_temp_max, 0);
882 static SENSOR_DEVICE_ATTR(temp2_max, S_IWUSR | S_IRUGO, show_temp_max,
883                           set_temp_max, 1);
884 static SENSOR_DEVICE_ATTR(temp3_max, S_IWUSR | S_IRUGO, show_temp_max,
885                           set_temp_max, 2);
886
887 static SENSOR_DEVICE_ATTR(temp1_min, S_IWUSR | S_IRUGO, show_temp_min,
888                           set_temp_min, 0);
889 static SENSOR_DEVICE_ATTR(temp2_min, S_IWUSR | S_IRUGO, show_temp_min,
890                           set_temp_min, 1);
891 static SENSOR_DEVICE_ATTR(temp3_min, S_IWUSR | S_IRUGO, show_temp_min,
892                           set_temp_min, 2);
893
894 static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
895 static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1);
896 static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2);
897
898 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL,
899                           ADT7473_R1T_ALARM | ALARM2(ADT7473_R1T_SHORT));
900 static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL,
901                           ADT7473_LT_ALARM);
902 static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL,
903                           ADT7473_R2T_ALARM | ALARM2(ADT7473_R2T_SHORT));
904
905 static SENSOR_DEVICE_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
906                           set_fan_min, 0);
907 static SENSOR_DEVICE_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
908                           set_fan_min, 1);
909 static SENSOR_DEVICE_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
910                           set_fan_min, 2);
911 static SENSOR_DEVICE_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
912                           set_fan_min, 3);
913
914 static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
915 static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
916 static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
917 static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3);
918
919 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL,
920                           ALARM2(ADT7473_FAN1_ALARM));
921 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL,
922                           ALARM2(ADT7473_FAN2_ALARM));
923 static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL,
924                           ALARM2(ADT7473_FAN3_ALARM));
925 static SENSOR_DEVICE_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL,
926                           ALARM2(ADT7473_FAN4_ALARM));
927
928 static SENSOR_DEVICE_ATTR(pwm_use_point2_pwm_at_crit, S_IWUSR | S_IRUGO,
929                           show_max_duty_at_crit, set_max_duty_at_crit, 0);
930
931 static SENSOR_DEVICE_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 0);
932 static SENSOR_DEVICE_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 1);
933 static SENSOR_DEVICE_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 2);
934
935 static SENSOR_DEVICE_ATTR(pwm1_auto_point1_pwm, S_IWUSR | S_IRUGO,
936                           show_pwm_min, set_pwm_min, 0);
937 static SENSOR_DEVICE_ATTR(pwm2_auto_point1_pwm, S_IWUSR | S_IRUGO,
938                           show_pwm_min, set_pwm_min, 1);
939 static SENSOR_DEVICE_ATTR(pwm3_auto_point1_pwm, S_IWUSR | S_IRUGO,
940                           show_pwm_min, set_pwm_min, 2);
941
942 static SENSOR_DEVICE_ATTR(pwm1_auto_point2_pwm, S_IWUSR | S_IRUGO,
943                           show_pwm_max, set_pwm_max, 0);
944 static SENSOR_DEVICE_ATTR(pwm2_auto_point2_pwm, S_IWUSR | S_IRUGO,
945                           show_pwm_max, set_pwm_max, 1);
946 static SENSOR_DEVICE_ATTR(pwm3_auto_point2_pwm, S_IWUSR | S_IRUGO,
947                           show_pwm_max, set_pwm_max, 2);
948
949 static SENSOR_DEVICE_ATTR(temp1_auto_point1_temp, S_IWUSR | S_IRUGO,
950                           show_temp_tmin, set_temp_tmin, 0);
951 static SENSOR_DEVICE_ATTR(temp2_auto_point1_temp, S_IWUSR | S_IRUGO,
952                           show_temp_tmin, set_temp_tmin, 1);
953 static SENSOR_DEVICE_ATTR(temp3_auto_point1_temp, S_IWUSR | S_IRUGO,
954                           show_temp_tmin, set_temp_tmin, 2);
955
956 static SENSOR_DEVICE_ATTR(temp1_auto_point2_temp, S_IWUSR | S_IRUGO,
957                           show_temp_tmax, set_temp_tmax, 0);
958 static SENSOR_DEVICE_ATTR(temp2_auto_point2_temp, S_IWUSR | S_IRUGO,
959                           show_temp_tmax, set_temp_tmax, 1);
960 static SENSOR_DEVICE_ATTR(temp3_auto_point2_temp, S_IWUSR | S_IRUGO,
961                           show_temp_tmax, set_temp_tmax, 2);
962
963 static SENSOR_DEVICE_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
964                           set_pwm_enable, 0);
965 static SENSOR_DEVICE_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
966                           set_pwm_enable, 1);
967 static SENSOR_DEVICE_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
968                           set_pwm_enable, 2);
969
970 static SENSOR_DEVICE_ATTR(pwm1_auto_channels_temp, S_IWUSR | S_IRUGO,
971                           show_pwm_auto_temp, set_pwm_auto_temp, 0);
972 static SENSOR_DEVICE_ATTR(pwm2_auto_channels_temp, S_IWUSR | S_IRUGO,
973                           show_pwm_auto_temp, set_pwm_auto_temp, 1);
974 static SENSOR_DEVICE_ATTR(pwm3_auto_channels_temp, S_IWUSR | S_IRUGO,
975                           show_pwm_auto_temp, set_pwm_auto_temp, 2);
976
977 static struct attribute *adt7473_attr[] =
978 {
979         &sensor_dev_attr_in1_max.dev_attr.attr,
980         &sensor_dev_attr_in2_max.dev_attr.attr,
981         &sensor_dev_attr_in1_min.dev_attr.attr,
982         &sensor_dev_attr_in2_min.dev_attr.attr,
983         &sensor_dev_attr_in1_input.dev_attr.attr,
984         &sensor_dev_attr_in2_input.dev_attr.attr,
985         &sensor_dev_attr_in1_alarm.dev_attr.attr,
986         &sensor_dev_attr_in2_alarm.dev_attr.attr,
987
988         &sensor_dev_attr_temp1_max.dev_attr.attr,
989         &sensor_dev_attr_temp2_max.dev_attr.attr,
990         &sensor_dev_attr_temp3_max.dev_attr.attr,
991         &sensor_dev_attr_temp1_min.dev_attr.attr,
992         &sensor_dev_attr_temp2_min.dev_attr.attr,
993         &sensor_dev_attr_temp3_min.dev_attr.attr,
994         &sensor_dev_attr_temp1_input.dev_attr.attr,
995         &sensor_dev_attr_temp2_input.dev_attr.attr,
996         &sensor_dev_attr_temp3_input.dev_attr.attr,
997         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
998         &sensor_dev_attr_temp2_alarm.dev_attr.attr,
999         &sensor_dev_attr_temp3_alarm.dev_attr.attr,
1000         &sensor_dev_attr_temp1_auto_point1_temp.dev_attr.attr,
1001         &sensor_dev_attr_temp2_auto_point1_temp.dev_attr.attr,
1002         &sensor_dev_attr_temp3_auto_point1_temp.dev_attr.attr,
1003         &sensor_dev_attr_temp1_auto_point2_temp.dev_attr.attr,
1004         &sensor_dev_attr_temp2_auto_point2_temp.dev_attr.attr,
1005         &sensor_dev_attr_temp3_auto_point2_temp.dev_attr.attr,
1006
1007         &sensor_dev_attr_fan1_min.dev_attr.attr,
1008         &sensor_dev_attr_fan2_min.dev_attr.attr,
1009         &sensor_dev_attr_fan3_min.dev_attr.attr,
1010         &sensor_dev_attr_fan4_min.dev_attr.attr,
1011         &sensor_dev_attr_fan1_input.dev_attr.attr,
1012         &sensor_dev_attr_fan2_input.dev_attr.attr,
1013         &sensor_dev_attr_fan3_input.dev_attr.attr,
1014         &sensor_dev_attr_fan4_input.dev_attr.attr,
1015         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
1016         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
1017         &sensor_dev_attr_fan3_alarm.dev_attr.attr,
1018         &sensor_dev_attr_fan4_alarm.dev_attr.attr,
1019
1020         &sensor_dev_attr_pwm_use_point2_pwm_at_crit.dev_attr.attr,
1021
1022         &sensor_dev_attr_pwm1.dev_attr.attr,
1023         &sensor_dev_attr_pwm2.dev_attr.attr,
1024         &sensor_dev_attr_pwm3.dev_attr.attr,
1025         &sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
1026         &sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
1027         &sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
1028         &sensor_dev_attr_pwm1_auto_point2_pwm.dev_attr.attr,
1029         &sensor_dev_attr_pwm2_auto_point2_pwm.dev_attr.attr,
1030         &sensor_dev_attr_pwm3_auto_point2_pwm.dev_attr.attr,
1031
1032         &sensor_dev_attr_pwm1_enable.dev_attr.attr,
1033         &sensor_dev_attr_pwm2_enable.dev_attr.attr,
1034         &sensor_dev_attr_pwm3_enable.dev_attr.attr,
1035         &sensor_dev_attr_pwm1_auto_channels_temp.dev_attr.attr,
1036         &sensor_dev_attr_pwm2_auto_channels_temp.dev_attr.attr,
1037         &sensor_dev_attr_pwm3_auto_channels_temp.dev_attr.attr,
1038
1039         NULL
1040 };
1041
1042 static int adt7473_attach_adapter(struct i2c_adapter *adapter)
1043 {
1044         if (!(adapter->class & I2C_CLASS_HWMON))
1045                 return 0;
1046         return i2c_probe(adapter, &addr_data, adt7473_detect);
1047 }
1048
1049 static int adt7473_detect(struct i2c_adapter *adapter, int address, int kind)
1050 {
1051         struct i2c_client *client;
1052         struct adt7473_data *data;
1053         int err = 0;
1054
1055         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1056                 goto exit;
1057
1058         data = kzalloc(sizeof(struct adt7473_data), GFP_KERNEL);
1059         if (!data) {
1060                 err = -ENOMEM;
1061                 goto exit;
1062         }
1063
1064         client = &data->client;
1065         client->addr = address;
1066         client->adapter = adapter;
1067         client->driver = &adt7473_driver;
1068
1069         i2c_set_clientdata(client, data);
1070
1071         mutex_init(&data->lock);
1072
1073         if (kind <= 0) {
1074                 int vendor, device, revision;
1075
1076                 vendor = i2c_smbus_read_byte_data(client, ADT7473_REG_VENDOR);
1077                 if (vendor != ADT7473_VENDOR) {
1078                         err = -ENODEV;
1079                         goto exit_free;
1080                 }
1081
1082                 device = i2c_smbus_read_byte_data(client, ADT7473_REG_DEVICE);
1083                 if (device != ADT7473_DEVICE) {
1084                         err = -ENODEV;
1085                         goto exit_free;
1086                 }
1087
1088                 revision = i2c_smbus_read_byte_data(client,
1089                                                     ADT7473_REG_REVISION);
1090                 if (revision != ADT7473_REV_68 && revision != ADT7473_REV_69) {
1091                         err = -ENODEV;
1092                         goto exit_free;
1093                 }
1094         } else
1095                 dev_dbg(&adapter->dev, "detection forced\n");
1096
1097         strlcpy(client->name, "adt7473", I2C_NAME_SIZE);
1098
1099         err = i2c_attach_client(client);
1100         if (err)
1101                 goto exit_free;
1102
1103         dev_info(&client->dev, "%s chip found\n", client->name);
1104
1105         /* Initialize the ADT7473 chip */
1106         adt7473_init_client(client);
1107
1108         /* Register sysfs hooks */
1109         data->attrs.attrs = adt7473_attr;
1110         err = sysfs_create_group(&client->dev.kobj, &data->attrs);
1111         if (err)
1112                 goto exit_detach;
1113
1114         data->hwmon_dev = hwmon_device_register(&client->dev);
1115         if (IS_ERR(data->hwmon_dev)) {
1116                 err = PTR_ERR(data->hwmon_dev);
1117                 goto exit_remove;
1118         }
1119
1120         return 0;
1121
1122 exit_remove:
1123         sysfs_remove_group(&client->dev.kobj, &data->attrs);
1124 exit_detach:
1125         i2c_detach_client(client);
1126 exit_free:
1127         kfree(data);
1128 exit:
1129         return err;
1130 }
1131
1132 static int adt7473_detach_client(struct i2c_client *client)
1133 {
1134         struct adt7473_data *data = i2c_get_clientdata(client);
1135
1136         hwmon_device_unregister(data->hwmon_dev);
1137         sysfs_remove_group(&client->dev.kobj, &data->attrs);
1138         i2c_detach_client(client);
1139         kfree(data);
1140         return 0;
1141 }
1142
1143 static int __init adt7473_init(void)
1144 {
1145         return i2c_add_driver(&adt7473_driver);
1146 }
1147
1148 static void __exit adt7473_exit(void)
1149 {
1150         i2c_del_driver(&adt7473_driver);
1151 }
1152
1153 MODULE_AUTHOR("Darrick J. Wong <djwong@us.ibm.com>");
1154 MODULE_DESCRIPTION("ADT7473 driver");
1155 MODULE_LICENSE("GPL");
1156
1157 module_init(adt7473_init);
1158 module_exit(adt7473_exit);