hwmon: (lm92) Convert to a new-style i2c driver
[linux-2.6.git] / drivers / hwmon / lm78.c
1 /*
2     lm78.c - Part of lm_sensors, Linux kernel modules for hardware
3              monitoring
4     Copyright (c) 1998, 1999  Frodo Looijaard <frodol@dds.nl> 
5     Copyright (c) 2007        Jean Delvare <khali@linux-fr.org>
6
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.
11
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.
16
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.
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 /* ISA device, if found */
37 static struct platform_device *pdev;
38
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;
43
44 /* Insmod parameters */
45 I2C_CLIENT_INSMOD_2(lm78, lm79);
46
47 /* Many LM78 constants specified below */
48
49 /* Length of ISA address segment */
50 #define LM78_EXTENT 8
51
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
55
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))
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 /* Conversions. Rounding and limit checking is only done on the TO_REG 
79    variants. */
80
81 /* IN: mV, (0V to 4.08V)
82    REG: 16mV/bit */
83 static 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
90 static 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
97 static inline int FAN_FROM_REG(u8 val, int div)
98 {
99         return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
100 }
101
102 /* TEMP: mC (-128C to +127C)
103    REG: 1C/bit, two's complement */
104 static 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
110 static inline int TEMP_FROM_REG(s8 val)
111 {
112         return val * 1000;
113 }
114
115 #define DIV_FROM_REG(val) (1 << (val))
116
117 /* There are some complications in a module like this. First off, LM78 chips
118    may be both present on the SMBus and the ISA bus, and we have to handle
119    those cases separately at some places. Second, there might be several
120    LM78 chips available (well, actually, that is probably never done; but
121    it is a clean illustration of how to handle a case like that). Finally,
122    a specific chip may be attached to *both* ISA and SMBus, and we would
123    not like to detect it double. Fortunately, in the case of the LM78 at
124    least, a register tells us what SMBus address we are on, so that helps
125    a bit - except if there could be more than one SMBus. Groan. No solution
126    for this yet. */
127
128 /* For ISA chips, we abuse the i2c_client addr and name fields. We also use
129    the driver field to differentiate between I2C and ISA chips. */
130 struct lm78_data {
131         struct i2c_client client;
132         struct device *hwmon_dev;
133         struct mutex lock;
134         enum chips type;
135
136         struct mutex update_lock;
137         char valid;             /* !=0 if following fields are valid */
138         unsigned long last_updated;     /* In jiffies */
139
140         u8 in[7];               /* Register value */
141         u8 in_max[7];           /* Register value */
142         u8 in_min[7];           /* Register value */
143         u8 fan[3];              /* Register value */
144         u8 fan_min[3];          /* Register value */
145         s8 temp;                /* Register value */
146         s8 temp_over;           /* Register value */
147         s8 temp_hyst;           /* Register value */
148         u8 fan_div[3];          /* Register encoding, shifted right */
149         u8 vid;                 /* Register encoding, combined */
150         u16 alarms;             /* Register encoding, combined */
151 };
152
153
154 static int lm78_attach_adapter(struct i2c_adapter *adapter);
155 static int lm78_detect(struct i2c_adapter *adapter, int address, int kind);
156 static int lm78_detach_client(struct i2c_client *client);
157
158 static int __devinit lm78_isa_probe(struct platform_device *pdev);
159 static int __devexit lm78_isa_remove(struct platform_device *pdev);
160
161 static int lm78_read_value(struct lm78_data *data, u8 reg);
162 static int lm78_write_value(struct lm78_data *data, u8 reg, u8 value);
163 static struct lm78_data *lm78_update_device(struct device *dev);
164 static void lm78_init_device(struct lm78_data *data);
165
166
167 static struct i2c_driver lm78_driver = {
168         .driver = {
169                 .name   = "lm78",
170         },
171         .attach_adapter = lm78_attach_adapter,
172         .detach_client  = lm78_detach_client,
173 };
174
175 static struct platform_driver lm78_isa_driver = {
176         .driver = {
177                 .owner  = THIS_MODULE,
178                 .name   = "lm78",
179         },
180         .probe          = lm78_isa_probe,
181         .remove         = lm78_isa_remove,
182 };
183
184
185 /* 7 Voltages */
186 static ssize_t show_in(struct device *dev, struct device_attribute *da,
187                        char *buf)
188 {
189         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
190         struct lm78_data *data = lm78_update_device(dev);
191         return sprintf(buf, "%d\n", IN_FROM_REG(data->in[attr->index]));
192 }
193
194 static ssize_t show_in_min(struct device *dev, struct device_attribute *da,
195                            char *buf)
196 {
197         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
198         struct lm78_data *data = lm78_update_device(dev);
199         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[attr->index]));
200 }
201
202 static ssize_t show_in_max(struct device *dev, struct device_attribute *da,
203                            char *buf)
204 {
205         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
206         struct lm78_data *data = lm78_update_device(dev);
207         return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[attr->index]));
208 }
209
210 static ssize_t set_in_min(struct device *dev, struct device_attribute *da,
211                           const char *buf, size_t count)
212 {
213         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
214         struct lm78_data *data = dev_get_drvdata(dev);
215         unsigned long val = simple_strtoul(buf, NULL, 10);
216         int nr = attr->index;
217
218         mutex_lock(&data->update_lock);
219         data->in_min[nr] = IN_TO_REG(val);
220         lm78_write_value(data, LM78_REG_IN_MIN(nr), data->in_min[nr]);
221         mutex_unlock(&data->update_lock);
222         return count;
223 }
224
225 static ssize_t set_in_max(struct device *dev, struct device_attribute *da,
226                           const char *buf, size_t count)
227 {
228         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
229         struct lm78_data *data = dev_get_drvdata(dev);
230         unsigned long val = simple_strtoul(buf, NULL, 10);
231         int nr = attr->index;
232
233         mutex_lock(&data->update_lock);
234         data->in_max[nr] = IN_TO_REG(val);
235         lm78_write_value(data, LM78_REG_IN_MAX(nr), data->in_max[nr]);
236         mutex_unlock(&data->update_lock);
237         return count;
238 }
239         
240 #define show_in_offset(offset)                                  \
241 static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO,          \
242                 show_in, NULL, offset);                         \
243 static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR,  \
244                 show_in_min, set_in_min, offset);               \
245 static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR,  \
246                 show_in_max, set_in_max, offset);
247
248 show_in_offset(0);
249 show_in_offset(1);
250 show_in_offset(2);
251 show_in_offset(3);
252 show_in_offset(4);
253 show_in_offset(5);
254 show_in_offset(6);
255
256 /* Temperature */
257 static ssize_t show_temp(struct device *dev, struct device_attribute *da,
258                          char *buf)
259 {
260         struct lm78_data *data = lm78_update_device(dev);
261         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
262 }
263
264 static ssize_t show_temp_over(struct device *dev, struct device_attribute *da,
265                               char *buf)
266 {
267         struct lm78_data *data = lm78_update_device(dev);
268         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
269 }
270
271 static ssize_t set_temp_over(struct device *dev, struct device_attribute *da,
272                              const char *buf, size_t count)
273 {
274         struct lm78_data *data = dev_get_drvdata(dev);
275         long val = simple_strtol(buf, NULL, 10);
276
277         mutex_lock(&data->update_lock);
278         data->temp_over = TEMP_TO_REG(val);
279         lm78_write_value(data, LM78_REG_TEMP_OVER, data->temp_over);
280         mutex_unlock(&data->update_lock);
281         return count;
282 }
283
284 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *da,
285                               char *buf)
286 {
287         struct lm78_data *data = lm78_update_device(dev);
288         return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
289 }
290
291 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *da,
292                              const char *buf, size_t count)
293 {
294         struct lm78_data *data = dev_get_drvdata(dev);
295         long val = simple_strtol(buf, NULL, 10);
296
297         mutex_lock(&data->update_lock);
298         data->temp_hyst = TEMP_TO_REG(val);
299         lm78_write_value(data, LM78_REG_TEMP_HYST, data->temp_hyst);
300         mutex_unlock(&data->update_lock);
301         return count;
302 }
303
304 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
305 static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
306                 show_temp_over, set_temp_over);
307 static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
308                 show_temp_hyst, set_temp_hyst);
309
310 /* 3 Fans */
311 static ssize_t show_fan(struct device *dev, struct device_attribute *da,
312                         char *buf)
313 {
314         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
315         struct lm78_data *data = lm78_update_device(dev);
316         int nr = attr->index;
317         return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
318                 DIV_FROM_REG(data->fan_div[nr])) );
319 }
320
321 static ssize_t show_fan_min(struct device *dev, struct device_attribute *da,
322                             char *buf)
323 {
324         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
325         struct lm78_data *data = lm78_update_device(dev);
326         int nr = attr->index;
327         return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan_min[nr],
328                 DIV_FROM_REG(data->fan_div[nr])) );
329 }
330
331 static ssize_t set_fan_min(struct device *dev, struct device_attribute *da,
332                            const char *buf, size_t count)
333 {
334         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
335         struct lm78_data *data = dev_get_drvdata(dev);
336         int nr = attr->index;
337         unsigned long val = simple_strtoul(buf, NULL, 10);
338
339         mutex_lock(&data->update_lock);
340         data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
341         lm78_write_value(data, LM78_REG_FAN_MIN(nr), data->fan_min[nr]);
342         mutex_unlock(&data->update_lock);
343         return count;
344 }
345
346 static ssize_t show_fan_div(struct device *dev, struct device_attribute *da,
347                             char *buf)
348 {
349         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
350         struct lm78_data *data = lm78_update_device(dev);
351         return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[attr->index]));
352 }
353
354 /* Note: we save and restore the fan minimum here, because its value is
355    determined in part by the fan divisor.  This follows the principle of
356    least surprise; the user doesn't expect the fan minimum to change just
357    because the divisor changed. */
358 static ssize_t set_fan_div(struct device *dev, struct device_attribute *da,
359                            const char *buf, size_t count)
360 {
361         struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
362         struct lm78_data *data = dev_get_drvdata(dev);
363         int nr = attr->index;
364         unsigned long val = simple_strtoul(buf, NULL, 10);
365         unsigned long min;
366         u8 reg;
367
368         mutex_lock(&data->update_lock);
369         min = FAN_FROM_REG(data->fan_min[nr],
370                            DIV_FROM_REG(data->fan_div[nr]));
371
372         switch (val) {
373         case 1: data->fan_div[nr] = 0; break;
374         case 2: data->fan_div[nr] = 1; break;
375         case 4: data->fan_div[nr] = 2; break;
376         case 8: data->fan_div[nr] = 3; break;
377         default:
378                 dev_err(dev, "fan_div value %ld not "
379                         "supported. Choose one of 1, 2, 4 or 8!\n", val);
380                 mutex_unlock(&data->update_lock);
381                 return -EINVAL;
382         }
383
384         reg = lm78_read_value(data, LM78_REG_VID_FANDIV);
385         switch (nr) {
386         case 0:
387                 reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
388                 break;
389         case 1:
390                 reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
391                 break;
392         }
393         lm78_write_value(data, LM78_REG_VID_FANDIV, reg);
394
395         data->fan_min[nr] =
396                 FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
397         lm78_write_value(data, LM78_REG_FAN_MIN(nr), data->fan_min[nr]);
398         mutex_unlock(&data->update_lock);
399
400         return count;
401 }
402
403 #define show_fan_offset(offset)                         \
404 static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO,         \
405                 show_fan, NULL, offset - 1);                    \
406 static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
407                 show_fan_min, set_fan_min, offset - 1);
408
409 show_fan_offset(1);
410 show_fan_offset(2);
411 show_fan_offset(3);
412
413 /* Fan 3 divisor is locked in H/W */
414 static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
415                 show_fan_div, set_fan_div, 0);
416 static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
417                 show_fan_div, set_fan_div, 1);
418 static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2);
419
420 /* VID */
421 static ssize_t show_vid(struct device *dev, struct device_attribute *da,
422                         char *buf)
423 {
424         struct lm78_data *data = lm78_update_device(dev);
425         return sprintf(buf, "%d\n", vid_from_reg(data->vid, 82));
426 }
427 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
428
429 /* Alarms */
430 static ssize_t show_alarms(struct device *dev, struct device_attribute *da,
431                            char *buf)
432 {
433         struct lm78_data *data = lm78_update_device(dev);
434         return sprintf(buf, "%u\n", data->alarms);
435 }
436 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
437
438 static ssize_t show_alarm(struct device *dev, struct device_attribute *da,
439                           char *buf)
440 {
441         struct lm78_data *data = lm78_update_device(dev);
442         int nr = to_sensor_dev_attr(da)->index;
443         return sprintf(buf, "%u\n", (data->alarms >> nr) & 1);
444 }
445 static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
446 static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
447 static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
448 static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
449 static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
450 static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
451 static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
452 static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
453 static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
454 static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
455 static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
456
457 /* This function is called when:
458      * lm78_driver is inserted (when this module is loaded), for each
459        available adapter
460      * when a new adapter is inserted (and lm78_driver is still present) */
461 static int lm78_attach_adapter(struct i2c_adapter *adapter)
462 {
463         if (!(adapter->class & I2C_CLASS_HWMON))
464                 return 0;
465         return i2c_probe(adapter, &addr_data, lm78_detect);
466 }
467
468 static struct attribute *lm78_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_in0_alarm.dev_attr.attr,
473         &sensor_dev_attr_in1_input.dev_attr.attr,
474         &sensor_dev_attr_in1_min.dev_attr.attr,
475         &sensor_dev_attr_in1_max.dev_attr.attr,
476         &sensor_dev_attr_in1_alarm.dev_attr.attr,
477         &sensor_dev_attr_in2_input.dev_attr.attr,
478         &sensor_dev_attr_in2_min.dev_attr.attr,
479         &sensor_dev_attr_in2_max.dev_attr.attr,
480         &sensor_dev_attr_in2_alarm.dev_attr.attr,
481         &sensor_dev_attr_in3_input.dev_attr.attr,
482         &sensor_dev_attr_in3_min.dev_attr.attr,
483         &sensor_dev_attr_in3_max.dev_attr.attr,
484         &sensor_dev_attr_in3_alarm.dev_attr.attr,
485         &sensor_dev_attr_in4_input.dev_attr.attr,
486         &sensor_dev_attr_in4_min.dev_attr.attr,
487         &sensor_dev_attr_in4_max.dev_attr.attr,
488         &sensor_dev_attr_in4_alarm.dev_attr.attr,
489         &sensor_dev_attr_in5_input.dev_attr.attr,
490         &sensor_dev_attr_in5_min.dev_attr.attr,
491         &sensor_dev_attr_in5_max.dev_attr.attr,
492         &sensor_dev_attr_in5_alarm.dev_attr.attr,
493         &sensor_dev_attr_in6_input.dev_attr.attr,
494         &sensor_dev_attr_in6_min.dev_attr.attr,
495         &sensor_dev_attr_in6_max.dev_attr.attr,
496         &sensor_dev_attr_in6_alarm.dev_attr.attr,
497         &dev_attr_temp1_input.attr,
498         &dev_attr_temp1_max.attr,
499         &dev_attr_temp1_max_hyst.attr,
500         &sensor_dev_attr_temp1_alarm.dev_attr.attr,
501         &sensor_dev_attr_fan1_input.dev_attr.attr,
502         &sensor_dev_attr_fan1_min.dev_attr.attr,
503         &sensor_dev_attr_fan1_div.dev_attr.attr,
504         &sensor_dev_attr_fan1_alarm.dev_attr.attr,
505         &sensor_dev_attr_fan2_input.dev_attr.attr,
506         &sensor_dev_attr_fan2_min.dev_attr.attr,
507         &sensor_dev_attr_fan2_div.dev_attr.attr,
508         &sensor_dev_attr_fan2_alarm.dev_attr.attr,
509         &sensor_dev_attr_fan3_input.dev_attr.attr,
510         &sensor_dev_attr_fan3_min.dev_attr.attr,
511         &sensor_dev_attr_fan3_div.dev_attr.attr,
512         &sensor_dev_attr_fan3_alarm.dev_attr.attr,
513         &dev_attr_alarms.attr,
514         &dev_attr_cpu0_vid.attr,
515
516         NULL
517 };
518
519 static const struct attribute_group lm78_group = {
520         .attrs = lm78_attributes,
521 };
522
523 /* I2C devices get this name attribute automatically, but for ISA devices
524    we must create it by ourselves. */
525 static ssize_t show_name(struct device *dev, struct device_attribute
526                          *devattr, char *buf)
527 {
528         struct lm78_data *data = dev_get_drvdata(dev);
529
530         return sprintf(buf, "%s\n", data->client.name);
531 }
532 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
533
534 /* This function is called by i2c_probe */
535 static int lm78_detect(struct i2c_adapter *adapter, int address, int kind)
536 {
537         int i, err;
538         struct i2c_client *new_client;
539         struct lm78_data *data;
540         const char *client_name = "";
541
542         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
543                 err = -ENODEV;
544                 goto ERROR1;
545         }
546
547         /* OK. For now, we presume we have a valid client. We now create the
548            client structure, even though we cannot fill it completely yet.
549            But it allows us to access lm78_{read,write}_value. */
550
551         if (!(data = kzalloc(sizeof(struct lm78_data), GFP_KERNEL))) {
552                 err = -ENOMEM;
553                 goto ERROR1;
554         }
555
556         new_client = &data->client;
557         i2c_set_clientdata(new_client, data);
558         new_client->addr = address;
559         new_client->adapter = adapter;
560         new_client->driver = &lm78_driver;
561
562         /* Now, we do the remaining detection. */
563         if (kind < 0) {
564                 if (lm78_read_value(data, LM78_REG_CONFIG) & 0x80) {
565                         err = -ENODEV;
566                         goto ERROR2;
567                 }
568                 if (lm78_read_value(data, LM78_REG_I2C_ADDR) !=
569                     address) {
570                         err = -ENODEV;
571                         goto ERROR2;
572                 }
573         }
574
575         /* Determine the chip type. */
576         if (kind <= 0) {
577                 i = lm78_read_value(data, LM78_REG_CHIPID);
578                 if (i == 0x00 || i == 0x20      /* LM78 */
579                  || i == 0x40)                  /* LM78-J */
580                         kind = lm78;
581                 else if ((i & 0xfe) == 0xc0)
582                         kind = lm79;
583                 else {
584                         if (kind == 0)
585                                 dev_warn(&adapter->dev, "Ignoring 'force' "
586                                         "parameter for unknown chip at "
587                                         "adapter %d, address 0x%02x\n",
588                                         i2c_adapter_id(adapter), address);
589                         err = -ENODEV;
590                         goto ERROR2;
591                 }
592         }
593
594         if (kind == lm78) {
595                 client_name = "lm78";
596         } else if (kind == lm79) {
597                 client_name = "lm79";
598         }
599
600         /* Fill in the remaining client fields and put into the global list */
601         strlcpy(new_client->name, client_name, I2C_NAME_SIZE);
602         data->type = kind;
603
604         /* Tell the I2C layer a new client has arrived */
605         if ((err = i2c_attach_client(new_client)))
606                 goto ERROR2;
607
608         /* Initialize the LM78 chip */
609         lm78_init_device(data);
610
611         /* Register sysfs hooks */
612         if ((err = sysfs_create_group(&new_client->dev.kobj, &lm78_group)))
613                 goto ERROR3;
614
615         data->hwmon_dev = hwmon_device_register(&new_client->dev);
616         if (IS_ERR(data->hwmon_dev)) {
617                 err = PTR_ERR(data->hwmon_dev);
618                 goto ERROR4;
619         }
620
621         return 0;
622
623 ERROR4:
624         sysfs_remove_group(&new_client->dev.kobj, &lm78_group);
625 ERROR3:
626         i2c_detach_client(new_client);
627 ERROR2:
628         kfree(data);
629 ERROR1:
630         return err;
631 }
632
633 static int lm78_detach_client(struct i2c_client *client)
634 {
635         struct lm78_data *data = i2c_get_clientdata(client);
636         int err;
637
638         hwmon_device_unregister(data->hwmon_dev);
639         sysfs_remove_group(&client->dev.kobj, &lm78_group);
640
641         if ((err = i2c_detach_client(client)))
642                 return err;
643
644         kfree(data);
645
646         return 0;
647 }
648
649 static int __devinit lm78_isa_probe(struct platform_device *pdev)
650 {
651         int err;
652         struct lm78_data *data;
653         struct resource *res;
654         const char *name;
655
656         /* Reserve the ISA region */
657         res = platform_get_resource(pdev, IORESOURCE_IO, 0);
658         if (!request_region(res->start, LM78_EXTENT, "lm78")) {
659                 err = -EBUSY;
660                 goto exit;
661         }
662
663         if (!(data = kzalloc(sizeof(struct lm78_data), GFP_KERNEL))) {
664                 err = -ENOMEM;
665                 goto exit_release_region;
666         }
667         mutex_init(&data->lock);
668         data->client.addr = res->start;
669         i2c_set_clientdata(&data->client, data);
670         platform_set_drvdata(pdev, data);
671
672         if (lm78_read_value(data, LM78_REG_CHIPID) & 0x80) {
673                 data->type = lm79;
674                 name = "lm79";
675         } else {
676                 data->type = lm78;
677                 name = "lm78";
678         }
679         strlcpy(data->client.name, name, I2C_NAME_SIZE);
680
681         /* Initialize the LM78 chip */
682         lm78_init_device(data);
683
684         /* Register sysfs hooks */
685         if ((err = sysfs_create_group(&pdev->dev.kobj, &lm78_group))
686          || (err = device_create_file(&pdev->dev, &dev_attr_name)))
687                 goto exit_remove_files;
688
689         data->hwmon_dev = hwmon_device_register(&pdev->dev);
690         if (IS_ERR(data->hwmon_dev)) {
691                 err = PTR_ERR(data->hwmon_dev);
692                 goto exit_remove_files;
693         }
694
695         return 0;
696
697  exit_remove_files:
698         sysfs_remove_group(&pdev->dev.kobj, &lm78_group);
699         device_remove_file(&pdev->dev, &dev_attr_name);
700         kfree(data);
701  exit_release_region:
702         release_region(res->start, LM78_EXTENT);
703  exit:
704         return err;
705 }
706
707 static int __devexit lm78_isa_remove(struct platform_device *pdev)
708 {
709         struct lm78_data *data = platform_get_drvdata(pdev);
710
711         hwmon_device_unregister(data->hwmon_dev);
712         sysfs_remove_group(&pdev->dev.kobj, &lm78_group);
713         device_remove_file(&pdev->dev, &dev_attr_name);
714         release_region(data->client.addr, LM78_EXTENT);
715         kfree(data);
716
717         return 0;
718 }
719
720 /* The SMBus locks itself, but ISA access must be locked explicitly! 
721    We don't want to lock the whole ISA bus, so we lock each client
722    separately.
723    We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks,
724    would slow down the LM78 access and should not be necessary.  */
725 static int lm78_read_value(struct lm78_data *data, u8 reg)
726 {
727         struct i2c_client *client = &data->client;
728
729         if (!client->driver) { /* ISA device */
730                 int res;
731                 mutex_lock(&data->lock);
732                 outb_p(reg, client->addr + LM78_ADDR_REG_OFFSET);
733                 res = inb_p(client->addr + LM78_DATA_REG_OFFSET);
734                 mutex_unlock(&data->lock);
735                 return res;
736         } else
737                 return i2c_smbus_read_byte_data(client, reg);
738 }
739
740 /* The SMBus locks itself, but ISA access muse be locked explicitly! 
741    We don't want to lock the whole ISA bus, so we lock each client
742    separately.
743    We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks,
744    would slow down the LM78 access and should not be necessary. 
745    There are some ugly typecasts here, but the good new is - they should
746    nowhere else be necessary! */
747 static int lm78_write_value(struct lm78_data *data, u8 reg, u8 value)
748 {
749         struct i2c_client *client = &data->client;
750
751         if (!client->driver) { /* ISA device */
752                 mutex_lock(&data->lock);
753                 outb_p(reg, client->addr + LM78_ADDR_REG_OFFSET);
754                 outb_p(value, client->addr + LM78_DATA_REG_OFFSET);
755                 mutex_unlock(&data->lock);
756                 return 0;
757         } else
758                 return i2c_smbus_write_byte_data(client, reg, value);
759 }
760
761 static void lm78_init_device(struct lm78_data *data)
762 {
763         u8 config;
764         int i;
765
766         /* Start monitoring */
767         config = lm78_read_value(data, LM78_REG_CONFIG);
768         if ((config & 0x09) != 0x01)
769                 lm78_write_value(data, LM78_REG_CONFIG,
770                                  (config & 0xf7) | 0x01);
771
772         /* A few vars need to be filled upon startup */
773         for (i = 0; i < 3; i++) {
774                 data->fan_min[i] = lm78_read_value(data,
775                                         LM78_REG_FAN_MIN(i));
776         }
777
778         mutex_init(&data->update_lock);
779 }
780
781 static struct lm78_data *lm78_update_device(struct device *dev)
782 {
783         struct lm78_data *data = dev_get_drvdata(dev);
784         int i;
785
786         mutex_lock(&data->update_lock);
787
788         if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
789             || !data->valid) {
790
791                 dev_dbg(dev, "Starting lm78 update\n");
792
793                 for (i = 0; i <= 6; i++) {
794                         data->in[i] =
795                             lm78_read_value(data, LM78_REG_IN(i));
796                         data->in_min[i] =
797                             lm78_read_value(data, LM78_REG_IN_MIN(i));
798                         data->in_max[i] =
799                             lm78_read_value(data, LM78_REG_IN_MAX(i));
800                 }
801                 for (i = 0; i < 3; i++) {
802                         data->fan[i] =
803                             lm78_read_value(data, LM78_REG_FAN(i));
804                         data->fan_min[i] =
805                             lm78_read_value(data, LM78_REG_FAN_MIN(i));
806                 }
807                 data->temp = lm78_read_value(data, LM78_REG_TEMP);
808                 data->temp_over =
809                     lm78_read_value(data, LM78_REG_TEMP_OVER);
810                 data->temp_hyst =
811                     lm78_read_value(data, LM78_REG_TEMP_HYST);
812                 i = lm78_read_value(data, LM78_REG_VID_FANDIV);
813                 data->vid = i & 0x0f;
814                 if (data->type == lm79)
815                         data->vid |=
816                             (lm78_read_value(data, LM78_REG_CHIPID) &
817                              0x01) << 4;
818                 else
819                         data->vid |= 0x10;
820                 data->fan_div[0] = (i >> 4) & 0x03;
821                 data->fan_div[1] = i >> 6;
822                 data->alarms = lm78_read_value(data, LM78_REG_ALARM1) +
823                     (lm78_read_value(data, LM78_REG_ALARM2) << 8);
824                 data->last_updated = jiffies;
825                 data->valid = 1;
826
827                 data->fan_div[2] = 1;
828         }
829
830         mutex_unlock(&data->update_lock);
831
832         return data;
833 }
834
835 /* return 1 if a supported chip is found, 0 otherwise */
836 static int __init lm78_isa_found(unsigned short address)
837 {
838         int val, save, found = 0;
839
840         if (!request_region(address, LM78_EXTENT, "lm78"))
841                 return 0;
842
843 #define REALLY_SLOW_IO
844         /* We need the timeouts for at least some LM78-like
845            chips. But only if we read 'undefined' registers. */
846         val = inb_p(address + 1);
847         if (inb_p(address + 2) != val
848          || inb_p(address + 3) != val
849          || inb_p(address + 7) != val)
850                 goto release;
851 #undef REALLY_SLOW_IO
852
853         /* We should be able to change the 7 LSB of the address port. The
854            MSB (busy flag) should be clear initially, set after the write. */
855         save = inb_p(address + LM78_ADDR_REG_OFFSET);
856         if (save & 0x80)
857                 goto release;
858         val = ~save & 0x7f;
859         outb_p(val, address + LM78_ADDR_REG_OFFSET);
860         if (inb_p(address + LM78_ADDR_REG_OFFSET) != (val | 0x80)) {
861                 outb_p(save, address + LM78_ADDR_REG_OFFSET);
862                 goto release;
863         }
864
865         /* We found a device, now see if it could be an LM78 */
866         outb_p(LM78_REG_CONFIG, address + LM78_ADDR_REG_OFFSET);
867         val = inb_p(address + LM78_DATA_REG_OFFSET);
868         if (val & 0x80)
869                 goto release;
870         outb_p(LM78_REG_I2C_ADDR, address + LM78_ADDR_REG_OFFSET);
871         val = inb_p(address + LM78_DATA_REG_OFFSET);
872         if (val < 0x03 || val > 0x77)   /* Not a valid I2C address */
873                 goto release;
874
875         /* The busy flag should be clear again */
876         if (inb_p(address + LM78_ADDR_REG_OFFSET) & 0x80)
877                 goto release;
878
879         /* Explicitly prevent the misdetection of Winbond chips */
880         outb_p(0x4f, address + LM78_ADDR_REG_OFFSET);
881         val = inb_p(address + LM78_DATA_REG_OFFSET);
882         if (val == 0xa3 || val == 0x5c)
883                 goto release;
884
885         /* Explicitly prevent the misdetection of ITE chips */
886         outb_p(0x58, address + LM78_ADDR_REG_OFFSET);
887         val = inb_p(address + LM78_DATA_REG_OFFSET);
888         if (val == 0x90)
889                 goto release;
890
891         /* Determine the chip type */
892         outb_p(LM78_REG_CHIPID, address + LM78_ADDR_REG_OFFSET);
893         val = inb_p(address + LM78_DATA_REG_OFFSET);
894         if (val == 0x00 || val == 0x20  /* LM78 */
895          || val == 0x40                 /* LM78-J */
896          || (val & 0xfe) == 0xc0)       /* LM79 */
897                 found = 1;
898
899         if (found)
900                 pr_info("lm78: Found an %s chip at %#x\n",
901                         val & 0x80 ? "LM79" : "LM78", (int)address);
902
903  release:
904         release_region(address, LM78_EXTENT);
905         return found;
906 }
907
908 static int __init lm78_isa_device_add(unsigned short address)
909 {
910         struct resource res = {
911                 .start  = address,
912                 .end    = address + LM78_EXTENT - 1,
913                 .name   = "lm78",
914                 .flags  = IORESOURCE_IO,
915         };
916         int err;
917
918         pdev = platform_device_alloc("lm78", address);
919         if (!pdev) {
920                 err = -ENOMEM;
921                 printk(KERN_ERR "lm78: Device allocation failed\n");
922                 goto exit;
923         }
924
925         err = platform_device_add_resources(pdev, &res, 1);
926         if (err) {
927                 printk(KERN_ERR "lm78: Device resource addition failed "
928                        "(%d)\n", err);
929                 goto exit_device_put;
930         }
931
932         err = platform_device_add(pdev);
933         if (err) {
934                 printk(KERN_ERR "lm78: Device addition failed (%d)\n",
935                        err);
936                 goto exit_device_put;
937         }
938
939         return 0;
940
941  exit_device_put:
942         platform_device_put(pdev);
943  exit:
944         pdev = NULL;
945         return err;
946 }
947
948 static int __init sm_lm78_init(void)
949 {
950         int res;
951
952         res = i2c_add_driver(&lm78_driver);
953         if (res)
954                 goto exit;
955
956         if (lm78_isa_found(isa_address)) {
957                 res = platform_driver_register(&lm78_isa_driver);
958                 if (res)
959                         goto exit_unreg_i2c_driver;
960
961                 /* Sets global pdev as a side effect */
962                 res = lm78_isa_device_add(isa_address);
963                 if (res)
964                         goto exit_unreg_isa_driver;
965         }
966
967         return 0;
968
969  exit_unreg_isa_driver:
970         platform_driver_unregister(&lm78_isa_driver);
971  exit_unreg_i2c_driver:
972         i2c_del_driver(&lm78_driver);
973  exit:
974         return res;
975 }
976
977 static void __exit sm_lm78_exit(void)
978 {
979         if (pdev) {
980                 platform_device_unregister(pdev);
981                 platform_driver_unregister(&lm78_isa_driver);
982         }
983         i2c_del_driver(&lm78_driver);
984 }
985
986
987
988 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
989 MODULE_DESCRIPTION("LM78/LM79 driver");
990 MODULE_LICENSE("GPL");
991
992 module_init(sm_lm78_init);
993 module_exit(sm_lm78_exit);