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