1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/module.h>
23#include <linux/init.h>
24#include <linux/slab.h>
25#include <linux/jiffies.h>
26#include <linux/i2c.h>
27#include <linux/platform_device.h>
28#include <linux/ioport.h>
29#include <linux/hwmon.h>
30#include <linux/hwmon-vid.h>
31#include <linux/hwmon-sysfs.h>
32#include <linux/err.h>
33#include <linux/mutex.h>
34#include <asm/io.h>
35
36
37static struct platform_device *pdev;
38
39
40static const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d,
41 0x2e, 0x2f, I2C_CLIENT_END };
42static unsigned short isa_address = 0x290;
43
44
45I2C_CLIENT_INSMOD_2(lm78, lm79);
46
47
48
49
50#define LM78_EXTENT 8
51
52
53#define LM78_ADDR_REG_OFFSET 5
54#define LM78_DATA_REG_OFFSET 6
55
56
57#define LM78_REG_IN_MAX(nr) (0x2b + (nr) * 2)
58#define LM78_REG_IN_MIN(nr) (0x2c + (nr) * 2)
59#define LM78_REG_IN(nr) (0x20 + (nr))
60
61#define LM78_REG_FAN_MIN(nr) (0x3b + (nr))
62#define LM78_REG_FAN(nr) (0x28 + (nr))
63
64#define LM78_REG_TEMP 0x27
65#define LM78_REG_TEMP_OVER 0x39
66#define LM78_REG_TEMP_HYST 0x3a
67
68#define LM78_REG_ALARM1 0x41
69#define LM78_REG_ALARM2 0x42
70
71#define LM78_REG_VID_FANDIV 0x47
72
73#define LM78_REG_CONFIG 0x40
74#define LM78_REG_CHIPID 0x49
75#define LM78_REG_I2C_ADDR 0x48
76
77
78
79
80
81
82
83static inline u8 IN_TO_REG(unsigned long val)
84{
85 unsigned long nval = SENSORS_LIMIT(val, 0, 4080);
86 return (nval + 8) / 16;
87}
88#define IN_FROM_REG(val) ((val) * 16)
89
90static inline u8 FAN_TO_REG(long rpm, int div)
91{
92 if (rpm <= 0)
93 return 255;
94 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
95}
96
97static inline int FAN_FROM_REG(u8 val, int div)
98{
99 return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
100}
101
102
103
104static inline s8 TEMP_TO_REG(int val)
105{
106 int nval = SENSORS_LIMIT(val, -128000, 127000) ;
107 return nval<0 ? (nval-500)/1000 : (nval+500)/1000;
108}
109
110static inline int TEMP_FROM_REG(s8 val)
111{
112 return val * 1000;
113}
114
115#define DIV_FROM_REG(val) (1 << (val))
116
117struct lm78_data {
118 struct i2c_client *client;
119 struct device *hwmon_dev;
120 struct mutex lock;
121 enum chips type;
122
123
124 const char *name;
125 int isa_addr;
126
127 struct mutex update_lock;
128 char valid;
129 unsigned long last_updated;
130
131 u8 in[7];
132 u8 in_max[7];
133 u8 in_min[7];
134 u8 fan[3];
135 u8 fan_min[3];
136 s8 temp;
137 s8 temp_over;
138 s8 temp_hyst;
139 u8 fan_div[3];
140 u8 vid;
141 u16 alarms;
142};
143
144
145static int lm78_i2c_detect(struct i2c_client *client, int kind,
146 struct i2c_board_info *info);
147static int lm78_i2c_probe(struct i2c_client *client,
148 const struct i2c_device_id *id);
149static int lm78_i2c_remove(struct i2c_client *client);
150
151static int __devinit lm78_isa_probe(struct platform_device *pdev);
152static int __devexit lm78_isa_remove(struct platform_device *pdev);
153
154static int lm78_read_value(struct lm78_data *data, u8 reg);
155static int lm78_write_value(struct lm78_data *data, u8 reg, u8 value);
156static struct lm78_data *lm78_update_device(struct device *dev);
157static void lm78_init_device(struct lm78_data *data);
158
159
160static const struct i2c_device_id lm78_i2c_id[] = {
161 { "lm78", lm78 },
162 { "lm79", lm79 },
163 { }
164};
165MODULE_DEVICE_TABLE(i2c, lm78_i2c_id);
166
167static struct i2c_driver lm78_driver = {
168 .class = I2C_CLASS_HWMON,
169 .driver = {
170 .name = "lm78",
171 },
172 .probe = lm78_i2c_probe,
173 .remove = lm78_i2c_remove,
174 .id_table = lm78_i2c_id,
175 .detect = lm78_i2c_detect,
176 .address_data = &addr_data,
177};
178
179static struct platform_driver lm78_isa_driver = {
180 .driver = {
181 .owner = THIS_MODULE,
182 .name = "lm78",
183 },
184 .probe = lm78_isa_probe,
185 .remove = lm78_isa_remove,
186};
187
188
189
190static ssize_t show_in(struct device *dev, struct device_attribute *da,
191 char *buf)
192{
193 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
194 struct lm78_data *data = lm78_update_device(dev);
195 return sprintf(buf, "%d\n", IN_FROM_REG(data->in[attr->index]));
196}
197
198static ssize_t show_in_min(struct device *dev, struct device_attribute *da,
199 char *buf)
200{
201 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
202 struct lm78_data *data = lm78_update_device(dev);
203 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[attr->index]));
204}
205
206static ssize_t show_in_max(struct device *dev, struct device_attribute *da,
207 char *buf)
208{
209 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
210 struct lm78_data *data = lm78_update_device(dev);
211 return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[attr->index]));
212}
213
214static ssize_t set_in_min(struct device *dev, struct device_attribute *da,
215 const char *buf, size_t count)
216{
217 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
218 struct lm78_data *data = dev_get_drvdata(dev);
219 unsigned long val = simple_strtoul(buf, NULL, 10);
220 int nr = attr->index;
221
222 mutex_lock(&data->update_lock);
223 data->in_min[nr] = IN_TO_REG(val);
224 lm78_write_value(data, LM78_REG_IN_MIN(nr), data->in_min[nr]);
225 mutex_unlock(&data->update_lock);
226 return count;
227}
228
229static ssize_t set_in_max(struct device *dev, struct device_attribute *da,
230 const char *buf, size_t count)
231{
232 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
233 struct lm78_data *data = dev_get_drvdata(dev);
234 unsigned long val = simple_strtoul(buf, NULL, 10);
235 int nr = attr->index;
236
237 mutex_lock(&data->update_lock);
238 data->in_max[nr] = IN_TO_REG(val);
239 lm78_write_value(data, LM78_REG_IN_MAX(nr), data->in_max[nr]);
240 mutex_unlock(&data->update_lock);
241 return count;
242}
243
244#define show_in_offset(offset) \
245static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
246 show_in, NULL, offset); \
247static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
248 show_in_min, set_in_min, offset); \
249static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
250 show_in_max, set_in_max, offset);
251
252show_in_offset(0);
253show_in_offset(1);
254show_in_offset(2);
255show_in_offset(3);
256show_in_offset(4);
257show_in_offset(5);
258show_in_offset(6);
259
260
261static ssize_t show_temp(struct device *dev, struct device_attribute *da,
262 char *buf)
263{
264 struct lm78_data *data = lm78_update_device(dev);
265 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
266}
267
268static ssize_t show_temp_over(struct device *dev, struct device_attribute *da,
269 char *buf)
270{
271 struct lm78_data *data = lm78_update_device(dev);
272 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
273}
274
275static ssize_t set_temp_over(struct device *dev, struct device_attribute *da,
276 const char *buf, size_t count)
277{
278 struct lm78_data *data = dev_get_drvdata(dev);
279 long val = simple_strtol(buf, NULL, 10);
280
281 mutex_lock(&data->update_lock);
282 data->temp_over = TEMP_TO_REG(val);
283 lm78_write_value(data, LM78_REG_TEMP_OVER, data->temp_over);
284 mutex_unlock(&data->update_lock);
285 return count;
286}
287
288static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *da,
289 char *buf)
290{
291 struct lm78_data *data = lm78_update_device(dev);
292 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
293}
294
295static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *da,
296 const char *buf, size_t count)
297{
298 struct lm78_data *data = dev_get_drvdata(dev);
299 long val = simple_strtol(buf, NULL, 10);
300
301 mutex_lock(&data->update_lock);
302 data->temp_hyst = TEMP_TO_REG(val);
303 lm78_write_value(data, LM78_REG_TEMP_HYST, data->temp_hyst);
304 mutex_unlock(&data->update_lock);
305 return count;
306}
307
308static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
309static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
310 show_temp_over, set_temp_over);
311static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
312 show_temp_hyst, set_temp_hyst);
313
314
315static ssize_t show_fan(struct device *dev, struct device_attribute *da,
316 char *buf)
317{
318 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
319 struct lm78_data *data = lm78_update_device(dev);
320 int nr = attr->index;
321 return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
322 DIV_FROM_REG(data->fan_div[nr])) );
323}
324
325static ssize_t show_fan_min(struct device *dev, struct device_attribute *da,
326 char *buf)
327{
328 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
329 struct lm78_data *data = lm78_update_device(dev);
330 int nr = attr->index;
331 return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan_min[nr],
332 DIV_FROM_REG(data->fan_div[nr])) );
333}
334
335static ssize_t set_fan_min(struct device *dev, struct device_attribute *da,
336 const char *buf, size_t count)
337{
338 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
339 struct lm78_data *data = dev_get_drvdata(dev);
340 int nr = attr->index;
341 unsigned long val = simple_strtoul(buf, NULL, 10);
342
343 mutex_lock(&data->update_lock);
344 data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
345 lm78_write_value(data, LM78_REG_FAN_MIN(nr), data->fan_min[nr]);
346 mutex_unlock(&data->update_lock);
347 return count;
348}
349
350static ssize_t show_fan_div(struct device *dev, struct device_attribute *da,
351 char *buf)
352{
353 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
354 struct lm78_data *data = lm78_update_device(dev);
355 return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[attr->index]));
356}
357
358
359
360
361
362static ssize_t set_fan_div(struct device *dev, struct device_attribute *da,
363 const char *buf, size_t count)
364{
365 struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
366 struct lm78_data *data = dev_get_drvdata(dev);
367 int nr = attr->index;
368 unsigned long val = simple_strtoul(buf, NULL, 10);
369 unsigned long min;
370 u8 reg;
371
372 mutex_lock(&data->update_lock);
373 min = FAN_FROM_REG(data->fan_min[nr],
374 DIV_FROM_REG(data->fan_div[nr]));
375
376 switch (val) {
377 case 1: data->fan_div[nr] = 0; break;
378 case 2: data->fan_div[nr] = 1; break;
379 case 4: data->fan_div[nr] = 2; break;
380 case 8: data->fan_div[nr] = 3; break;
381 default:
382 dev_err(dev, "fan_div value %ld not "
383 "supported. Choose one of 1, 2, 4 or 8!\n", val);
384 mutex_unlock(&data->update_lock);
385 return -EINVAL;
386 }
387
388 reg = lm78_read_value(data, LM78_REG_VID_FANDIV);
389 switch (nr) {
390 case 0:
391 reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
392 break;
393 case 1:
394 reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
395 break;
396 }
397 lm78_write_value(data, LM78_REG_VID_FANDIV, reg);
398
399 data->fan_min[nr] =
400 FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
401 lm78_write_value(data, LM78_REG_FAN_MIN(nr), data->fan_min[nr]);
402 mutex_unlock(&data->update_lock);
403
404 return count;
405}
406
407#define show_fan_offset(offset) \
408static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
409 show_fan, NULL, offset - 1); \
410static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
411 show_fan_min, set_fan_min, offset - 1);
412
413show_fan_offset(1);
414show_fan_offset(2);
415show_fan_offset(3);
416
417
418static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
419 show_fan_div, set_fan_div, 0);
420static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
421 show_fan_div, set_fan_div, 1);
422static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2);
423
424
425static ssize_t show_vid(struct device *dev, struct device_attribute *da,
426 char *buf)
427{
428 struct lm78_data *data = lm78_update_device(dev);
429 return sprintf(buf, "%d\n", vid_from_reg(data->vid, 82));
430}
431static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
432
433
434static ssize_t show_alarms(struct device *dev, struct device_attribute *da,
435 char *buf)
436{
437 struct lm78_data *data = lm78_update_device(dev);
438 return sprintf(buf, "%u\n", data->alarms);
439}
440static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
441
442static ssize_t show_alarm(struct device *dev, struct device_attribute *da,
443 char *buf)
444{
445 struct lm78_data *data = lm78_update_device(dev);
446 int nr = to_sensor_dev_attr(da)->index;
447 return sprintf(buf, "%u\n", (data->alarms >> nr) & 1);
448}
449static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
450static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
451static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
452static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
453static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
454static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
455static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
456static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
457static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
458static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
459static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
460
461static struct attribute *lm78_attributes[] = {
462 &sensor_dev_attr_in0_input.dev_attr.attr,
463 &sensor_dev_attr_in0_min.dev_attr.attr,
464 &sensor_dev_attr_in0_max.dev_attr.attr,
465 &sensor_dev_attr_in0_alarm.dev_attr.attr,
466 &sensor_dev_attr_in1_input.dev_attr.attr,
467 &sensor_dev_attr_in1_min.dev_attr.attr,
468 &sensor_dev_attr_in1_max.dev_attr.attr,
469 &sensor_dev_attr_in1_alarm.dev_attr.attr,
470 &sensor_dev_attr_in2_input.dev_attr.attr,
471 &sensor_dev_attr_in2_min.dev_attr.attr,
472 &sensor_dev_attr_in2_max.dev_attr.attr,
473 &sensor_dev_attr_in2_alarm.dev_attr.attr,
474 &sensor_dev_attr_in3_input.dev_attr.attr,
475 &sensor_dev_attr_in3_min.dev_attr.attr,
476 &sensor_dev_attr_in3_max.dev_attr.attr,
477 &sensor_dev_attr_in3_alarm.dev_attr.attr,
478 &sensor_dev_attr_in4_input.dev_attr.attr,
479 &sensor_dev_attr_in4_min.dev_attr.attr,
480 &sensor_dev_attr_in4_max.dev_attr.attr,
481 &sensor_dev_attr_in4_alarm.dev_attr.attr,
482 &sensor_dev_attr_in5_input.dev_attr.attr,
483 &sensor_dev_attr_in5_min.dev_attr.attr,
484 &sensor_dev_attr_in5_max.dev_attr.attr,
485 &sensor_dev_attr_in5_alarm.dev_attr.attr,
486 &sensor_dev_attr_in6_input.dev_attr.attr,
487 &sensor_dev_attr_in6_min.dev_attr.attr,
488 &sensor_dev_attr_in6_max.dev_attr.attr,
489 &sensor_dev_attr_in6_alarm.dev_attr.attr,
490 &dev_attr_temp1_input.attr,
491 &dev_attr_temp1_max.attr,
492 &dev_attr_temp1_max_hyst.attr,
493 &sensor_dev_attr_temp1_alarm.dev_attr.attr,
494 &sensor_dev_attr_fan1_input.dev_attr.attr,
495 &sensor_dev_attr_fan1_min.dev_attr.attr,
496 &sensor_dev_attr_fan1_div.dev_attr.attr,
497 &sensor_dev_attr_fan1_alarm.dev_attr.attr,
498 &sensor_dev_attr_fan2_input.dev_attr.attr,
499 &sensor_dev_attr_fan2_min.dev_attr.attr,
500 &sensor_dev_attr_fan2_div.dev_attr.attr,
501 &sensor_dev_attr_fan2_alarm.dev_attr.attr,
502 &sensor_dev_attr_fan3_input.dev_attr.attr,
503 &sensor_dev_attr_fan3_min.dev_attr.attr,
504 &sensor_dev_attr_fan3_div.dev_attr.attr,
505 &sensor_dev_attr_fan3_alarm.dev_attr.attr,
506 &dev_attr_alarms.attr,
507 &dev_attr_cpu0_vid.attr,
508
509 NULL
510};
511
512static const struct attribute_group lm78_group = {
513 .attrs = lm78_attributes,
514};
515
516
517
518static ssize_t show_name(struct device *dev, struct device_attribute
519 *devattr, char *buf)
520{
521 struct lm78_data *data = dev_get_drvdata(dev);
522
523 return sprintf(buf, "%s\n", data->name);
524}
525static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
526
527
528static int lm78_alias_detect(struct i2c_client *client, u8 chipid)
529{
530 struct lm78_data *isa;
531 int i;
532
533 if (!pdev)
534 return 0;
535 isa = platform_get_drvdata(pdev);
536
537 if (lm78_read_value(isa, LM78_REG_I2C_ADDR) != client->addr)
538 return 0;
539 if ((lm78_read_value(isa, LM78_REG_CHIPID) & 0xfe) != (chipid & 0xfe))
540 return 0;
541
542
543
544 for (i = 0x2b; i <= 0x3d; i++) {
545 if (lm78_read_value(isa, i) !=
546 i2c_smbus_read_byte_data(client, i))
547 return 0;
548 }
549 if (lm78_read_value(isa, LM78_REG_CONFIG) !=
550 i2c_smbus_read_byte_data(client, LM78_REG_CONFIG))
551 return 0;
552 for (i = 0x43; i <= 0x46; i++) {
553 if (lm78_read_value(isa, i) !=
554 i2c_smbus_read_byte_data(client, i))
555 return 0;
556 }
557
558 return 1;
559}
560
561static int lm78_i2c_detect(struct i2c_client *client, int kind,
562 struct i2c_board_info *info)
563{
564 int i;
565 struct lm78_data *isa = pdev ? platform_get_drvdata(pdev) : NULL;
566 const char *client_name;
567 struct i2c_adapter *adapter = client->adapter;
568 int address = client->addr;
569
570 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
571 return -ENODEV;
572
573
574
575
576 if (isa)
577 mutex_lock(&isa->update_lock);
578
579 if (kind < 0) {
580 if ((i2c_smbus_read_byte_data(client, LM78_REG_CONFIG) & 0x80)
581 || i2c_smbus_read_byte_data(client, LM78_REG_I2C_ADDR)
582 != address)
583 goto err_nodev;
584
585
586 i = i2c_smbus_read_byte_data(client, 0x4f);
587 if (i == 0xa3 || i == 0x5c)
588 goto err_nodev;
589 }
590
591
592 if (kind <= 0) {
593 i = i2c_smbus_read_byte_data(client, LM78_REG_CHIPID);
594 if (i == 0x00 || i == 0x20
595 || i == 0x40)
596 kind = lm78;
597 else if ((i & 0xfe) == 0xc0)
598 kind = lm79;
599 else {
600 if (kind == 0)
601 dev_warn(&adapter->dev, "Ignoring 'force' "
602 "parameter for unknown chip at "
603 "adapter %d, address 0x%02x\n",
604 i2c_adapter_id(adapter), address);
605 goto err_nodev;
606 }
607
608 if (lm78_alias_detect(client, i)) {
609 dev_dbg(&adapter->dev, "Device at 0x%02x appears to "
610 "be the same as ISA device\n", address);
611 goto err_nodev;
612 }
613 }
614
615 if (isa)
616 mutex_unlock(&isa->update_lock);
617
618 switch (kind) {
619 case lm79:
620 client_name = "lm79";
621 break;
622 default:
623 client_name = "lm78";
624 }
625 strlcpy(info->type, client_name, I2C_NAME_SIZE);
626
627 return 0;
628
629 err_nodev:
630 if (isa)
631 mutex_unlock(&isa->update_lock);
632 return -ENODEV;
633}
634
635static int lm78_i2c_probe(struct i2c_client *client,
636 const struct i2c_device_id *id)
637{
638 struct lm78_data *data;
639 int err;
640
641 data = kzalloc(sizeof(struct lm78_data), GFP_KERNEL);
642 if (!data)
643 return -ENOMEM;
644
645 i2c_set_clientdata(client, data);
646 data->client = client;
647 data->type = id->driver_data;
648
649
650 lm78_init_device(data);
651
652
653 err = sysfs_create_group(&client->dev.kobj, &lm78_group);
654 if (err)
655 goto ERROR3;
656
657 data->hwmon_dev = hwmon_device_register(&client->dev);
658 if (IS_ERR(data->hwmon_dev)) {
659 err = PTR_ERR(data->hwmon_dev);
660 goto ERROR4;
661 }
662
663 return 0;
664
665ERROR4:
666 sysfs_remove_group(&client->dev.kobj, &lm78_group);
667ERROR3:
668 kfree(data);
669 return err;
670}
671
672static int lm78_i2c_remove(struct i2c_client *client)
673{
674 struct lm78_data *data = i2c_get_clientdata(client);
675
676 hwmon_device_unregister(data->hwmon_dev);
677 sysfs_remove_group(&client->dev.kobj, &lm78_group);
678 kfree(data);
679
680 return 0;
681}
682
683static int __devinit lm78_isa_probe(struct platform_device *pdev)
684{
685 int err;
686 struct lm78_data *data;
687 struct resource *res;
688
689
690 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
691 if (!request_region(res->start + LM78_ADDR_REG_OFFSET, 2, "lm78")) {
692 err = -EBUSY;
693 goto exit;
694 }
695
696 if (!(data = kzalloc(sizeof(struct lm78_data), GFP_KERNEL))) {
697 err = -ENOMEM;
698 goto exit_release_region;
699 }
700 mutex_init(&data->lock);
701 data->isa_addr = res->start;
702 platform_set_drvdata(pdev, data);
703
704 if (lm78_read_value(data, LM78_REG_CHIPID) & 0x80) {
705 data->type = lm79;
706 data->name = "lm79";
707 } else {
708 data->type = lm78;
709 data->name = "lm78";
710 }
711
712
713 lm78_init_device(data);
714
715
716 if ((err = sysfs_create_group(&pdev->dev.kobj, &lm78_group))
717 || (err = device_create_file(&pdev->dev, &dev_attr_name)))
718 goto exit_remove_files;
719
720 data->hwmon_dev = hwmon_device_register(&pdev->dev);
721 if (IS_ERR(data->hwmon_dev)) {
722 err = PTR_ERR(data->hwmon_dev);
723 goto exit_remove_files;
724 }
725
726 return 0;
727
728 exit_remove_files:
729 sysfs_remove_group(&pdev->dev.kobj, &lm78_group);
730 device_remove_file(&pdev->dev, &dev_attr_name);
731 kfree(data);
732 exit_release_region:
733 release_region(res->start + LM78_ADDR_REG_OFFSET, 2);
734 exit:
735 return err;
736}
737
738static int __devexit lm78_isa_remove(struct platform_device *pdev)
739{
740 struct lm78_data *data = platform_get_drvdata(pdev);
741 struct resource *res;
742
743 hwmon_device_unregister(data->hwmon_dev);
744 sysfs_remove_group(&pdev->dev.kobj, &lm78_group);
745 device_remove_file(&pdev->dev, &dev_attr_name);
746 kfree(data);
747
748 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
749 release_region(res->start + LM78_ADDR_REG_OFFSET, 2);
750
751 return 0;
752}
753
754
755
756
757
758
759static int lm78_read_value(struct lm78_data *data, u8 reg)
760{
761 struct i2c_client *client = data->client;
762
763 if (!client) {
764 int res;
765 mutex_lock(&data->lock);
766 outb_p(reg, data->isa_addr + LM78_ADDR_REG_OFFSET);
767 res = inb_p(data->isa_addr + LM78_DATA_REG_OFFSET);
768 mutex_unlock(&data->lock);
769 return res;
770 } else
771 return i2c_smbus_read_byte_data(client, reg);
772}
773
774
775
776
777
778
779
780
781static int lm78_write_value(struct lm78_data *data, u8 reg, u8 value)
782{
783 struct i2c_client *client = data->client;
784
785 if (!client) {
786 mutex_lock(&data->lock);
787 outb_p(reg, data->isa_addr + LM78_ADDR_REG_OFFSET);
788 outb_p(value, data->isa_addr + LM78_DATA_REG_OFFSET);
789 mutex_unlock(&data->lock);
790 return 0;
791 } else
792 return i2c_smbus_write_byte_data(client, reg, value);
793}
794
795static void lm78_init_device(struct lm78_data *data)
796{
797 u8 config;
798 int i;
799
800
801 config = lm78_read_value(data, LM78_REG_CONFIG);
802 if ((config & 0x09) != 0x01)
803 lm78_write_value(data, LM78_REG_CONFIG,
804 (config & 0xf7) | 0x01);
805
806
807 for (i = 0; i < 3; i++) {
808 data->fan_min[i] = lm78_read_value(data,
809 LM78_REG_FAN_MIN(i));
810 }
811
812 mutex_init(&data->update_lock);
813}
814
815static struct lm78_data *lm78_update_device(struct device *dev)
816{
817 struct lm78_data *data = dev_get_drvdata(dev);
818 int i;
819
820 mutex_lock(&data->update_lock);
821
822 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
823 || !data->valid) {
824
825 dev_dbg(dev, "Starting lm78 update\n");
826
827 for (i = 0; i <= 6; i++) {
828 data->in[i] =
829 lm78_read_value(data, LM78_REG_IN(i));
830 data->in_min[i] =
831 lm78_read_value(data, LM78_REG_IN_MIN(i));
832 data->in_max[i] =
833 lm78_read_value(data, LM78_REG_IN_MAX(i));
834 }
835 for (i = 0; i < 3; i++) {
836 data->fan[i] =
837 lm78_read_value(data, LM78_REG_FAN(i));
838 data->fan_min[i] =
839 lm78_read_value(data, LM78_REG_FAN_MIN(i));
840 }
841 data->temp = lm78_read_value(data, LM78_REG_TEMP);
842 data->temp_over =
843 lm78_read_value(data, LM78_REG_TEMP_OVER);
844 data->temp_hyst =
845 lm78_read_value(data, LM78_REG_TEMP_HYST);
846 i = lm78_read_value(data, LM78_REG_VID_FANDIV);
847 data->vid = i & 0x0f;
848 if (data->type == lm79)
849 data->vid |=
850 (lm78_read_value(data, LM78_REG_CHIPID) &
851 0x01) << 4;
852 else
853 data->vid |= 0x10;
854 data->fan_div[0] = (i >> 4) & 0x03;
855 data->fan_div[1] = i >> 6;
856 data->alarms = lm78_read_value(data, LM78_REG_ALARM1) +
857 (lm78_read_value(data, LM78_REG_ALARM2) << 8);
858 data->last_updated = jiffies;
859 data->valid = 1;
860
861 data->fan_div[2] = 1;
862 }
863
864 mutex_unlock(&data->update_lock);
865
866 return data;
867}
868
869
870static int __init lm78_isa_found(unsigned short address)
871{
872 int val, save, found = 0;
873
874
875
876 if (!request_region(address, 4, "lm78")) {
877 pr_debug("lm78: Failed to request low part of region\n");
878 return 0;
879 }
880 if (!request_region(address + 4, 4, "lm78")) {
881 pr_debug("lm78: Failed to request high part of region\n");
882 release_region(address, 4);
883 return 0;
884 }
885
886#define REALLY_SLOW_IO
887
888
889 val = inb_p(address + 1);
890 if (inb_p(address + 2) != val
891 || inb_p(address + 3) != val
892 || inb_p(address + 7) != val)
893 goto release;
894#undef REALLY_SLOW_IO
895
896
897
898 save = inb_p(address + LM78_ADDR_REG_OFFSET);
899 if (save & 0x80)
900 goto release;
901 val = ~save & 0x7f;
902 outb_p(val, address + LM78_ADDR_REG_OFFSET);
903 if (inb_p(address + LM78_ADDR_REG_OFFSET) != (val | 0x80)) {
904 outb_p(save, address + LM78_ADDR_REG_OFFSET);
905 goto release;
906 }
907
908
909 outb_p(LM78_REG_CONFIG, address + LM78_ADDR_REG_OFFSET);
910 val = inb_p(address + LM78_DATA_REG_OFFSET);
911 if (val & 0x80)
912 goto release;
913 outb_p(LM78_REG_I2C_ADDR, address + LM78_ADDR_REG_OFFSET);
914 val = inb_p(address + LM78_DATA_REG_OFFSET);
915 if (val < 0x03 || val > 0x77)
916 goto release;
917
918
919 if (inb_p(address + LM78_ADDR_REG_OFFSET) & 0x80)
920 goto release;
921
922
923 outb_p(0x4f, address + LM78_ADDR_REG_OFFSET);
924 val = inb_p(address + LM78_DATA_REG_OFFSET);
925 if (val == 0xa3 || val == 0x5c)
926 goto release;
927
928
929 outb_p(0x58, address + LM78_ADDR_REG_OFFSET);
930 val = inb_p(address + LM78_DATA_REG_OFFSET);
931 if (val == 0x90)
932 goto release;
933
934
935 outb_p(LM78_REG_CHIPID, address + LM78_ADDR_REG_OFFSET);
936 val = inb_p(address + LM78_DATA_REG_OFFSET);
937 if (val == 0x00 || val == 0x20
938 || val == 0x40
939 || (val & 0xfe) == 0xc0)
940 found = 1;
941
942 if (found)
943 pr_info("lm78: Found an %s chip at %#x\n",
944 val & 0x80 ? "LM79" : "LM78", (int)address);
945
946 release:
947 release_region(address + 4, 4);
948 release_region(address, 4);
949 return found;
950}
951
952static int __init lm78_isa_device_add(unsigned short address)
953{
954 struct resource res = {
955 .start = address,
956 .end = address + LM78_EXTENT - 1,
957 .name = "lm78",
958 .flags = IORESOURCE_IO,
959 };
960 int err;
961
962 pdev = platform_device_alloc("lm78", address);
963 if (!pdev) {
964 err = -ENOMEM;
965 printk(KERN_ERR "lm78: Device allocation failed\n");
966 goto exit;
967 }
968
969 err = platform_device_add_resources(pdev, &res, 1);
970 if (err) {
971 printk(KERN_ERR "lm78: Device resource addition failed "
972 "(%d)\n", err);
973 goto exit_device_put;
974 }
975
976 err = platform_device_add(pdev);
977 if (err) {
978 printk(KERN_ERR "lm78: Device addition failed (%d)\n",
979 err);
980 goto exit_device_put;
981 }
982
983 return 0;
984
985 exit_device_put:
986 platform_device_put(pdev);
987 exit:
988 pdev = NULL;
989 return err;
990}
991
992static int __init sm_lm78_init(void)
993{
994 int res;
995
996
997
998 if (lm78_isa_found(isa_address)) {
999 res = platform_driver_register(&lm78_isa_driver);
1000 if (res)
1001 goto exit;
1002
1003
1004 res = lm78_isa_device_add(isa_address);
1005 if (res)
1006 goto exit_unreg_isa_driver;
1007 }
1008
1009 res = i2c_add_driver(&lm78_driver);
1010 if (res)
1011 goto exit_unreg_isa_device;
1012
1013 return 0;
1014
1015 exit_unreg_isa_device:
1016 platform_device_unregister(pdev);
1017 exit_unreg_isa_driver:
1018 platform_driver_unregister(&lm78_isa_driver);
1019 exit:
1020 return res;
1021}
1022
1023static void __exit sm_lm78_exit(void)
1024{
1025 if (pdev) {
1026 platform_device_unregister(pdev);
1027 platform_driver_unregister(&lm78_isa_driver);
1028 }
1029 i2c_del_driver(&lm78_driver);
1030}
1031
1032
1033
1034MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
1035MODULE_DESCRIPTION("LM78/LM79 driver");
1036MODULE_LICENSE("GPL");
1037
1038module_init(sm_lm78_init);
1039module_exit(sm_lm78_exit);