]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/hwmon/adm1031.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
[PATCH] 01/05 Implement generic dispatch queue
[mirror_ubuntu-artful-kernel.git] / drivers / hwmon / adm1031.c
1 /*
2 adm1031.c - Part of lm_sensors, Linux kernel modules for hardware
3 monitoring
4 Based on lm75.c and lm85.c
5 Supports adm1030 / adm1031
6 Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org>
7 Reworked by Jean Delvare <khali@linux-fr.org>
8
9 This program is free software; you can redistribute it and/or modify
10 it under the terms of the GNU General Public License as published by
11 the Free Software Foundation; either version 2 of the License, or
12 (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful,
15 but WITHOUT ANY WARRANTY; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License
20 along with this program; if not, write to the Free Software
21 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 */
23
24 #include <linux/module.h>
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <linux/jiffies.h>
28 #include <linux/i2c.h>
29 #include <linux/hwmon.h>
30 #include <linux/err.h>
31
32 /* Following macros takes channel parameter starting from 0 to 2 */
33 #define ADM1031_REG_FAN_SPEED(nr) (0x08 + (nr))
34 #define ADM1031_REG_FAN_DIV(nr) (0x20 + (nr))
35 #define ADM1031_REG_PWM (0x22)
36 #define ADM1031_REG_FAN_MIN(nr) (0x10 + (nr))
37
38 #define ADM1031_REG_TEMP_MAX(nr) (0x14 + 4*(nr))
39 #define ADM1031_REG_TEMP_MIN(nr) (0x15 + 4*(nr))
40 #define ADM1031_REG_TEMP_CRIT(nr) (0x16 + 4*(nr))
41
42 #define ADM1031_REG_TEMP(nr) (0xa + (nr))
43 #define ADM1031_REG_AUTO_TEMP(nr) (0x24 + (nr))
44
45 #define ADM1031_REG_STATUS(nr) (0x2 + (nr))
46
47 #define ADM1031_REG_CONF1 0x0
48 #define ADM1031_REG_CONF2 0x1
49 #define ADM1031_REG_EXT_TEMP 0x6
50
51 #define ADM1031_CONF1_MONITOR_ENABLE 0x01 /* Monitoring enable */
52 #define ADM1031_CONF1_PWM_INVERT 0x08 /* PWM Invert */
53 #define ADM1031_CONF1_AUTO_MODE 0x80 /* Auto FAN */
54
55 #define ADM1031_CONF2_PWM1_ENABLE 0x01
56 #define ADM1031_CONF2_PWM2_ENABLE 0x02
57 #define ADM1031_CONF2_TACH1_ENABLE 0x04
58 #define ADM1031_CONF2_TACH2_ENABLE 0x08
59 #define ADM1031_CONF2_TEMP_ENABLE(chan) (0x10 << (chan))
60
61 /* Addresses to scan */
62 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
63
64 /* Insmod parameters */
65 I2C_CLIENT_INSMOD_2(adm1030, adm1031);
66
67 typedef u8 auto_chan_table_t[8][2];
68
69 /* Each client has this additional data */
70 struct adm1031_data {
71 struct i2c_client client;
72 struct class_device *class_dev;
73 struct semaphore update_lock;
74 int chip_type;
75 char valid; /* !=0 if following fields are valid */
76 unsigned long last_updated; /* In jiffies */
77 /* The chan_select_table contains the possible configurations for
78 * auto fan control.
79 */
80 auto_chan_table_t *chan_select_table;
81 u16 alarm;
82 u8 conf1;
83 u8 conf2;
84 u8 fan[2];
85 u8 fan_div[2];
86 u8 fan_min[2];
87 u8 pwm[2];
88 u8 old_pwm[2];
89 s8 temp[3];
90 u8 ext_temp[3];
91 u8 auto_temp[3];
92 u8 auto_temp_min[3];
93 u8 auto_temp_off[3];
94 u8 auto_temp_max[3];
95 s8 temp_min[3];
96 s8 temp_max[3];
97 s8 temp_crit[3];
98 };
99
100 static int adm1031_attach_adapter(struct i2c_adapter *adapter);
101 static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind);
102 static void adm1031_init_client(struct i2c_client *client);
103 static int adm1031_detach_client(struct i2c_client *client);
104 static struct adm1031_data *adm1031_update_device(struct device *dev);
105
106 /* This is the driver that will be inserted */
107 static struct i2c_driver adm1031_driver = {
108 .owner = THIS_MODULE,
109 .name = "adm1031",
110 .flags = I2C_DF_NOTIFY,
111 .attach_adapter = adm1031_attach_adapter,
112 .detach_client = adm1031_detach_client,
113 };
114
115 static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg)
116 {
117 return i2c_smbus_read_byte_data(client, reg);
118 }
119
120 static inline int
121 adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value)
122 {
123 return i2c_smbus_write_byte_data(client, reg, value);
124 }
125
126
127 #define TEMP_TO_REG(val) (((val) < 0 ? ((val - 500) / 1000) : \
128 ((val + 500) / 1000)))
129
130 #define TEMP_FROM_REG(val) ((val) * 1000)
131
132 #define TEMP_FROM_REG_EXT(val, ext) (TEMP_FROM_REG(val) + (ext) * 125)
133
134 #define FAN_FROM_REG(reg, div) ((reg) ? (11250 * 60) / ((reg) * (div)) : 0)
135
136 static int FAN_TO_REG(int reg, int div)
137 {
138 int tmp;
139 tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div);
140 return tmp > 255 ? 255 : tmp;
141 }
142
143 #define FAN_DIV_FROM_REG(reg) (1<<(((reg)&0xc0)>>6))
144
145 #define PWM_TO_REG(val) (SENSORS_LIMIT((val), 0, 255) >> 4)
146 #define PWM_FROM_REG(val) ((val) << 4)
147
148 #define FAN_CHAN_FROM_REG(reg) (((reg) >> 5) & 7)
149 #define FAN_CHAN_TO_REG(val, reg) \
150 (((reg) & 0x1F) | (((val) << 5) & 0xe0))
151
152 #define AUTO_TEMP_MIN_TO_REG(val, reg) \
153 ((((val)/500) & 0xf8)|((reg) & 0x7))
154 #define AUTO_TEMP_RANGE_FROM_REG(reg) (5000 * (1<< ((reg)&0x7)))
155 #define AUTO_TEMP_MIN_FROM_REG(reg) (1000 * ((((reg) >> 3) & 0x1f) << 2))
156
157 #define AUTO_TEMP_MIN_FROM_REG_DEG(reg) ((((reg) >> 3) & 0x1f) << 2)
158
159 #define AUTO_TEMP_OFF_FROM_REG(reg) \
160 (AUTO_TEMP_MIN_FROM_REG(reg) - 5000)
161
162 #define AUTO_TEMP_MAX_FROM_REG(reg) \
163 (AUTO_TEMP_RANGE_FROM_REG(reg) + \
164 AUTO_TEMP_MIN_FROM_REG(reg))
165
166 static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm)
167 {
168 int ret;
169 int range = val - AUTO_TEMP_MIN_FROM_REG(reg);
170
171 range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm);
172 ret = ((reg & 0xf8) |
173 (range < 10000 ? 0 :
174 range < 20000 ? 1 :
175 range < 40000 ? 2 : range < 80000 ? 3 : 4));
176 return ret;
177 }
178
179 /* FAN auto control */
180 #define GET_FAN_AUTO_BITFIELD(data, idx) \
181 (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2]
182
183 /* The tables below contains the possible values for the auto fan
184 * control bitfields. the index in the table is the register value.
185 * MSb is the auto fan control enable bit, so the four first entries
186 * in the table disables auto fan control when both bitfields are zero.
187 */
188 static auto_chan_table_t auto_channel_select_table_adm1031 = {
189 {0, 0}, {0, 0}, {0, 0}, {0, 0},
190 {2 /*0b010 */ , 4 /*0b100 */ },
191 {2 /*0b010 */ , 2 /*0b010 */ },
192 {4 /*0b100 */ , 4 /*0b100 */ },
193 {7 /*0b111 */ , 7 /*0b111 */ },
194 };
195
196 static auto_chan_table_t auto_channel_select_table_adm1030 = {
197 {0, 0}, {0, 0}, {0, 0}, {0, 0},
198 {2 /*0b10 */ , 0},
199 {0xff /*invalid */ , 0},
200 {0xff /*invalid */ , 0},
201 {3 /*0b11 */ , 0},
202 };
203
204 /* That function checks if a bitfield is valid and returns the other bitfield
205 * nearest match if no exact match where found.
206 */
207 static int
208 get_fan_auto_nearest(struct adm1031_data *data,
209 int chan, u8 val, u8 reg, u8 * new_reg)
210 {
211 int i;
212 int first_match = -1, exact_match = -1;
213 u8 other_reg_val =
214 (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1];
215
216 if (val == 0) {
217 *new_reg = 0;
218 return 0;
219 }
220
221 for (i = 0; i < 8; i++) {
222 if ((val == (*data->chan_select_table)[i][chan]) &&
223 ((*data->chan_select_table)[i][chan ? 0 : 1] ==
224 other_reg_val)) {
225 /* We found an exact match */
226 exact_match = i;
227 break;
228 } else if (val == (*data->chan_select_table)[i][chan] &&
229 first_match == -1) {
230 /* Save the first match in case of an exact match has not been
231 * found
232 */
233 first_match = i;
234 }
235 }
236
237 if (exact_match >= 0) {
238 *new_reg = exact_match;
239 } else if (first_match >= 0) {
240 *new_reg = first_match;
241 } else {
242 return -EINVAL;
243 }
244 return 0;
245 }
246
247 static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr)
248 {
249 struct adm1031_data *data = adm1031_update_device(dev);
250 return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr));
251 }
252
253 static ssize_t
254 set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr)
255 {
256 struct i2c_client *client = to_i2c_client(dev);
257 struct adm1031_data *data = i2c_get_clientdata(client);
258 int val = simple_strtol(buf, NULL, 10);
259 u8 reg;
260 int ret;
261 u8 old_fan_mode;
262
263 old_fan_mode = data->conf1;
264
265 down(&data->update_lock);
266
267 if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, &reg))) {
268 up(&data->update_lock);
269 return ret;
270 }
271 if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^
272 (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) {
273 if (data->conf1 & ADM1031_CONF1_AUTO_MODE){
274 /* Switch to Auto Fan Mode
275 * Save PWM registers
276 * Set PWM registers to 33% Both */
277 data->old_pwm[0] = data->pwm[0];
278 data->old_pwm[1] = data->pwm[1];
279 adm1031_write_value(client, ADM1031_REG_PWM, 0x55);
280 } else {
281 /* Switch to Manual Mode */
282 data->pwm[0] = data->old_pwm[0];
283 data->pwm[1] = data->old_pwm[1];
284 /* Restore PWM registers */
285 adm1031_write_value(client, ADM1031_REG_PWM,
286 data->pwm[0] | (data->pwm[1] << 4));
287 }
288 }
289 data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1);
290 adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1);
291 up(&data->update_lock);
292 return count;
293 }
294
295 #define fan_auto_channel_offset(offset) \
296 static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
297 { \
298 return show_fan_auto_channel(dev, buf, offset - 1); \
299 } \
300 static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, \
301 const char *buf, size_t count) \
302 { \
303 return set_fan_auto_channel(dev, buf, count, offset - 1); \
304 } \
305 static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR, \
306 show_fan_auto_channel_##offset, \
307 set_fan_auto_channel_##offset)
308
309 fan_auto_channel_offset(1);
310 fan_auto_channel_offset(2);
311
312 /* Auto Temps */
313 static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr)
314 {
315 struct adm1031_data *data = adm1031_update_device(dev);
316 return sprintf(buf, "%d\n",
317 AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr]));
318 }
319 static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr)
320 {
321 struct adm1031_data *data = adm1031_update_device(dev);
322 return sprintf(buf, "%d\n",
323 AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr]));
324 }
325 static ssize_t
326 set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr)
327 {
328 struct i2c_client *client = to_i2c_client(dev);
329 struct adm1031_data *data = i2c_get_clientdata(client);
330 int val = simple_strtol(buf, NULL, 10);
331
332 down(&data->update_lock);
333 data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]);
334 adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
335 data->auto_temp[nr]);
336 up(&data->update_lock);
337 return count;
338 }
339 static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr)
340 {
341 struct adm1031_data *data = adm1031_update_device(dev);
342 return sprintf(buf, "%d\n",
343 AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr]));
344 }
345 static ssize_t
346 set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr)
347 {
348 struct i2c_client *client = to_i2c_client(dev);
349 struct adm1031_data *data = i2c_get_clientdata(client);
350 int val = simple_strtol(buf, NULL, 10);
351
352 down(&data->update_lock);
353 data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]);
354 adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr),
355 data->temp_max[nr]);
356 up(&data->update_lock);
357 return count;
358 }
359
360 #define auto_temp_reg(offset) \
361 static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf) \
362 { \
363 return show_auto_temp_off(dev, buf, offset - 1); \
364 } \
365 static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \
366 { \
367 return show_auto_temp_min(dev, buf, offset - 1); \
368 } \
369 static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \
370 { \
371 return show_auto_temp_max(dev, buf, offset - 1); \
372 } \
373 static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, \
374 const char *buf, size_t count) \
375 { \
376 return set_auto_temp_min(dev, buf, count, offset - 1); \
377 } \
378 static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, \
379 const char *buf, size_t count) \
380 { \
381 return set_auto_temp_max(dev, buf, count, offset - 1); \
382 } \
383 static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO, \
384 show_auto_temp_##offset##_off, NULL); \
385 static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR, \
386 show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\
387 static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR, \
388 show_auto_temp_##offset##_max, set_auto_temp_##offset##_max)
389
390 auto_temp_reg(1);
391 auto_temp_reg(2);
392 auto_temp_reg(3);
393
394 /* pwm */
395 static ssize_t show_pwm(struct device *dev, char *buf, int nr)
396 {
397 struct adm1031_data *data = adm1031_update_device(dev);
398 return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr]));
399 }
400 static ssize_t
401 set_pwm(struct device *dev, const char *buf, size_t count, int nr)
402 {
403 struct i2c_client *client = to_i2c_client(dev);
404 struct adm1031_data *data = i2c_get_clientdata(client);
405 int val = simple_strtol(buf, NULL, 10);
406 int reg;
407
408 down(&data->update_lock);
409 if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) &&
410 (((val>>4) & 0xf) != 5)) {
411 /* In automatic mode, the only PWM accepted is 33% */
412 up(&data->update_lock);
413 return -EINVAL;
414 }
415 data->pwm[nr] = PWM_TO_REG(val);
416 reg = adm1031_read_value(client, ADM1031_REG_PWM);
417 adm1031_write_value(client, ADM1031_REG_PWM,
418 nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf)
419 : (data->pwm[nr] & 0xf) | (reg & 0xf0));
420 up(&data->update_lock);
421 return count;
422 }
423
424 #define pwm_reg(offset) \
425 static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
426 { \
427 return show_pwm(dev, buf, offset - 1); \
428 } \
429 static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr, \
430 const char *buf, size_t count) \
431 { \
432 return set_pwm(dev, buf, count, offset - 1); \
433 } \
434 static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \
435 show_pwm_##offset, set_pwm_##offset)
436
437 pwm_reg(1);
438 pwm_reg(2);
439
440 /* Fans */
441
442 /*
443 * That function checks the cases where the fan reading is not
444 * relevant. It is used to provide 0 as fan reading when the fan is
445 * not supposed to run
446 */
447 static int trust_fan_readings(struct adm1031_data *data, int chan)
448 {
449 int res = 0;
450
451 if (data->conf1 & ADM1031_CONF1_AUTO_MODE) {
452 switch (data->conf1 & 0x60) {
453 case 0x00: /* remote temp1 controls fan1 remote temp2 controls fan2 */
454 res = data->temp[chan+1] >=
455 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]);
456 break;
457 case 0x20: /* remote temp1 controls both fans */
458 res =
459 data->temp[1] >=
460 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]);
461 break;
462 case 0x40: /* remote temp2 controls both fans */
463 res =
464 data->temp[2] >=
465 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]);
466 break;
467 case 0x60: /* max controls both fans */
468 res =
469 data->temp[0] >=
470 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0])
471 || data->temp[1] >=
472 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1])
473 || (data->chip_type == adm1031
474 && data->temp[2] >=
475 AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]));
476 break;
477 }
478 } else {
479 res = data->pwm[chan] > 0;
480 }
481 return res;
482 }
483
484
485 static ssize_t show_fan(struct device *dev, char *buf, int nr)
486 {
487 struct adm1031_data *data = adm1031_update_device(dev);
488 int value;
489
490 value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr],
491 FAN_DIV_FROM_REG(data->fan_div[nr])) : 0;
492 return sprintf(buf, "%d\n", value);
493 }
494
495 static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
496 {
497 struct adm1031_data *data = adm1031_update_device(dev);
498 return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr]));
499 }
500 static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
501 {
502 struct adm1031_data *data = adm1031_update_device(dev);
503 return sprintf(buf, "%d\n",
504 FAN_FROM_REG(data->fan_min[nr],
505 FAN_DIV_FROM_REG(data->fan_div[nr])));
506 }
507 static ssize_t
508 set_fan_min(struct device *dev, const char *buf, size_t count, int nr)
509 {
510 struct i2c_client *client = to_i2c_client(dev);
511 struct adm1031_data *data = i2c_get_clientdata(client);
512 int val = simple_strtol(buf, NULL, 10);
513
514 down(&data->update_lock);
515 if (val) {
516 data->fan_min[nr] =
517 FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr]));
518 } else {
519 data->fan_min[nr] = 0xff;
520 }
521 adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]);
522 up(&data->update_lock);
523 return count;
524 }
525 static ssize_t
526 set_fan_div(struct device *dev, const char *buf, size_t count, int nr)
527 {
528 struct i2c_client *client = to_i2c_client(dev);
529 struct adm1031_data *data = i2c_get_clientdata(client);
530 int val = simple_strtol(buf, NULL, 10);
531 u8 tmp;
532 int old_div;
533 int new_min;
534
535 tmp = val == 8 ? 0xc0 :
536 val == 4 ? 0x80 :
537 val == 2 ? 0x40 :
538 val == 1 ? 0x00 :
539 0xff;
540 if (tmp == 0xff)
541 return -EINVAL;
542
543 down(&data->update_lock);
544 old_div = FAN_DIV_FROM_REG(data->fan_div[nr]);
545 data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]);
546 new_min = data->fan_min[nr] * old_div /
547 FAN_DIV_FROM_REG(data->fan_div[nr]);
548 data->fan_min[nr] = new_min > 0xff ? 0xff : new_min;
549 data->fan[nr] = data->fan[nr] * old_div /
550 FAN_DIV_FROM_REG(data->fan_div[nr]);
551
552 adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr),
553 data->fan_div[nr]);
554 adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr),
555 data->fan_min[nr]);
556 up(&data->update_lock);
557 return count;
558 }
559
560 #define fan_offset(offset) \
561 static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
562 { \
563 return show_fan(dev, buf, offset - 1); \
564 } \
565 static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \
566 { \
567 return show_fan_min(dev, buf, offset - 1); \
568 } \
569 static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf) \
570 { \
571 return show_fan_div(dev, buf, offset - 1); \
572 } \
573 static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr, \
574 const char *buf, size_t count) \
575 { \
576 return set_fan_min(dev, buf, count, offset - 1); \
577 } \
578 static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr, \
579 const char *buf, size_t count) \
580 { \
581 return set_fan_div(dev, buf, count, offset - 1); \
582 } \
583 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset, \
584 NULL); \
585 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
586 show_fan_##offset##_min, set_fan_##offset##_min); \
587 static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
588 show_fan_##offset##_div, set_fan_##offset##_div); \
589 static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR, \
590 show_pwm_##offset, set_pwm_##offset)
591
592 fan_offset(1);
593 fan_offset(2);
594
595
596 /* Temps */
597 static ssize_t show_temp(struct device *dev, char *buf, int nr)
598 {
599 struct adm1031_data *data = adm1031_update_device(dev);
600 int ext;
601 ext = nr == 0 ?
602 ((data->ext_temp[nr] >> 6) & 0x3) * 2 :
603 (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7));
604 return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext));
605 }
606 static ssize_t show_temp_min(struct device *dev, char *buf, int nr)
607 {
608 struct adm1031_data *data = adm1031_update_device(dev);
609 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr]));
610 }
611 static ssize_t show_temp_max(struct device *dev, char *buf, int nr)
612 {
613 struct adm1031_data *data = adm1031_update_device(dev);
614 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr]));
615 }
616 static ssize_t show_temp_crit(struct device *dev, char *buf, int nr)
617 {
618 struct adm1031_data *data = adm1031_update_device(dev);
619 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr]));
620 }
621 static ssize_t
622 set_temp_min(struct device *dev, const char *buf, size_t count, int nr)
623 {
624 struct i2c_client *client = to_i2c_client(dev);
625 struct adm1031_data *data = i2c_get_clientdata(client);
626 int val;
627
628 val = simple_strtol(buf, NULL, 10);
629 val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
630 down(&data->update_lock);
631 data->temp_min[nr] = TEMP_TO_REG(val);
632 adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr),
633 data->temp_min[nr]);
634 up(&data->update_lock);
635 return count;
636 }
637 static ssize_t
638 set_temp_max(struct device *dev, const char *buf, size_t count, int nr)
639 {
640 struct i2c_client *client = to_i2c_client(dev);
641 struct adm1031_data *data = i2c_get_clientdata(client);
642 int val;
643
644 val = simple_strtol(buf, NULL, 10);
645 val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
646 down(&data->update_lock);
647 data->temp_max[nr] = TEMP_TO_REG(val);
648 adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr),
649 data->temp_max[nr]);
650 up(&data->update_lock);
651 return count;
652 }
653 static ssize_t
654 set_temp_crit(struct device *dev, const char *buf, size_t count, int nr)
655 {
656 struct i2c_client *client = to_i2c_client(dev);
657 struct adm1031_data *data = i2c_get_clientdata(client);
658 int val;
659
660 val = simple_strtol(buf, NULL, 10);
661 val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875);
662 down(&data->update_lock);
663 data->temp_crit[nr] = TEMP_TO_REG(val);
664 adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr),
665 data->temp_crit[nr]);
666 up(&data->update_lock);
667 return count;
668 }
669
670 #define temp_reg(offset) \
671 static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
672 { \
673 return show_temp(dev, buf, offset - 1); \
674 } \
675 static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \
676 { \
677 return show_temp_min(dev, buf, offset - 1); \
678 } \
679 static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \
680 { \
681 return show_temp_max(dev, buf, offset - 1); \
682 } \
683 static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf) \
684 { \
685 return show_temp_crit(dev, buf, offset - 1); \
686 } \
687 static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr, \
688 const char *buf, size_t count) \
689 { \
690 return set_temp_min(dev, buf, count, offset - 1); \
691 } \
692 static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr, \
693 const char *buf, size_t count) \
694 { \
695 return set_temp_max(dev, buf, count, offset - 1); \
696 } \
697 static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, \
698 const char *buf, size_t count) \
699 { \
700 return set_temp_crit(dev, buf, count, offset - 1); \
701 } \
702 static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset, \
703 NULL); \
704 static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \
705 show_temp_##offset##_min, set_temp_##offset##_min); \
706 static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
707 show_temp_##offset##_max, set_temp_##offset##_max); \
708 static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR, \
709 show_temp_##offset##_crit, set_temp_##offset##_crit)
710
711 temp_reg(1);
712 temp_reg(2);
713 temp_reg(3);
714
715 /* Alarms */
716 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
717 {
718 struct adm1031_data *data = adm1031_update_device(dev);
719 return sprintf(buf, "%d\n", data->alarm);
720 }
721
722 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
723
724
725 static int adm1031_attach_adapter(struct i2c_adapter *adapter)
726 {
727 if (!(adapter->class & I2C_CLASS_HWMON))
728 return 0;
729 return i2c_probe(adapter, &addr_data, adm1031_detect);
730 }
731
732 /* This function is called by i2c_probe */
733 static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind)
734 {
735 struct i2c_client *new_client;
736 struct adm1031_data *data;
737 int err = 0;
738 const char *name = "";
739
740 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
741 goto exit;
742
743 if (!(data = kmalloc(sizeof(struct adm1031_data), GFP_KERNEL))) {
744 err = -ENOMEM;
745 goto exit;
746 }
747 memset(data, 0, sizeof(struct adm1031_data));
748
749 new_client = &data->client;
750 i2c_set_clientdata(new_client, data);
751 new_client->addr = address;
752 new_client->adapter = adapter;
753 new_client->driver = &adm1031_driver;
754 new_client->flags = 0;
755
756 if (kind < 0) {
757 int id, co;
758 id = i2c_smbus_read_byte_data(new_client, 0x3d);
759 co = i2c_smbus_read_byte_data(new_client, 0x3e);
760
761 if (!((id == 0x31 || id == 0x30) && co == 0x41))
762 goto exit_free;
763 kind = (id == 0x30) ? adm1030 : adm1031;
764 }
765
766 if (kind <= 0)
767 kind = adm1031;
768
769 /* Given the detected chip type, set the chip name and the
770 * auto fan control helper table. */
771 if (kind == adm1030) {
772 name = "adm1030";
773 data->chan_select_table = &auto_channel_select_table_adm1030;
774 } else if (kind == adm1031) {
775 name = "adm1031";
776 data->chan_select_table = &auto_channel_select_table_adm1031;
777 }
778 data->chip_type = kind;
779
780 strlcpy(new_client->name, name, I2C_NAME_SIZE);
781 data->valid = 0;
782 init_MUTEX(&data->update_lock);
783
784 /* Tell the I2C layer a new client has arrived */
785 if ((err = i2c_attach_client(new_client)))
786 goto exit_free;
787
788 /* Initialize the ADM1031 chip */
789 adm1031_init_client(new_client);
790
791 /* Register sysfs hooks */
792 data->class_dev = hwmon_device_register(&new_client->dev);
793 if (IS_ERR(data->class_dev)) {
794 err = PTR_ERR(data->class_dev);
795 goto exit_detach;
796 }
797
798 device_create_file(&new_client->dev, &dev_attr_fan1_input);
799 device_create_file(&new_client->dev, &dev_attr_fan1_div);
800 device_create_file(&new_client->dev, &dev_attr_fan1_min);
801 device_create_file(&new_client->dev, &dev_attr_pwm1);
802 device_create_file(&new_client->dev, &dev_attr_auto_fan1_channel);
803 device_create_file(&new_client->dev, &dev_attr_temp1_input);
804 device_create_file(&new_client->dev, &dev_attr_temp1_min);
805 device_create_file(&new_client->dev, &dev_attr_temp1_max);
806 device_create_file(&new_client->dev, &dev_attr_temp1_crit);
807 device_create_file(&new_client->dev, &dev_attr_temp2_input);
808 device_create_file(&new_client->dev, &dev_attr_temp2_min);
809 device_create_file(&new_client->dev, &dev_attr_temp2_max);
810 device_create_file(&new_client->dev, &dev_attr_temp2_crit);
811
812 device_create_file(&new_client->dev, &dev_attr_auto_temp1_off);
813 device_create_file(&new_client->dev, &dev_attr_auto_temp1_min);
814 device_create_file(&new_client->dev, &dev_attr_auto_temp1_max);
815
816 device_create_file(&new_client->dev, &dev_attr_auto_temp2_off);
817 device_create_file(&new_client->dev, &dev_attr_auto_temp2_min);
818 device_create_file(&new_client->dev, &dev_attr_auto_temp2_max);
819
820 device_create_file(&new_client->dev, &dev_attr_auto_fan1_min_pwm);
821
822 device_create_file(&new_client->dev, &dev_attr_alarms);
823
824 if (kind == adm1031) {
825 device_create_file(&new_client->dev, &dev_attr_fan2_input);
826 device_create_file(&new_client->dev, &dev_attr_fan2_div);
827 device_create_file(&new_client->dev, &dev_attr_fan2_min);
828 device_create_file(&new_client->dev, &dev_attr_pwm2);
829 device_create_file(&new_client->dev,
830 &dev_attr_auto_fan2_channel);
831 device_create_file(&new_client->dev, &dev_attr_temp3_input);
832 device_create_file(&new_client->dev, &dev_attr_temp3_min);
833 device_create_file(&new_client->dev, &dev_attr_temp3_max);
834 device_create_file(&new_client->dev, &dev_attr_temp3_crit);
835 device_create_file(&new_client->dev, &dev_attr_auto_temp3_off);
836 device_create_file(&new_client->dev, &dev_attr_auto_temp3_min);
837 device_create_file(&new_client->dev, &dev_attr_auto_temp3_max);
838 device_create_file(&new_client->dev, &dev_attr_auto_fan2_min_pwm);
839 }
840
841 return 0;
842
843 exit_detach:
844 i2c_detach_client(new_client);
845 exit_free:
846 kfree(data);
847 exit:
848 return err;
849 }
850
851 static int adm1031_detach_client(struct i2c_client *client)
852 {
853 struct adm1031_data *data = i2c_get_clientdata(client);
854 int ret;
855
856 hwmon_device_unregister(data->class_dev);
857 if ((ret = i2c_detach_client(client)) != 0) {
858 return ret;
859 }
860 kfree(data);
861 return 0;
862 }
863
864 static void adm1031_init_client(struct i2c_client *client)
865 {
866 unsigned int read_val;
867 unsigned int mask;
868 struct adm1031_data *data = i2c_get_clientdata(client);
869
870 mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE);
871 if (data->chip_type == adm1031) {
872 mask |= (ADM1031_CONF2_PWM2_ENABLE |
873 ADM1031_CONF2_TACH2_ENABLE);
874 }
875 /* Initialize the ADM1031 chip (enables fan speed reading ) */
876 read_val = adm1031_read_value(client, ADM1031_REG_CONF2);
877 if ((read_val | mask) != read_val) {
878 adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask);
879 }
880
881 read_val = adm1031_read_value(client, ADM1031_REG_CONF1);
882 if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) {
883 adm1031_write_value(client, ADM1031_REG_CONF1, read_val |
884 ADM1031_CONF1_MONITOR_ENABLE);
885 }
886
887 }
888
889 static struct adm1031_data *adm1031_update_device(struct device *dev)
890 {
891 struct i2c_client *client = to_i2c_client(dev);
892 struct adm1031_data *data = i2c_get_clientdata(client);
893 int chan;
894
895 down(&data->update_lock);
896
897 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
898 || !data->valid) {
899
900 dev_dbg(&client->dev, "Starting adm1031 update\n");
901 for (chan = 0;
902 chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) {
903 u8 oldh, newh;
904
905 oldh =
906 adm1031_read_value(client, ADM1031_REG_TEMP(chan));
907 data->ext_temp[chan] =
908 adm1031_read_value(client, ADM1031_REG_EXT_TEMP);
909 newh =
910 adm1031_read_value(client, ADM1031_REG_TEMP(chan));
911 if (newh != oldh) {
912 data->ext_temp[chan] =
913 adm1031_read_value(client,
914 ADM1031_REG_EXT_TEMP);
915 #ifdef DEBUG
916 oldh =
917 adm1031_read_value(client,
918 ADM1031_REG_TEMP(chan));
919
920 /* oldh is actually newer */
921 if (newh != oldh)
922 dev_warn(&client->dev,
923 "Remote temperature may be "
924 "wrong.\n");
925 #endif
926 }
927 data->temp[chan] = newh;
928
929 data->temp_min[chan] =
930 adm1031_read_value(client,
931 ADM1031_REG_TEMP_MIN(chan));
932 data->temp_max[chan] =
933 adm1031_read_value(client,
934 ADM1031_REG_TEMP_MAX(chan));
935 data->temp_crit[chan] =
936 adm1031_read_value(client,
937 ADM1031_REG_TEMP_CRIT(chan));
938 data->auto_temp[chan] =
939 adm1031_read_value(client,
940 ADM1031_REG_AUTO_TEMP(chan));
941
942 }
943
944 data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1);
945 data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2);
946
947 data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0))
948 | (adm1031_read_value(client, ADM1031_REG_STATUS(1))
949 << 8);
950 if (data->chip_type == adm1030) {
951 data->alarm &= 0xc0ff;
952 }
953
954 for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) {
955 data->fan_div[chan] =
956 adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan));
957 data->fan_min[chan] =
958 adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan));
959 data->fan[chan] =
960 adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan));
961 data->pwm[chan] =
962 0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >>
963 (4*chan));
964 }
965 data->last_updated = jiffies;
966 data->valid = 1;
967 }
968
969 up(&data->update_lock);
970
971 return data;
972 }
973
974 static int __init sensors_adm1031_init(void)
975 {
976 return i2c_add_driver(&adm1031_driver);
977 }
978
979 static void __exit sensors_adm1031_exit(void)
980 {
981 i2c_del_driver(&adm1031_driver);
982 }
983
984 MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>");
985 MODULE_DESCRIPTION("ADM1031/ADM1030 driver");
986 MODULE_LICENSE("GPL");
987
988 module_init(sensors_adm1031_init);
989 module_exit(sensors_adm1031_exit);
Ubuntu Artful kernel mirror