?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86: fix bootup crash in native_read_tsc()
[wrt350n-kernel.git] / drivers / hwmon / adm9240.c
blobc17d0b6b3283f306677b9107c711b2e02574ce69
1 /*
2 * adm9240.c Part of lm_sensors, Linux kernel modules for hardware
3 * monitoring
4 *
5 * Copyright (C) 1999 Frodo Looijaard <frodol@dds.nl>
6 * Philip Edelbrock <phil@netroedge.com>
7 * Copyright (C) 2003 Michiel Rook <michiel@grendelproject.nl>
8 * Copyright (C) 2005 Grant Coady <gcoady.lk@gmail.com> with valuable
9 * guidance from Jean Delvare
10 *
11 * Driver supports Analog Devices ADM9240
12 * Dallas Semiconductor DS1780
13 * National Semiconductor LM81
14 *
15 * ADM9240 is the reference, DS1780 and LM81 are register compatibles
16 *
17 * Voltage Six inputs are scaled by chip, VID also reported
18 * Temperature Chip temperature to 0.5'C, maximum and max_hysteris
19 * Fans 2 fans, low speed alarm, automatic fan clock divider
20 * Alarms 16-bit map of active alarms
21 * Analog Out 0..1250 mV output
22 *
23 * Chassis Intrusion: clear CI latch with 'echo 1 > chassis_clear'
24 *
25 * Test hardware: Intel SE440BX-2 desktop motherboard --Grant
26 *
27 * LM81 extended temp reading not implemented
28 *
29 * This program is free software; you can redistribute it and/or modify
30 * it under the terms of the GNU General Public License as published by
31 * the Free Software Foundation; either version 2 of the License, or
32 * (at your option) any later version.
33 *
34 * This program is distributed in the hope that it will be useful,
35 * but WITHOUT ANY WARRANTY; without even the implied warranty of
36 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
37 * GNU General Public License for more details.
38 *
39 * You should have received a copy of the GNU General Public License
40 * along with this program; if not, write to the Free Software
41 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
42 */
43
44 #include <linux/init.h>
45 #include <linux/module.h>
46 #include <linux/slab.h>
47 #include <linux/i2c.h>
48 #include <linux/hwmon-sysfs.h>
49 #include <linux/hwmon.h>
50 #include <linux/hwmon-vid.h>
51 #include <linux/err.h>
52 #include <linux/mutex.h>
53
54 /* Addresses to scan */
55 static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, 0x2f,
56 I2C_CLIENT_END };
57
58 /* Insmod parameters */
59 I2C_CLIENT_INSMOD_3(adm9240, ds1780, lm81);
60
61 /* ADM9240 registers */
62 #define ADM9240_REG_MAN_ID 0x3e
63 #define ADM9240_REG_DIE_REV 0x3f
64 #define ADM9240_REG_CONFIG 0x40
65
66 #define ADM9240_REG_IN(nr) (0x20 + (nr)) /* 0..5 */
67 #define ADM9240_REG_IN_MAX(nr) (0x2b + (nr) * 2)
68 #define ADM9240_REG_IN_MIN(nr) (0x2c + (nr) * 2)
69 #define ADM9240_REG_FAN(nr) (0x28 + (nr)) /* 0..1 */
70 #define ADM9240_REG_FAN_MIN(nr) (0x3b + (nr))
71 #define ADM9240_REG_INT(nr) (0x41 + (nr))
72 #define ADM9240_REG_INT_MASK(nr) (0x43 + (nr))
73 #define ADM9240_REG_TEMP 0x27
74 #define ADM9240_REG_TEMP_MAX(nr) (0x39 + (nr)) /* 0, 1 = high, hyst */
75 #define ADM9240_REG_ANALOG_OUT 0x19
76 #define ADM9240_REG_CHASSIS_CLEAR 0x46
77 #define ADM9240_REG_VID_FAN_DIV 0x47
78 #define ADM9240_REG_I2C_ADDR 0x48
79 #define ADM9240_REG_VID4 0x49
80 #define ADM9240_REG_TEMP_CONF 0x4b
81
82 /* generalised scaling with integer rounding */
83 static inline int SCALE(long val, int mul, int div)
84 {
85 if (val < 0)
86 return (val * mul - div / 2) / div;
87 else
88 return (val * mul + div / 2) / div;
89 }
90
91 /* adm9240 internally scales voltage measurements */
92 static const u16 nom_mv[] = { 2500, 2700, 3300, 5000, 12000, 2700 };
93
94 static inline unsigned int IN_FROM_REG(u8 reg, int n)
95 {
96 return SCALE(reg, nom_mv[n], 192);
97 }
98
99 static inline u8 IN_TO_REG(unsigned long val, int n)
100 {
101 return SENSORS_LIMIT(SCALE(val, 192, nom_mv[n]), 0, 255);
102 }
103
104 /* temperature range: -40..125, 127 disables temperature alarm */
105 static inline s8 TEMP_TO_REG(long val)
106 {
107 return SENSORS_LIMIT(SCALE(val, 1, 1000), -40, 127);
108 }
109
110 /* two fans, each with low fan speed limit */
111 static inline unsigned int FAN_FROM_REG(u8 reg, u8 div)
112 {
113 if (!reg) /* error */
114 return -1;
115
116 if (reg == 255)
117 return 0;
118
119 return SCALE(1350000, 1, reg * div);
120 }
121
122 /* analog out 0..1250mV */
123 static inline u8 AOUT_TO_REG(unsigned long val)
124 {
125 return SENSORS_LIMIT(SCALE(val, 255, 1250), 0, 255);
126 }
127
128 static inline unsigned int AOUT_FROM_REG(u8 reg)
129 {
130 return SCALE(reg, 1250, 255);
131 }
132
133 static int adm9240_attach_adapter(struct i2c_adapter *adapter);
134 static int adm9240_detect(struct i2c_adapter *adapter, int address, int kind);
135 static void adm9240_init_client(struct i2c_client *client);
136 static int adm9240_detach_client(struct i2c_client *client);
137 static struct adm9240_data *adm9240_update_device(struct device *dev);
138
139 /* driver data */
140 static struct i2c_driver adm9240_driver = {
141 .driver = {
142 .name = "adm9240",
143 },
144 .id = I2C_DRIVERID_ADM9240,
145 .attach_adapter = adm9240_attach_adapter,
146 .detach_client = adm9240_detach_client,
147 };
148
149 /* per client data */
150 struct adm9240_data {
151 enum chips type;
152 struct i2c_client client;
153 struct device *hwmon_dev;
154 struct mutex update_lock;
155 char valid;
156 unsigned long last_updated_measure;
157 unsigned long last_updated_config;
158
159 u8 in[6]; /* ro in0_input */
160 u8 in_max[6]; /* rw in0_max */
161 u8 in_min[6]; /* rw in0_min */
162 u8 fan[2]; /* ro fan1_input */
163 u8 fan_min[2]; /* rw fan1_min */
164 u8 fan_div[2]; /* rw fan1_div, read-only accessor */
165 s16 temp; /* ro temp1_input, 9-bit sign-extended */
166 s8 temp_max[2]; /* rw 0 -> temp_max, 1 -> temp_max_hyst */
167 u16 alarms; /* ro alarms */
168 u8 aout; /* rw aout_output */
169 u8 vid; /* ro vid */
170 u8 vrm; /* -- vrm set on startup, no accessor */
171 };
172
173 /*** sysfs accessors ***/
174
175 /* temperature */
176 static ssize_t show_temp(struct device *dev, struct device_attribute *dummy,
177 char *buf)
178 {
179 struct adm9240_data *data = adm9240_update_device(dev);
180 return sprintf(buf, "%d\n", data->temp * 500); /* 9-bit value */
181 }
182
183 static ssize_t show_max(struct device *dev, struct device_attribute *devattr,
184 char *buf)
185 {
186 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
187 struct adm9240_data *data = adm9240_update_device(dev);
188 return sprintf(buf, "%d\n", data->temp_max[attr->index] * 1000);
189 }
190
191 static ssize_t set_max(struct device *dev, struct device_attribute *devattr,
192 const char *buf, size_t count)
193 {
194 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
195 struct i2c_client *client = to_i2c_client(dev);
196 struct adm9240_data *data = i2c_get_clientdata(client);
197 long val = simple_strtol(buf, NULL, 10);
198
199 mutex_lock(&data->update_lock);
200 data->temp_max[attr->index] = TEMP_TO_REG(val);
201 i2c_smbus_write_byte_data(client, ADM9240_REG_TEMP_MAX(attr->index),
202 data->temp_max[attr->index]);
203 mutex_unlock(&data->update_lock);
204 return count;
205 }
206
207 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
208 static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO,
209 show_max, set_max, 0);
210 static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO,
211 show_max, set_max, 1);
212
213 /* voltage */
214 static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
215 char *buf)
216 {
217 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
218 struct adm9240_data *data = adm9240_update_device(dev);
219 return sprintf(buf, "%d\n", IN_FROM_REG(data->in[attr->index],
220 attr->index));
221 }
222
223 static ssize_t show_in_min(struct device *dev,
224 struct device_attribute *devattr, char *buf)
225 {
226 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
227 struct adm9240_data *data = adm9240_update_device(dev);
228 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[attr->index],
229 attr->index));
230 }
231
232 static ssize_t show_in_max(struct device *dev,
233 struct device_attribute *devattr, char *buf)
234 {
235 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
236 struct adm9240_data *data = adm9240_update_device(dev);
237 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[attr->index],
238 attr->index));
239 }
240
241 static ssize_t set_in_min(struct device *dev,
242 struct device_attribute *devattr,
243 const char *buf, size_t count)
244 {
245 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
246 struct i2c_client *client = to_i2c_client(dev);
247 struct adm9240_data *data = i2c_get_clientdata(client);
248 unsigned long val = simple_strtoul(buf, NULL, 10);
249
250 mutex_lock(&data->update_lock);
251 data->in_min[attr->index] = IN_TO_REG(val, attr->index);
252 i2c_smbus_write_byte_data(client, ADM9240_REG_IN_MIN(attr->index),
253 data->in_min[attr->index]);
254 mutex_unlock(&data->update_lock);
255 return count;
256 }
257
258 static ssize_t set_in_max(struct device *dev,
259 struct device_attribute *devattr,
260 const char *buf, size_t count)
261 {
262 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
263 struct i2c_client *client = to_i2c_client(dev);
264 struct adm9240_data *data = i2c_get_clientdata(client);
265 unsigned long val = simple_strtoul(buf, NULL, 10);
266
267 mutex_lock(&data->update_lock);
268 data->in_max[attr->index] = IN_TO_REG(val, attr->index);
269 i2c_smbus_write_byte_data(client, ADM9240_REG_IN_MAX(attr->index),
270 data->in_max[attr->index]);
271 mutex_unlock(&data->update_lock);
272 return count;
273 }
274
275 #define vin(nr) \
276 static SENSOR_DEVICE_ATTR(in##nr##_input, S_IRUGO, \
277 show_in, NULL, nr); \
278 static SENSOR_DEVICE_ATTR(in##nr##_min, S_IRUGO | S_IWUSR, \
279 show_in_min, set_in_min, nr); \
280 static SENSOR_DEVICE_ATTR(in##nr##_max, S_IRUGO | S_IWUSR, \
281 show_in_max, set_in_max, nr);
282
283 vin(0);
284 vin(1);
285 vin(2);
286 vin(3);
287 vin(4);
288 vin(5);
289
290 /* fans */
291 static ssize_t show_fan(struct device *dev,
292 struct device_attribute *devattr, char *buf)
293 {
294 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
295 struct adm9240_data *data = adm9240_update_device(dev);
296 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[attr->index],
297 1 << data->fan_div[attr->index]));
298 }
299
300 static ssize_t show_fan_min(struct device *dev,
301 struct device_attribute *devattr, char *buf)
302 {
303 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
304 struct adm9240_data *data = adm9240_update_device(dev);
305 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[attr->index],
306 1 << data->fan_div[attr->index]));
307 }
308
309 static ssize_t show_fan_div(struct device *dev,
310 struct device_attribute *devattr, char *buf)
311 {
312 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
313 struct adm9240_data *data = adm9240_update_device(dev);
314 return sprintf(buf, "%d\n", 1 << data->fan_div[attr->index]);
315 }
316
317 /* write new fan div, callers must hold data->update_lock */
318 static void adm9240_write_fan_div(struct i2c_client *client, int nr,
319 u8 fan_div)
320 {
321 u8 reg, old, shift = (nr + 2) * 2;
322
323 reg = i2c_smbus_read_byte_data(client, ADM9240_REG_VID_FAN_DIV);
324 old = (reg >> shift) & 3;
325 reg &= ~(3 << shift);
326 reg |= (fan_div << shift);
327 i2c_smbus_write_byte_data(client, ADM9240_REG_VID_FAN_DIV, reg);
328 dev_dbg(&client->dev, "fan%d clock divider changed from %u "
329 "to %u\n", nr + 1, 1 << old, 1 << fan_div);
330 }
331
332 /*
333 * set fan speed low limit:
334 *
335 * - value is zero: disable fan speed low limit alarm
336 *
337 * - value is below fan speed measurement range: enable fan speed low
338 * limit alarm to be asserted while fan speed too slow to measure
339 *
340 * - otherwise: select fan clock divider to suit fan speed low limit,
341 * measurement code may adjust registers to ensure fan speed reading
342 */
343 static ssize_t set_fan_min(struct device *dev,
344 struct device_attribute *devattr,
345 const char *buf, size_t count)
346 {
347 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
348 struct i2c_client *client = to_i2c_client(dev);
349 struct adm9240_data *data = i2c_get_clientdata(client);
350 unsigned long val = simple_strtoul(buf, NULL, 10);
351 int nr = attr->index;
352 u8 new_div;
353
354 mutex_lock(&data->update_lock);
355
356 if (!val) {
357 data->fan_min[nr] = 255;
358 new_div = data->fan_div[nr];
359
360 dev_dbg(&client->dev, "fan%u low limit set disabled\n",
361 nr + 1);
362
363 } else if (val < 1350000 / (8 * 254)) {
364 new_div = 3;
365 data->fan_min[nr] = 254;
366
367 dev_dbg(&client->dev, "fan%u low limit set minimum %u\n",
368 nr + 1, FAN_FROM_REG(254, 1 << new_div));
369
370 } else {
371 unsigned int new_min = 1350000 / val;
372
373 new_div = 0;
374 while (new_min > 192 && new_div < 3) {
375 new_div++;
376 new_min /= 2;
377 }
378 if (!new_min) /* keep > 0 */
379 new_min++;
380
381 data->fan_min[nr] = new_min;
382
383 dev_dbg(&client->dev, "fan%u low limit set fan speed %u\n",
384 nr + 1, FAN_FROM_REG(new_min, 1 << new_div));
385 }
386
387 if (new_div != data->fan_div[nr]) {
388 data->fan_div[nr] = new_div;
389 adm9240_write_fan_div(client, nr, new_div);
390 }
391 i2c_smbus_write_byte_data(client, ADM9240_REG_FAN_MIN(nr),
392 data->fan_min[nr]);
393
394 mutex_unlock(&data->update_lock);
395 return count;
396 }
397
398 #define fan(nr) \
399 static SENSOR_DEVICE_ATTR(fan##nr##_input, S_IRUGO, \
400 show_fan, NULL, nr - 1); \
401 static SENSOR_DEVICE_ATTR(fan##nr##_div, S_IRUGO, \
402 show_fan_div, NULL, nr - 1); \
403 static SENSOR_DEVICE_ATTR(fan##nr##_min, S_IRUGO | S_IWUSR, \
404 show_fan_min, set_fan_min, nr - 1);
405
406 fan(1);
407 fan(2);
408
409 /* alarms */
410 static ssize_t show_alarms(struct device *dev,
411 struct device_attribute *attr, char *buf)
412 {
413 struct adm9240_data *data = adm9240_update_device(dev);
414 return sprintf(buf, "%u\n", data->alarms);
415 }
416 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
417
418 /* vid */
419 static ssize_t show_vid(struct device *dev,
420 struct device_attribute *attr, char *buf)
421 {
422 struct adm9240_data *data = adm9240_update_device(dev);
423 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
424 }
425 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
426
427 /* analog output */
428 static ssize_t show_aout(struct device *dev,
429 struct device_attribute *attr, char *buf)
430 {
431 struct adm9240_data *data = adm9240_update_device(dev);
432 return sprintf(buf, "%d\n", AOUT_FROM_REG(data->aout));
433 }
434
435 static ssize_t set_aout(struct device *dev,
436 struct device_attribute *attr,
437 const char *buf, size_t count)
438 {
439 struct i2c_client *client = to_i2c_client(dev);
440 struct adm9240_data *data = i2c_get_clientdata(client);
441 unsigned long val = simple_strtol(buf, NULL, 10);
442
443 mutex_lock(&data->update_lock);
444 data->aout = AOUT_TO_REG(val);
445 i2c_smbus_write_byte_data(client, ADM9240_REG_ANALOG_OUT, data->aout);
446 mutex_unlock(&data->update_lock);
447 return count;
448 }
449 static DEVICE_ATTR(aout_output, S_IRUGO | S_IWUSR, show_aout, set_aout);
450
451 /* chassis_clear */
452 static ssize_t chassis_clear(struct device *dev,
453 struct device_attribute *attr,
454 const char *buf, size_t count)
455 {
456 struct i2c_client *client = to_i2c_client(dev);
457 unsigned long val = simple_strtol(buf, NULL, 10);
458
459 if (val == 1) {
460 i2c_smbus_write_byte_data(client,
461 ADM9240_REG_CHASSIS_CLEAR, 0x80);
462 dev_dbg(&client->dev, "chassis intrusion latch cleared\n");
463 }
464 return count;
465 }
466 static DEVICE_ATTR(chassis_clear, S_IWUSR, NULL, chassis_clear);
467
468 static struct attribute *adm9240_attributes[] = {
469 &sensor_dev_attr_in0_input.dev_attr.attr,
470 &sensor_dev_attr_in0_min.dev_attr.attr,
471 &sensor_dev_attr_in0_max.dev_attr.attr,
472 &sensor_dev_attr_in1_input.dev_attr.attr,
473 &sensor_dev_attr_in1_min.dev_attr.attr,
474 &sensor_dev_attr_in1_max.dev_attr.attr,
475 &sensor_dev_attr_in2_input.dev_attr.attr,
476 &sensor_dev_attr_in2_min.dev_attr.attr,
477 &sensor_dev_attr_in2_max.dev_attr.attr,
478 &sensor_dev_attr_in3_input.dev_attr.attr,
479 &sensor_dev_attr_in3_min.dev_attr.attr,
480 &sensor_dev_attr_in3_max.dev_attr.attr,
481 &sensor_dev_attr_in4_input.dev_attr.attr,
482 &sensor_dev_attr_in4_min.dev_attr.attr,
483 &sensor_dev_attr_in4_max.dev_attr.attr,
484 &sensor_dev_attr_in5_input.dev_attr.attr,
485 &sensor_dev_attr_in5_min.dev_attr.attr,
486 &sensor_dev_attr_in5_max.dev_attr.attr,
487 &dev_attr_temp1_input.attr,
488 &sensor_dev_attr_temp1_max.dev_attr.attr,
489 &sensor_dev_attr_temp1_max_hyst.dev_attr.attr,
490 &sensor_dev_attr_fan1_input.dev_attr.attr,
491 &sensor_dev_attr_fan1_div.dev_attr.attr,
492 &sensor_dev_attr_fan1_min.dev_attr.attr,
493 &sensor_dev_attr_fan2_input.dev_attr.attr,
494 &sensor_dev_attr_fan2_div.dev_attr.attr,
495 &sensor_dev_attr_fan2_min.dev_attr.attr,
496 &dev_attr_alarms.attr,
497 &dev_attr_aout_output.attr,
498 &dev_attr_chassis_clear.attr,
499 &dev_attr_cpu0_vid.attr,
500 NULL
501 };
502
503 static const struct attribute_group adm9240_group = {
504 .attrs = adm9240_attributes,
505 };
506
507
508 /*** sensor chip detect and driver install ***/
509
510 static int adm9240_detect(struct i2c_adapter *adapter, int address, int kind)
511 {
512 struct i2c_client *new_client;
513 struct adm9240_data *data;
514 int err = 0;
515 const char *name = "";
516 u8 man_id, die_rev;
517
518 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
519 goto exit;
520
521 if (!(data = kzalloc(sizeof(*data), GFP_KERNEL))) {
522 err = -ENOMEM;
523 goto exit;
524 }
525
526 new_client = &data->client;
527 i2c_set_clientdata(new_client, data);
528 new_client->addr = address;
529 new_client->adapter = adapter;
530 new_client->driver = &adm9240_driver;
531 new_client->flags = 0;
532
533 if (kind == 0) {
534 kind = adm9240;
535 }
536
537 if (kind < 0) {
538
539 /* verify chip: reg address should match i2c address */
540 if (i2c_smbus_read_byte_data(new_client, ADM9240_REG_I2C_ADDR)
541 != address) {
542 dev_err(&adapter->dev, "detect fail: address match, "
543 "0x%02x\n", address);
544 goto exit_free;
545 }
546
547 /* check known chip manufacturer */
548 man_id = i2c_smbus_read_byte_data(new_client,
549 ADM9240_REG_MAN_ID);
550 if (man_id == 0x23) {
551 kind = adm9240;
552 } else if (man_id == 0xda) {
553 kind = ds1780;
554 } else if (man_id == 0x01) {
555 kind = lm81;
556 } else {
557 dev_err(&adapter->dev, "detect fail: unknown manuf, "
558 "0x%02x\n", man_id);
559 goto exit_free;
560 }
561
562 /* successful detect, print chip info */
563 die_rev = i2c_smbus_read_byte_data(new_client,
564 ADM9240_REG_DIE_REV);
565 dev_info(&adapter->dev, "found %s revision %u\n",
566 man_id == 0x23 ? "ADM9240" :
567 man_id == 0xda ? "DS1780" : "LM81", die_rev);
568 }
569
570 /* either forced or detected chip kind */
571 if (kind == adm9240) {
572 name = "adm9240";
573 } else if (kind == ds1780) {
574 name = "ds1780";
575 } else if (kind == lm81) {
576 name = "lm81";
577 }
578
579 /* fill in the remaining client fields and attach */
580 strlcpy(new_client->name, name, I2C_NAME_SIZE);
581 data->type = kind;
582 mutex_init(&data->update_lock);
583
584 if ((err = i2c_attach_client(new_client)))
585 goto exit_free;
586
587 adm9240_init_client(new_client);
588
589 /* populate sysfs filesystem */
590 if ((err = sysfs_create_group(&new_client->dev.kobj, &adm9240_group)))
591 goto exit_detach;
592
593 data->hwmon_dev = hwmon_device_register(&new_client->dev);
594 if (IS_ERR(data->hwmon_dev)) {
595 err = PTR_ERR(data->hwmon_dev);
596 goto exit_remove;
597 }
598
599 return 0;
600
601 exit_remove:
602 sysfs_remove_group(&new_client->dev.kobj, &adm9240_group);
603 exit_detach:
604 i2c_detach_client(new_client);
605 exit_free:
606 kfree(data);
607 exit:
608 return err;
609 }
610
611 static int adm9240_attach_adapter(struct i2c_adapter *adapter)
612 {
613 if (!(adapter->class & I2C_CLASS_HWMON))
614 return 0;
615 return i2c_probe(adapter, &addr_data, adm9240_detect);
616 }
617
618 static int adm9240_detach_client(struct i2c_client *client)
619 {
620 struct adm9240_data *data = i2c_get_clientdata(client);
621 int err;
622
623 hwmon_device_unregister(data->hwmon_dev);
624 sysfs_remove_group(&client->dev.kobj, &adm9240_group);
625
626 if ((err = i2c_detach_client(client)))
627 return err;
628
629 kfree(data);
630 return 0;
631 }
632
633 static void adm9240_init_client(struct i2c_client *client)
634 {
635 struct adm9240_data *data = i2c_get_clientdata(client);
636 u8 conf = i2c_smbus_read_byte_data(client, ADM9240_REG_CONFIG);
637 u8 mode = i2c_smbus_read_byte_data(client, ADM9240_REG_TEMP_CONF) & 3;
638
639 data->vrm = vid_which_vrm(); /* need this to report vid as mV */
640
641 dev_info(&client->dev, "Using VRM: %d.%d\n", data->vrm / 10,
642 data->vrm % 10);
643
644 if (conf & 1) { /* measurement cycle running: report state */
645
646 dev_info(&client->dev, "status: config 0x%02x mode %u\n",
647 conf, mode);
648
649 } else { /* cold start: open limits before starting chip */
650 int i;
651
652 for (i = 0; i < 6; i++)
653 {
654 i2c_smbus_write_byte_data(client,
655 ADM9240_REG_IN_MIN(i), 0);
656 i2c_smbus_write_byte_data(client,
657 ADM9240_REG_IN_MAX(i), 255);
658 }
659 i2c_smbus_write_byte_data(client,
660 ADM9240_REG_FAN_MIN(0), 255);
661 i2c_smbus_write_byte_data(client,
662 ADM9240_REG_FAN_MIN(1), 255);
663 i2c_smbus_write_byte_data(client,
664 ADM9240_REG_TEMP_MAX(0), 127);
665 i2c_smbus_write_byte_data(client,
666 ADM9240_REG_TEMP_MAX(1), 127);
667
668 /* start measurement cycle */
669 i2c_smbus_write_byte_data(client, ADM9240_REG_CONFIG, 1);
670
671 dev_info(&client->dev, "cold start: config was 0x%02x "
672 "mode %u\n", conf, mode);
673 }
674 }
675
676 static struct adm9240_data *adm9240_update_device(struct device *dev)
677 {
678 struct i2c_client *client = to_i2c_client(dev);
679 struct adm9240_data *data = i2c_get_clientdata(client);
680 int i;
681
682 mutex_lock(&data->update_lock);
683
684 /* minimum measurement cycle: 1.75 seconds */
685 if (time_after(jiffies, data->last_updated_measure + (HZ * 7 / 4))
686 || !data->valid) {
687
688 for (i = 0; i < 6; i++) /* read voltages */
689 {
690 data->in[i] = i2c_smbus_read_byte_data(client,
691 ADM9240_REG_IN(i));
692 }
693 data->alarms = i2c_smbus_read_byte_data(client,
694 ADM9240_REG_INT(0)) |
695 i2c_smbus_read_byte_data(client,
696 ADM9240_REG_INT(1)) << 8;
697
698 /* read temperature: assume temperature changes less than
699 * 0.5'C per two measurement cycles thus ignore possible
700 * but unlikely aliasing error on lsb reading. --Grant */
701 data->temp = ((i2c_smbus_read_byte_data(client,
702 ADM9240_REG_TEMP) << 8) |
703 i2c_smbus_read_byte_data(client,
704 ADM9240_REG_TEMP_CONF)) / 128;
705
706 for (i = 0; i < 2; i++) /* read fans */
707 {
708 data->fan[i] = i2c_smbus_read_byte_data(client,
709 ADM9240_REG_FAN(i));
710
711 /* adjust fan clock divider on overflow */
712 if (data->valid && data->fan[i] == 255 &&
713 data->fan_div[i] < 3) {
714
715 adm9240_write_fan_div(client, i,
716 ++data->fan_div[i]);
717
718 /* adjust fan_min if active, but not to 0 */
719 if (data->fan_min[i] < 255 &&
720 data->fan_min[i] >= 2)
721 data->fan_min[i] /= 2;
722 }
723 }
724 data->last_updated_measure = jiffies;
725 }
726
727 /* minimum config reading cycle: 300 seconds */
728 if (time_after(jiffies, data->last_updated_config + (HZ * 300))
729 || !data->valid) {
730
731 for (i = 0; i < 6; i++)
732 {
733 data->in_min[i] = i2c_smbus_read_byte_data(client,
734 ADM9240_REG_IN_MIN(i));
735 data->in_max[i] = i2c_smbus_read_byte_data(client,
736 ADM9240_REG_IN_MAX(i));
737 }
738 for (i = 0; i < 2; i++)
739 {
740 data->fan_min[i] = i2c_smbus_read_byte_data(client,
741 ADM9240_REG_FAN_MIN(i));
742 }
743 data->temp_max[0] = i2c_smbus_read_byte_data(client,
744 ADM9240_REG_TEMP_MAX(0));
745 data->temp_max[1] = i2c_smbus_read_byte_data(client,
746 ADM9240_REG_TEMP_MAX(1));
747
748 /* read fan divs and 5-bit VID */
749 i = i2c_smbus_read_byte_data(client, ADM9240_REG_VID_FAN_DIV);
750 data->fan_div[0] = (i >> 4) & 3;
751 data->fan_div[1] = (i >> 6) & 3;
752 data->vid = i & 0x0f;
753 data->vid |= (i2c_smbus_read_byte_data(client,
754 ADM9240_REG_VID4) & 1) << 4;
755 /* read analog out */
756 data->aout = i2c_smbus_read_byte_data(client,
757 ADM9240_REG_ANALOG_OUT);
758
759 data->last_updated_config = jiffies;
760 data->valid = 1;
761 }
762 mutex_unlock(&data->update_lock);
763 return data;
764 }
765
766 static int __init sensors_adm9240_init(void)
767 {
768 return i2c_add_driver(&adm9240_driver);
769 }
770
771 static void __exit sensors_adm9240_exit(void)
772 {
773 i2c_del_driver(&adm9240_driver);
774 }
775
776 MODULE_AUTHOR("Michiel Rook <michiel@grendelproject.nl>, "
777 "Grant Coady <gcoady.lk@gmail.com> and others");
778 MODULE_DESCRIPTION("ADM9240/DS1780/LM81 driver");
779 MODULE_LICENSE("GPL");
780
781 module_init(sensors_adm9240_init);
782 module_exit(sensors_adm9240_exit);
783
WRT350N Kernel Patches