2 lm78.c - Part of lm_sensors, Linux kernel modules for hardware
4 Copyright (c) 1998, 1999 Frodo Looijaard <frodol@dds.nl>
5 Copyright (c) 2007 Jean Delvare <khali@linux-fr.org>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License as published by
9 the Free Software Foundation; either version 2 of the License, or
10 (at your option) any later version.
12 This program is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 GNU General Public License for more details.
17 You should have received a copy of the GNU General Public License
18 along with this program; if not, write to the Free Software
19 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
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>
36 /* ISA device, if found */
37 static struct platform_device *pdev;
39 /* Addresses to scan */
40 static const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d,
41 0x2e, 0x2f, I2C_CLIENT_END };
42 static unsigned short isa_address = 0x290;
44 /* Insmod parameters */
45 I2C_CLIENT_INSMOD_2(lm78, lm79);
47 /* Many LM78 constants specified below */
49 /* Length of ISA address segment */
52 /* Where are the ISA address/data registers relative to the base address */
53 #define LM78_ADDR_REG_OFFSET 5
54 #define LM78_DATA_REG_OFFSET 6
56 /* The LM78 registers */
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))
61 #define LM78_REG_FAN_MIN(nr) (0x3b + (nr))
62 #define LM78_REG_FAN(nr) (0x28 + (nr))
64 #define LM78_REG_TEMP 0x27
65 #define LM78_REG_TEMP_OVER 0x39
66 #define LM78_REG_TEMP_HYST 0x3a
68 #define LM78_REG_ALARM1 0x41
69 #define LM78_REG_ALARM2 0x42
71 #define LM78_REG_VID_FANDIV 0x47
73 #define LM78_REG_CONFIG 0x40
74 #define LM78_REG_CHIPID 0x49
75 #define LM78_REG_I2C_ADDR 0x48
78 /* Conversions. Rounding and limit checking is only done on the TO_REG
81 /* IN: mV, (0V to 4.08V)
83 static inline u8 IN_TO_REG(unsigned long val)
85 unsigned long nval = SENSORS_LIMIT(val, 0, 4080);
86 return (nval + 8) / 16;
88 #define IN_FROM_REG(val) ((val) * 16)
90 static inline u8 FAN_TO_REG(long rpm, int div)
94 return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
97 static inline int FAN_FROM_REG(u8 val, int div)
99 return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
102 /* TEMP: mC (-128C to +127C)
103 REG: 1C/bit, two's complement */
104 static inline s8 TEMP_TO_REG(int val)
106 int nval = SENSORS_LIMIT(val, -128000, 127000) ;
107 return nval<0 ? (nval-500)/1000 : (nval+500)/1000;
110 static inline int TEMP_FROM_REG(s8 val)
115 #define DIV_FROM_REG(val) (1 << (val))
118 struct i2c_client *client;
119 struct device *hwmon_dev;
123 /* For ISA device only */
127 struct mutex update_lock;
128 char valid; /* !=0 if following fields are valid */
129 unsigned long last_updated; /* In jiffies */
131 u8 in[7]; /* Register value */
132 u8 in_max[7]; /* Register value */
133 u8 in_min[7]; /* Register value */
134 u8 fan[3]; /* Register value */
135 u8 fan_min[3]; /* Register value */
136 s8 temp; /* Register value */
137 s8 temp_over; /* Register value */
138 s8 temp_hyst; /* Register value */
139 u8 fan_div[3]; /* Register encoding, shifted right */
140 u8 vid; /* Register encoding, combined */
141 u16 alarms; /* Register encoding, combined */
145 static int lm78_i2c_detect(struct i2c_client *client, int kind,
146 struct i2c_board_info *info);
147 static int lm78_i2c_probe(struct i2c_client *client,
148 const struct i2c_device_id *id);
149 static int lm78_i2c_remove(struct i2c_client *client);
151 static int __devinit lm78_isa_probe(struct platform_device *pdev);
152 static int __devexit lm78_isa_remove(struct platform_device *pdev);
154 static int lm78_read_value(struct lm78_data *data, u8 reg);
155 static int lm78_write_value(struct lm78_data *data, u8 reg, u8 value);
156 static struct lm78_data *lm78_update_device(struct device *dev);
157 static void lm78_init_device(struct lm78_data *data);
160 static const struct i2c_device_id lm78_i2c_id[] = {
165 MODULE_DEVICE_TABLE(i2c, lm78_i2c_id);
167 static struct i2c_driver lm78_driver = {
168 .class = I2C_CLASS_HWMON,
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,
179 static struct platform_driver lm78_isa_driver = {
181 .owner = THIS_MODULE,
184 .probe = lm78_isa_probe,
185 .remove = __devexit_p(lm78_isa_remove),
190 static ssize_t show_in(struct device *dev, struct device_attribute *da,
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]));
198 static ssize_t show_in_min(struct device *dev, struct device_attribute *da,
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]));
206 static ssize_t show_in_max(struct device *dev, struct device_attribute *da,
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]));
214 static ssize_t set_in_min(struct device *dev, struct device_attribute *da,
215 const char *buf, size_t count)
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;
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);
229 static ssize_t set_in_max(struct device *dev, struct device_attribute *da,
230 const char *buf, size_t count)
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;
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);
244 #define show_in_offset(offset) \
245 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
246 show_in, NULL, offset); \
247 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
248 show_in_min, set_in_min, offset); \
249 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
250 show_in_max, set_in_max, offset);
261 static ssize_t show_temp(struct device *dev, struct device_attribute *da,
264 struct lm78_data *data = lm78_update_device(dev);
265 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
268 static ssize_t show_temp_over(struct device *dev, struct device_attribute *da,
271 struct lm78_data *data = lm78_update_device(dev);
272 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
275 static ssize_t set_temp_over(struct device *dev, struct device_attribute *da,
276 const char *buf, size_t count)
278 struct lm78_data *data = dev_get_drvdata(dev);
279 long val = simple_strtol(buf, NULL, 10);
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);
288 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *da,
291 struct lm78_data *data = lm78_update_device(dev);
292 return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
295 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *da,
296 const char *buf, size_t count)
298 struct lm78_data *data = dev_get_drvdata(dev);
299 long val = simple_strtol(buf, NULL, 10);
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);
308 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
309 static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
310 show_temp_over, set_temp_over);
311 static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
312 show_temp_hyst, set_temp_hyst);
315 static ssize_t show_fan(struct device *dev, struct device_attribute *da,
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])) );
325 static ssize_t show_fan_min(struct device *dev, struct device_attribute *da,
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])) );
335 static ssize_t set_fan_min(struct device *dev, struct device_attribute *da,
336 const char *buf, size_t count)
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);
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);
350 static ssize_t show_fan_div(struct device *dev, struct device_attribute *da,
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]));
358 /* Note: we save and restore the fan minimum here, because its value is
359 determined in part by the fan divisor. This follows the principle of
360 least surprise; the user doesn't expect the fan minimum to change just
361 because the divisor changed. */
362 static ssize_t set_fan_div(struct device *dev, struct device_attribute *da,
363 const char *buf, size_t count)
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);
372 mutex_lock(&data->update_lock);
373 min = FAN_FROM_REG(data->fan_min[nr],
374 DIV_FROM_REG(data->fan_div[nr]));
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;
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);
388 reg = lm78_read_value(data, LM78_REG_VID_FANDIV);
391 reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
394 reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
397 lm78_write_value(data, LM78_REG_VID_FANDIV, reg);
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);
407 #define show_fan_offset(offset) \
408 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \
409 show_fan, NULL, offset - 1); \
410 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
411 show_fan_min, set_fan_min, offset - 1);
417 /* Fan 3 divisor is locked in H/W */
418 static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
419 show_fan_div, set_fan_div, 0);
420 static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
421 show_fan_div, set_fan_div, 1);
422 static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2);
425 static ssize_t show_vid(struct device *dev, struct device_attribute *da,
428 struct lm78_data *data = lm78_update_device(dev);
429 return sprintf(buf, "%d\n", vid_from_reg(data->vid, 82));
431 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
434 static ssize_t show_alarms(struct device *dev, struct device_attribute *da,
437 struct lm78_data *data = lm78_update_device(dev);
438 return sprintf(buf, "%u\n", data->alarms);
440 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
442 static ssize_t show_alarm(struct device *dev, struct device_attribute *da,
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);
449 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
450 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
451 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
452 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
453 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
454 static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
455 static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
456 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
457 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
458 static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
459 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
461 static 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,
512 static const struct attribute_group lm78_group = {
513 .attrs = lm78_attributes,
516 /* I2C devices get this name attribute automatically, but for ISA devices
517 we must create it by ourselves. */
518 static ssize_t show_name(struct device *dev, struct device_attribute
521 struct lm78_data *data = dev_get_drvdata(dev);
523 return sprintf(buf, "%s\n", data->name);
525 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
527 /* Returns 1 if the I2C chip appears to be an alias of the ISA chip */
528 static int lm78_alias_detect(struct i2c_client *client, u8 chipid)
530 struct lm78_data *isa;
533 if (!pdev) /* No ISA chip */
535 isa = platform_get_drvdata(pdev);
537 if (lm78_read_value(isa, LM78_REG_I2C_ADDR) != client->addr)
538 return 0; /* Address doesn't match */
539 if ((lm78_read_value(isa, LM78_REG_CHIPID) & 0xfe) != (chipid & 0xfe))
540 return 0; /* Chip type doesn't match */
542 /* We compare all the limit registers, the config register and the
543 * interrupt mask registers */
544 for (i = 0x2b; i <= 0x3d; i++) {
545 if (lm78_read_value(isa, i) !=
546 i2c_smbus_read_byte_data(client, i))
549 if (lm78_read_value(isa, LM78_REG_CONFIG) !=
550 i2c_smbus_read_byte_data(client, LM78_REG_CONFIG))
552 for (i = 0x43; i <= 0x46; i++) {
553 if (lm78_read_value(isa, i) !=
554 i2c_smbus_read_byte_data(client, i))
561 static int lm78_i2c_detect(struct i2c_client *client, int kind,
562 struct i2c_board_info *info)
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;
570 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
573 /* We block updates of the ISA device to minimize the risk of
574 concurrent access to the same LM78 chip through different
577 mutex_lock(&isa->update_lock);
580 if ((i2c_smbus_read_byte_data(client, LM78_REG_CONFIG) & 0x80)
581 || i2c_smbus_read_byte_data(client, LM78_REG_I2C_ADDR)
585 /* Explicitly prevent the misdetection of Winbond chips */
586 i = i2c_smbus_read_byte_data(client, 0x4f);
587 if (i == 0xa3 || i == 0x5c)
591 /* Determine the chip type. */
593 i = i2c_smbus_read_byte_data(client, LM78_REG_CHIPID);
594 if (i == 0x00 || i == 0x20 /* LM78 */
595 || i == 0x40) /* LM78-J */
597 else if ((i & 0xfe) == 0xc0)
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);
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);
616 mutex_unlock(&isa->update_lock);
620 client_name = "lm79";
623 client_name = "lm78";
625 strlcpy(info->type, client_name, I2C_NAME_SIZE);
631 mutex_unlock(&isa->update_lock);
635 static int lm78_i2c_probe(struct i2c_client *client,
636 const struct i2c_device_id *id)
638 struct lm78_data *data;
641 data = kzalloc(sizeof(struct lm78_data), GFP_KERNEL);
645 i2c_set_clientdata(client, data);
646 data->client = client;
647 data->type = id->driver_data;
649 /* Initialize the LM78 chip */
650 lm78_init_device(data);
652 /* Register sysfs hooks */
653 err = sysfs_create_group(&client->dev.kobj, &lm78_group);
657 data->hwmon_dev = hwmon_device_register(&client->dev);
658 if (IS_ERR(data->hwmon_dev)) {
659 err = PTR_ERR(data->hwmon_dev);
666 sysfs_remove_group(&client->dev.kobj, &lm78_group);
672 static int lm78_i2c_remove(struct i2c_client *client)
674 struct lm78_data *data = i2c_get_clientdata(client);
676 hwmon_device_unregister(data->hwmon_dev);
677 sysfs_remove_group(&client->dev.kobj, &lm78_group);
683 static int __devinit lm78_isa_probe(struct platform_device *pdev)
686 struct lm78_data *data;
687 struct resource *res;
689 /* Reserve the ISA region */
690 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
691 if (!request_region(res->start + LM78_ADDR_REG_OFFSET, 2, "lm78")) {
696 if (!(data = kzalloc(sizeof(struct lm78_data), GFP_KERNEL))) {
698 goto exit_release_region;
700 mutex_init(&data->lock);
701 data->isa_addr = res->start;
702 platform_set_drvdata(pdev, data);
704 if (lm78_read_value(data, LM78_REG_CHIPID) & 0x80) {
712 /* Initialize the LM78 chip */
713 lm78_init_device(data);
715 /* Register sysfs hooks */
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;
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;
729 sysfs_remove_group(&pdev->dev.kobj, &lm78_group);
730 device_remove_file(&pdev->dev, &dev_attr_name);
733 release_region(res->start + LM78_ADDR_REG_OFFSET, 2);
738 static int __devexit lm78_isa_remove(struct platform_device *pdev)
740 struct lm78_data *data = platform_get_drvdata(pdev);
741 struct resource *res;
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);
748 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
749 release_region(res->start + LM78_ADDR_REG_OFFSET, 2);
754 /* The SMBus locks itself, but ISA access must be locked explicitly!
755 We don't want to lock the whole ISA bus, so we lock each client
757 We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks,
758 would slow down the LM78 access and should not be necessary. */
759 static int lm78_read_value(struct lm78_data *data, u8 reg)
761 struct i2c_client *client = data->client;
763 if (!client) { /* ISA device */
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);
771 return i2c_smbus_read_byte_data(client, reg);
774 /* The SMBus locks itself, but ISA access muse be locked explicitly!
775 We don't want to lock the whole ISA bus, so we lock each client
777 We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks,
778 would slow down the LM78 access and should not be necessary.
779 There are some ugly typecasts here, but the good new is - they should
780 nowhere else be necessary! */
781 static int lm78_write_value(struct lm78_data *data, u8 reg, u8 value)
783 struct i2c_client *client = data->client;
785 if (!client) { /* ISA device */
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);
792 return i2c_smbus_write_byte_data(client, reg, value);
795 static void lm78_init_device(struct lm78_data *data)
800 /* Start monitoring */
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);
806 /* A few vars need to be filled upon startup */
807 for (i = 0; i < 3; i++) {
808 data->fan_min[i] = lm78_read_value(data,
809 LM78_REG_FAN_MIN(i));
812 mutex_init(&data->update_lock);
815 static struct lm78_data *lm78_update_device(struct device *dev)
817 struct lm78_data *data = dev_get_drvdata(dev);
820 mutex_lock(&data->update_lock);
822 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
825 dev_dbg(dev, "Starting lm78 update\n");
827 for (i = 0; i <= 6; i++) {
829 lm78_read_value(data, LM78_REG_IN(i));
831 lm78_read_value(data, LM78_REG_IN_MIN(i));
833 lm78_read_value(data, LM78_REG_IN_MAX(i));
835 for (i = 0; i < 3; i++) {
837 lm78_read_value(data, LM78_REG_FAN(i));
839 lm78_read_value(data, LM78_REG_FAN_MIN(i));
841 data->temp = lm78_read_value(data, LM78_REG_TEMP);
843 lm78_read_value(data, LM78_REG_TEMP_OVER);
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)
850 (lm78_read_value(data, LM78_REG_CHIPID) &
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;
861 data->fan_div[2] = 1;
864 mutex_unlock(&data->update_lock);
869 /* return 1 if a supported chip is found, 0 otherwise */
870 static int __init lm78_isa_found(unsigned short address)
872 int val, save, found = 0;
874 /* We have to request the region in two parts because some
875 boards declare base+4 to base+7 as a PNP device */
876 if (!request_region(address, 4, "lm78")) {
877 pr_debug("lm78: Failed to request low part of region\n");
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);
886 #define REALLY_SLOW_IO
887 /* We need the timeouts for at least some LM78-like
888 chips. But only if we read 'undefined' registers. */
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)
894 #undef REALLY_SLOW_IO
896 /* We should be able to change the 7 LSB of the address port. The
897 MSB (busy flag) should be clear initially, set after the write. */
898 save = inb_p(address + LM78_ADDR_REG_OFFSET);
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);
908 /* We found a device, now see if it could be an LM78 */
909 outb_p(LM78_REG_CONFIG, address + LM78_ADDR_REG_OFFSET);
910 val = inb_p(address + LM78_DATA_REG_OFFSET);
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) /* Not a valid I2C address */
918 /* The busy flag should be clear again */
919 if (inb_p(address + LM78_ADDR_REG_OFFSET) & 0x80)
922 /* Explicitly prevent the misdetection of Winbond chips */
923 outb_p(0x4f, address + LM78_ADDR_REG_OFFSET);
924 val = inb_p(address + LM78_DATA_REG_OFFSET);
925 if (val == 0xa3 || val == 0x5c)
928 /* Explicitly prevent the misdetection of ITE chips */
929 outb_p(0x58, address + LM78_ADDR_REG_OFFSET);
930 val = inb_p(address + LM78_DATA_REG_OFFSET);
934 /* Determine the chip type */
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 /* LM78 */
938 || val == 0x40 /* LM78-J */
939 || (val & 0xfe) == 0xc0) /* LM79 */
943 pr_info("lm78: Found an %s chip at %#x\n",
944 val & 0x80 ? "LM79" : "LM78", (int)address);
947 release_region(address + 4, 4);
948 release_region(address, 4);
952 static int __init lm78_isa_device_add(unsigned short address)
954 struct resource res = {
956 .end = address + LM78_EXTENT - 1,
958 .flags = IORESOURCE_IO,
962 pdev = platform_device_alloc("lm78", address);
965 printk(KERN_ERR "lm78: Device allocation failed\n");
969 err = platform_device_add_resources(pdev, &res, 1);
971 printk(KERN_ERR "lm78: Device resource addition failed "
973 goto exit_device_put;
976 err = platform_device_add(pdev);
978 printk(KERN_ERR "lm78: Device addition failed (%d)\n",
980 goto exit_device_put;
986 platform_device_put(pdev);
992 static int __init sm_lm78_init(void)
996 /* We register the ISA device first, so that we can skip the
997 * registration of an I2C interface to the same device. */
998 if (lm78_isa_found(isa_address)) {
999 res = platform_driver_register(&lm78_isa_driver);
1003 /* Sets global pdev as a side effect */
1004 res = lm78_isa_device_add(isa_address);
1006 goto exit_unreg_isa_driver;
1009 res = i2c_add_driver(&lm78_driver);
1011 goto exit_unreg_isa_device;
1015 exit_unreg_isa_device:
1016 platform_device_unregister(pdev);
1017 exit_unreg_isa_driver:
1018 platform_driver_unregister(&lm78_isa_driver);
1023 static void __exit sm_lm78_exit(void)
1026 platform_device_unregister(pdev);
1027 platform_driver_unregister(&lm78_isa_driver);
1029 i2c_del_driver(&lm78_driver);
1034 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
1035 MODULE_DESCRIPTION("LM78/LM79 driver");
1036 MODULE_LICENSE("GPL");
1038 module_init(sm_lm78_init);
1039 module_exit(sm_lm78_exit);