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