?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
RTC: M48T35: new RTC driver
[linux/fpc-iii.git] / drivers / hwmon / adt7473.c
blob3a0b63136479d7c4c701dc8eb6e3652e033c1831
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_MIN_BASE_ADDR 0x46
43
44 #define ADT7473_REG_TEMP_BASE_ADDR 0x25
45 #define ADT7473_REG_TEMP_LIMITS_BASE_ADDR 0x4E
46 #define ADT7473_REG_TEMP_TMIN_BASE_ADDR 0x67
47 #define ADT7473_REG_TEMP_TMAX_BASE_ADDR 0x6A
48
49 #define ADT7473_REG_FAN_BASE_ADDR 0x28
50 #define ADT7473_REG_FAN_MIN_BASE_ADDR 0x54
51
52 #define ADT7473_REG_PWM_BASE_ADDR 0x30
53 #define ADT7473_REG_PWM_MIN_BASE_ADDR 0x64
54 #define ADT7473_REG_PWM_MAX_BASE_ADDR 0x38
55 #define ADT7473_REG_PWM_BHVR_BASE_ADDR 0x5C
56 #define ADT7473_PWM_BHVR_MASK 0xE0
57 #define ADT7473_PWM_BHVR_SHIFT 5
58
59 #define ADT7473_REG_CFG1 0x40
60 #define ADT7473_CFG1_START 0x01
61 #define ADT7473_CFG1_READY 0x04
62 #define ADT7473_REG_CFG2 0x73
63 #define ADT7473_REG_CFG3 0x78
64 #define ADT7473_REG_CFG4 0x7D
65 #define ADT7473_CFG4_MAX_DUTY_AT_OVT 0x08
66 #define ADT7473_REG_CFG5 0x7C
67 #define ADT7473_CFG5_TEMP_TWOS 0x01
68 #define ADT7473_CFG5_TEMP_OFFSET 0x02
69
70 #define ADT7473_REG_DEVICE 0x3D
71 #define ADT7473_VENDOR 0x41
72 #define ADT7473_REG_VENDOR 0x3E
73 #define ADT7473_DEVICE 0x73
74 #define ADT7473_REG_REVISION 0x3F
75 #define ADT7473_REV_68 0x68
76 #define ADT7473_REV_69 0x69
77
78 #define ADT7473_REG_ALARM1 0x41
79 #define ADT7473_VCCP_ALARM 0x02
80 #define ADT7473_VCC_ALARM 0x04
81 #define ADT7473_R1T_ALARM 0x10
82 #define ADT7473_LT_ALARM 0x20
83 #define ADT7473_R2T_ALARM 0x40
84 #define ADT7473_OOL 0x80
85 #define ADT7473_REG_ALARM2 0x42
86 #define ADT7473_OVT_ALARM 0x02
87 #define ADT7473_FAN1_ALARM 0x04
88 #define ADT7473_FAN2_ALARM 0x08
89 #define ADT7473_FAN3_ALARM 0x10
90 #define ADT7473_FAN4_ALARM 0x20
91 #define ADT7473_R1T_SHORT 0x40
92 #define ADT7473_R2T_SHORT 0x80
93
94 #define ALARM2(x) ((x) << 8)
95
96 #define ADT7473_VOLT_COUNT 2
97 #define ADT7473_REG_VOLT(x) (ADT7473_REG_VOLT_BASE_ADDR + (x))
98 #define ADT7473_REG_VOLT_MIN(x) (ADT7473_REG_VOLT_MIN_BASE_ADDR + ((x) * 2))
99 #define ADT7473_REG_VOLT_MAX(x) (ADT7473_REG_VOLT_MIN_BASE_ADDR + \
100 ((x) * 2) + 1)
101
102 #define ADT7473_TEMP_COUNT 3
103 #define ADT7473_REG_TEMP(x) (ADT7473_REG_TEMP_BASE_ADDR + (x))
104 #define ADT7473_REG_TEMP_MIN(x) (ADT7473_REG_TEMP_LIMITS_BASE_ADDR + ((x) * 2))
105 #define ADT7473_REG_TEMP_MAX(x) (ADT7473_REG_TEMP_LIMITS_BASE_ADDR + \
106 ((x) * 2) + 1)
107 #define ADT7473_REG_TEMP_TMIN(x) (ADT7473_REG_TEMP_TMIN_BASE_ADDR + (x))
108 #define ADT7473_REG_TEMP_TMAX(x) (ADT7473_REG_TEMP_TMAX_BASE_ADDR + (x))
109
110 #define ADT7473_FAN_COUNT 4
111 #define ADT7473_REG_FAN(x) (ADT7473_REG_FAN_BASE_ADDR + ((x) * 2))
112 #define ADT7473_REG_FAN_MIN(x) (ADT7473_REG_FAN_MIN_BASE_ADDR + ((x) * 2))
113
114 #define ADT7473_PWM_COUNT 3
115 #define ADT7473_REG_PWM(x) (ADT7473_REG_PWM_BASE_ADDR + (x))
116 #define ADT7473_REG_PWM_MAX(x) (ADT7473_REG_PWM_MAX_BASE_ADDR + (x))
117 #define ADT7473_REG_PWM_MIN(x) (ADT7473_REG_PWM_MIN_BASE_ADDR + (x))
118 #define ADT7473_REG_PWM_BHVR(x) (ADT7473_REG_PWM_BHVR_BASE_ADDR + (x))
119
120 /* How often do we reread sensors values? (In jiffies) */
121 #define SENSOR_REFRESH_INTERVAL (2 * HZ)
122
123 /* How often do we reread sensor limit values? (In jiffies) */
124 #define LIMIT_REFRESH_INTERVAL (60 * HZ)
125
126 /* datasheet says to divide this number by the fan reading to get fan rpm */
127 #define FAN_PERIOD_TO_RPM(x) ((90000 * 60) / (x))
128 #define FAN_RPM_TO_PERIOD FAN_PERIOD_TO_RPM
129 #define FAN_PERIOD_INVALID 65535
130 #define FAN_DATA_VALID(x) ((x) && (x) != FAN_PERIOD_INVALID)
131
132 struct adt7473_data {
133 struct device *hwmon_dev;
134 struct attribute_group attrs;
135 struct mutex lock;
136 char sensors_valid;
137 char limits_valid;
138 unsigned long sensors_last_updated; /* In jiffies */
139 unsigned long limits_last_updated; /* In jiffies */
140
141 u8 volt[ADT7473_VOLT_COUNT];
142 s8 volt_min[ADT7473_VOLT_COUNT];
143 s8 volt_max[ADT7473_VOLT_COUNT];
144
145 s8 temp[ADT7473_TEMP_COUNT];
146 s8 temp_min[ADT7473_TEMP_COUNT];
147 s8 temp_max[ADT7473_TEMP_COUNT];
148 s8 temp_tmin[ADT7473_TEMP_COUNT];
149 /* This is called the !THERM limit in the datasheet */
150 s8 temp_tmax[ADT7473_TEMP_COUNT];
151
152 u16 fan[ADT7473_FAN_COUNT];
153 u16 fan_min[ADT7473_FAN_COUNT];
154
155 u8 pwm[ADT7473_PWM_COUNT];
156 u8 pwm_max[ADT7473_PWM_COUNT];
157 u8 pwm_min[ADT7473_PWM_COUNT];
158 u8 pwm_behavior[ADT7473_PWM_COUNT];
159
160 u8 temp_twos_complement;
161 u8 temp_offset;
162
163 u16 alarm;
164 u8 max_duty_at_overheat;
165 };
166
167 static int adt7473_probe(struct i2c_client *client,
168 const struct i2c_device_id *id);
169 static int adt7473_detect(struct i2c_client *client, int kind,
170 struct i2c_board_info *info);
171 static int adt7473_remove(struct i2c_client *client);
172
173 static const struct i2c_device_id adt7473_id[] = {
174 { "adt7473", adt7473 },
175 { }
176 };
177 MODULE_DEVICE_TABLE(i2c, adt7473_id);
178
179 static struct i2c_driver adt7473_driver = {
180 .class = I2C_CLASS_HWMON,
181 .driver = {
182 .name = "adt7473",
183 },
184 .probe = adt7473_probe,
185 .remove = adt7473_remove,
186 .id_table = adt7473_id,
187 .detect = adt7473_detect,
188 .address_data = &addr_data,
189 };
190
191 /*
192 * 16-bit registers on the ADT7473 are low-byte first. The data sheet says
193 * that the low byte must be read before the high byte.
194 */
195 static inline int adt7473_read_word_data(struct i2c_client *client, u8 reg)
196 {
197 u16 foo;
198 foo = i2c_smbus_read_byte_data(client, reg);
199 foo |= ((u16)i2c_smbus_read_byte_data(client, reg + 1) << 8);
200 return foo;
201 }
202
203 static inline int adt7473_write_word_data(struct i2c_client *client, u8 reg,
204 u16 value)
205 {
206 return i2c_smbus_write_byte_data(client, reg, value & 0xFF)
207 && i2c_smbus_write_byte_data(client, reg + 1, value >> 8);
208 }
209
210 static void adt7473_init_client(struct i2c_client *client)
211 {
212 int reg = i2c_smbus_read_byte_data(client, ADT7473_REG_CFG1);
213
214 if (!(reg & ADT7473_CFG1_READY)) {
215 dev_err(&client->dev, "Chip not ready.\n");
216 } else {
217 /* start monitoring */
218 i2c_smbus_write_byte_data(client, ADT7473_REG_CFG1,
219 reg | ADT7473_CFG1_START);
220 }
221 }
222
223 static struct adt7473_data *adt7473_update_device(struct device *dev)
224 {
225 struct i2c_client *client = to_i2c_client(dev);
226 struct adt7473_data *data = i2c_get_clientdata(client);
227 unsigned long local_jiffies = jiffies;
228 u8 cfg;
229 int i;
230
231 mutex_lock(&data->lock);
232 if (time_before(local_jiffies, data->sensors_last_updated +
233 SENSOR_REFRESH_INTERVAL)
234 && data->sensors_valid)
235 goto no_sensor_update;
236
237 for (i = 0; i < ADT7473_VOLT_COUNT; i++)
238 data->volt[i] = i2c_smbus_read_byte_data(client,
239 ADT7473_REG_VOLT(i));
240
241 /* Determine temperature encoding */
242 cfg = i2c_smbus_read_byte_data(client, ADT7473_REG_CFG5);
243 data->temp_twos_complement = (cfg & ADT7473_CFG5_TEMP_TWOS);
244
245 /*
246 * What does this do? it implies a variable temperature sensor
247 * offset, but the datasheet doesn't say anything about this bit
248 * and other parts of the datasheet imply that "offset64" mode
249 * means that you shift temp values by -64 if the above bit was set.
250 */
251 data->temp_offset = (cfg & ADT7473_CFG5_TEMP_OFFSET);
252
253 for (i = 0; i < ADT7473_TEMP_COUNT; i++)
254 data->temp[i] = i2c_smbus_read_byte_data(client,
255 ADT7473_REG_TEMP(i));
256
257 for (i = 0; i < ADT7473_FAN_COUNT; i++)
258 data->fan[i] = adt7473_read_word_data(client,
259 ADT7473_REG_FAN(i));
260
261 for (i = 0; i < ADT7473_PWM_COUNT; i++)
262 data->pwm[i] = i2c_smbus_read_byte_data(client,
263 ADT7473_REG_PWM(i));
264
265 data->alarm = i2c_smbus_read_byte_data(client, ADT7473_REG_ALARM1);
266 if (data->alarm & ADT7473_OOL)
267 data->alarm |= ALARM2(i2c_smbus_read_byte_data(client,
268 ADT7473_REG_ALARM2));
269
270 data->sensors_last_updated = local_jiffies;
271 data->sensors_valid = 1;
272
273 no_sensor_update:
274 if (time_before(local_jiffies, data->limits_last_updated +
275 LIMIT_REFRESH_INTERVAL)
276 && data->limits_valid)
277 goto out;
278
279 for (i = 0; i < ADT7473_VOLT_COUNT; i++) {
280 data->volt_min[i] = i2c_smbus_read_byte_data(client,
281 ADT7473_REG_VOLT_MIN(i));
282 data->volt_max[i] = i2c_smbus_read_byte_data(client,
283 ADT7473_REG_VOLT_MAX(i));
284 }
285
286 for (i = 0; i < ADT7473_TEMP_COUNT; i++) {
287 data->temp_min[i] = i2c_smbus_read_byte_data(client,
288 ADT7473_REG_TEMP_MIN(i));
289 data->temp_max[i] = i2c_smbus_read_byte_data(client,
290 ADT7473_REG_TEMP_MAX(i));
291 data->temp_tmin[i] = i2c_smbus_read_byte_data(client,
292 ADT7473_REG_TEMP_TMIN(i));
293 data->temp_tmax[i] = i2c_smbus_read_byte_data(client,
294 ADT7473_REG_TEMP_TMAX(i));
295 }
296
297 for (i = 0; i < ADT7473_FAN_COUNT; i++)
298 data->fan_min[i] = adt7473_read_word_data(client,
299 ADT7473_REG_FAN_MIN(i));
300
301 for (i = 0; i < ADT7473_PWM_COUNT; i++) {
302 data->pwm_max[i] = i2c_smbus_read_byte_data(client,
303 ADT7473_REG_PWM_MAX(i));
304 data->pwm_min[i] = i2c_smbus_read_byte_data(client,
305 ADT7473_REG_PWM_MIN(i));
306 data->pwm_behavior[i] = i2c_smbus_read_byte_data(client,
307 ADT7473_REG_PWM_BHVR(i));
308 }
309
310 i = i2c_smbus_read_byte_data(client, ADT7473_REG_CFG4);
311 data->max_duty_at_overheat = !!(i & ADT7473_CFG4_MAX_DUTY_AT_OVT);
312
313 data->limits_last_updated = local_jiffies;
314 data->limits_valid = 1;
315
316 out:
317 mutex_unlock(&data->lock);
318 return data;
319 }
320
321 /*
322 * On this chip, voltages are given as a count of steps between a minimum
323 * and maximum voltage, not a direct voltage.
324 */
325 static const int volt_convert_table[][2] = {
326 {2997, 3},
327 {4395, 4},
328 };
329
330 static int decode_volt(int volt_index, u8 raw)
331 {
332 int cmax = volt_convert_table[volt_index][0];
333 int cmin = volt_convert_table[volt_index][1];
334 return ((raw * (cmax - cmin)) / 255) + cmin;
335 }
336
337 static u8 encode_volt(int volt_index, int cooked)
338 {
339 int cmax = volt_convert_table[volt_index][0];
340 int cmin = volt_convert_table[volt_index][1];
341 u8 x;
342
343 if (cooked > cmax)
344 cooked = cmax;
345 else if (cooked < cmin)
346 cooked = cmin;
347
348 x = ((cooked - cmin) * 255) / (cmax - cmin);
349
350 return x;
351 }
352
353 static ssize_t show_volt_min(struct device *dev,
354 struct device_attribute *devattr,
355 char *buf)
356 {
357 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
358 struct adt7473_data *data = adt7473_update_device(dev);
359 return sprintf(buf, "%d\n",
360 decode_volt(attr->index, data->volt_min[attr->index]));
361 }
362
363 static ssize_t set_volt_min(struct device *dev,
364 struct device_attribute *devattr,
365 const char *buf,
366 size_t count)
367 {
368 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
369 struct i2c_client *client = to_i2c_client(dev);
370 struct adt7473_data *data = i2c_get_clientdata(client);
371 int volt = encode_volt(attr->index, simple_strtol(buf, NULL, 10));
372
373 mutex_lock(&data->lock);
374 data->volt_min[attr->index] = volt;
375 i2c_smbus_write_byte_data(client, ADT7473_REG_VOLT_MIN(attr->index),
376 volt);
377 mutex_unlock(&data->lock);
378
379 return count;
380 }
381
382 static ssize_t show_volt_max(struct device *dev,
383 struct device_attribute *devattr,
384 char *buf)
385 {
386 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
387 struct adt7473_data *data = adt7473_update_device(dev);
388 return sprintf(buf, "%d\n",
389 decode_volt(attr->index, data->volt_max[attr->index]));
390 }
391
392 static ssize_t set_volt_max(struct device *dev,
393 struct device_attribute *devattr,
394 const char *buf,
395 size_t count)
396 {
397 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
398 struct i2c_client *client = to_i2c_client(dev);
399 struct adt7473_data *data = i2c_get_clientdata(client);
400 int volt = encode_volt(attr->index, simple_strtol(buf, NULL, 10));
401
402 mutex_lock(&data->lock);
403 data->volt_max[attr->index] = volt;
404 i2c_smbus_write_byte_data(client, ADT7473_REG_VOLT_MAX(attr->index),
405 volt);
406 mutex_unlock(&data->lock);
407
408 return count;
409 }
410
411 static ssize_t show_volt(struct device *dev, struct device_attribute *devattr,
412 char *buf)
413 {
414 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
415 struct adt7473_data *data = adt7473_update_device(dev);
416
417 return sprintf(buf, "%d\n",
418 decode_volt(attr->index, data->volt[attr->index]));
419 }
420
421 /*
422 * This chip can report temperature data either as a two's complement
423 * number in the range -128 to 127, or as an unsigned number that must
424 * be offset by 64.
425 */
426 static int decode_temp(u8 twos_complement, u8 raw)
427 {
428 return twos_complement ? (s8)raw : raw - 64;
429 }
430
431 static u8 encode_temp(u8 twos_complement, int cooked)
432 {
433 return twos_complement ? cooked & 0xFF : cooked + 64;
434 }
435
436 static ssize_t show_temp_min(struct device *dev,
437 struct device_attribute *devattr,
438 char *buf)
439 {
440 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
441 struct adt7473_data *data = adt7473_update_device(dev);
442 return sprintf(buf, "%d\n", 1000 * decode_temp(
443 data->temp_twos_complement,
444 data->temp_min[attr->index]));
445 }
446
447 static ssize_t set_temp_min(struct device *dev,
448 struct device_attribute *devattr,
449 const char *buf,
450 size_t count)
451 {
452 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
453 struct i2c_client *client = to_i2c_client(dev);
454 struct adt7473_data *data = i2c_get_clientdata(client);
455 int temp = simple_strtol(buf, NULL, 10) / 1000;
456 temp = encode_temp(data->temp_twos_complement, temp);
457
458 mutex_lock(&data->lock);
459 data->temp_min[attr->index] = temp;
460 i2c_smbus_write_byte_data(client, ADT7473_REG_TEMP_MIN(attr->index),
461 temp);
462 mutex_unlock(&data->lock);
463
464 return count;
465 }
466
467 static ssize_t show_temp_max(struct device *dev,
468 struct device_attribute *devattr,
469 char *buf)
470 {
471 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
472 struct adt7473_data *data = adt7473_update_device(dev);
473 return sprintf(buf, "%d\n", 1000 * decode_temp(
474 data->temp_twos_complement,
475 data->temp_max[attr->index]));
476 }
477
478 static ssize_t set_temp_max(struct device *dev,
479 struct device_attribute *devattr,
480 const char *buf,
481 size_t count)
482 {
483 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
484 struct i2c_client *client = to_i2c_client(dev);
485 struct adt7473_data *data = i2c_get_clientdata(client);
486 int temp = simple_strtol(buf, NULL, 10) / 1000;
487 temp = encode_temp(data->temp_twos_complement, temp);
488
489 mutex_lock(&data->lock);
490 data->temp_max[attr->index] = temp;
491 i2c_smbus_write_byte_data(client, ADT7473_REG_TEMP_MAX(attr->index),
492 temp);
493 mutex_unlock(&data->lock);
494
495 return count;
496 }
497
498 static ssize_t show_temp(struct device *dev, struct device_attribute *devattr,
499 char *buf)
500 {
501 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
502 struct adt7473_data *data = adt7473_update_device(dev);
503 return sprintf(buf, "%d\n", 1000 * decode_temp(
504 data->temp_twos_complement,
505 data->temp[attr->index]));
506 }
507
508 static ssize_t show_fan_min(struct device *dev,
509 struct device_attribute *devattr,
510 char *buf)
511 {
512 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
513 struct adt7473_data *data = adt7473_update_device(dev);
514
515 if (FAN_DATA_VALID(data->fan_min[attr->index]))
516 return sprintf(buf, "%d\n",
517 FAN_PERIOD_TO_RPM(data->fan_min[attr->index]));
518 else
519 return sprintf(buf, "0\n");
520 }
521
522 static ssize_t set_fan_min(struct device *dev,
523 struct device_attribute *devattr,
524 const char *buf, size_t count)
525 {
526 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
527 struct i2c_client *client = to_i2c_client(dev);
528 struct adt7473_data *data = i2c_get_clientdata(client);
529 int temp = simple_strtol(buf, NULL, 10);
530
531 if (!temp)
532 return -EINVAL;
533 temp = FAN_RPM_TO_PERIOD(temp);
534
535 mutex_lock(&data->lock);
536 data->fan_min[attr->index] = temp;
537 adt7473_write_word_data(client, ADT7473_REG_FAN_MIN(attr->index), temp);
538 mutex_unlock(&data->lock);
539
540 return count;
541 }
542
543 static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
544 char *buf)
545 {
546 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
547 struct adt7473_data *data = adt7473_update_device(dev);
548
549 if (FAN_DATA_VALID(data->fan[attr->index]))
550 return sprintf(buf, "%d\n",
551 FAN_PERIOD_TO_RPM(data->fan[attr->index]));
552 else
553 return sprintf(buf, "0\n");
554 }
555
556 static ssize_t show_max_duty_at_crit(struct device *dev,
557 struct device_attribute *devattr,
558 char *buf)
559 {
560 struct adt7473_data *data = adt7473_update_device(dev);
561 return sprintf(buf, "%d\n", data->max_duty_at_overheat);
562 }
563
564 static ssize_t set_max_duty_at_crit(struct device *dev,
565 struct device_attribute *devattr,
566 const char *buf,
567 size_t count)
568 {
569 u8 reg;
570 struct i2c_client *client = to_i2c_client(dev);
571 struct adt7473_data *data = i2c_get_clientdata(client);
572 int temp = simple_strtol(buf, NULL, 10);
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 /* Return 0 if detection is successful, -ENODEV otherwise */
1043 static int adt7473_detect(struct i2c_client *client, int kind,
1044 struct i2c_board_info *info)
1045 {
1046 struct i2c_adapter *adapter = client->adapter;
1047
1048 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1049 return -ENODEV;
1050
1051 if (kind <= 0) {
1052 int vendor, device, revision;
1053
1054 vendor = i2c_smbus_read_byte_data(client, ADT7473_REG_VENDOR);
1055 if (vendor != ADT7473_VENDOR)
1056 return -ENODEV;
1057
1058 device = i2c_smbus_read_byte_data(client, ADT7473_REG_DEVICE);
1059 if (device != ADT7473_DEVICE)
1060 return -ENODEV;
1061
1062 revision = i2c_smbus_read_byte_data(client,
1063 ADT7473_REG_REVISION);
1064 if (revision != ADT7473_REV_68 && revision != ADT7473_REV_69)
1065 return -ENODEV;
1066 } else
1067 dev_dbg(&adapter->dev, "detection forced\n");
1068
1069 strlcpy(info->type, "adt7473", I2C_NAME_SIZE);
1070
1071 return 0;
1072 }
1073
1074 static int adt7473_probe(struct i2c_client *client,
1075 const struct i2c_device_id *id)
1076 {
1077 struct adt7473_data *data;
1078 int err;
1079
1080 data = kzalloc(sizeof(struct adt7473_data), GFP_KERNEL);
1081 if (!data) {
1082 err = -ENOMEM;
1083 goto exit;
1084 }
1085
1086 i2c_set_clientdata(client, data);
1087 mutex_init(&data->lock);
1088
1089 dev_info(&client->dev, "%s chip found\n", client->name);
1090
1091 /* Initialize the ADT7473 chip */
1092 adt7473_init_client(client);
1093
1094 /* Register sysfs hooks */
1095 data->attrs.attrs = adt7473_attr;
1096 err = sysfs_create_group(&client->dev.kobj, &data->attrs);
1097 if (err)
1098 goto exit_free;
1099
1100 data->hwmon_dev = hwmon_device_register(&client->dev);
1101 if (IS_ERR(data->hwmon_dev)) {
1102 err = PTR_ERR(data->hwmon_dev);
1103 goto exit_remove;
1104 }
1105
1106 return 0;
1107
1108 exit_remove:
1109 sysfs_remove_group(&client->dev.kobj, &data->attrs);
1110 exit_free:
1111 kfree(data);
1112 exit:
1113 return err;
1114 }
1115
1116 static int adt7473_remove(struct i2c_client *client)
1117 {
1118 struct adt7473_data *data = i2c_get_clientdata(client);
1119
1120 hwmon_device_unregister(data->hwmon_dev);
1121 sysfs_remove_group(&client->dev.kobj, &data->attrs);
1122 kfree(data);
1123 return 0;
1124 }
1125
1126 static int __init adt7473_init(void)
1127 {
1128 return i2c_add_driver(&adt7473_driver);
1129 }
1130
1131 static void __exit adt7473_exit(void)
1132 {
1133 i2c_del_driver(&adt7473_driver);
1134 }
1135
1136 MODULE_AUTHOR("Darrick J. Wong <djwong@us.ibm.com>");
1137 MODULE_DESCRIPTION("ADT7473 driver");
1138 MODULE_LICENSE("GPL");
1139
1140 module_init(adt7473_init);
1141 module_exit(adt7473_exit);
Linux with added FPC-III support