xref: /linux/drivers/hwmon/lm78.c (revision 20d0021394c1b070bf04b22c5bc8fdb437edd4c5)
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 
6     This program is free software; you can redistribute it and/or modify
7     it under the terms of the GNU General Public License as published by
8     the Free Software Foundation; either version 2 of the License, or
9     (at your option) any later version.
10 
11     This program is distributed in the hope that it will be useful,
12     but WITHOUT ANY WARRANTY; without even the implied warranty of
13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14     GNU General Public License for more details.
15 
16     You should have received a copy of the GNU General Public License
17     along with this program; if not, write to the Free Software
18     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 */
20 
21 #include <linux/module.h>
22 #include <linux/init.h>
23 #include <linux/slab.h>
24 #include <linux/jiffies.h>
25 #include <linux/i2c.h>
26 #include <linux/i2c-sensor.h>
27 #include <asm/io.h>
28 
29 /* Addresses to scan */
30 static unsigned short normal_i2c[] = { 0x20, 0x21, 0x22, 0x23, 0x24,
31 					0x25, 0x26, 0x27, 0x28, 0x29,
32 					0x2a, 0x2b, 0x2c, 0x2d, 0x2e,
33 					0x2f, I2C_CLIENT_END };
34 static unsigned int normal_isa[] = { 0x0290, I2C_CLIENT_ISA_END };
35 
36 /* Insmod parameters */
37 SENSORS_INSMOD_3(lm78, lm78j, lm79);
38 
39 /* Many LM78 constants specified below */
40 
41 /* Length of ISA address segment */
42 #define LM78_EXTENT 8
43 
44 /* Where are the ISA address/data registers relative to the base address */
45 #define LM78_ADDR_REG_OFFSET 5
46 #define LM78_DATA_REG_OFFSET 6
47 
48 /* The LM78 registers */
49 #define LM78_REG_IN_MAX(nr) (0x2b + (nr) * 2)
50 #define LM78_REG_IN_MIN(nr) (0x2c + (nr) * 2)
51 #define LM78_REG_IN(nr) (0x20 + (nr))
52 
53 #define LM78_REG_FAN_MIN(nr) (0x3b + (nr))
54 #define LM78_REG_FAN(nr) (0x28 + (nr))
55 
56 #define LM78_REG_TEMP 0x27
57 #define LM78_REG_TEMP_OVER 0x39
58 #define LM78_REG_TEMP_HYST 0x3a
59 
60 #define LM78_REG_ALARM1 0x41
61 #define LM78_REG_ALARM2 0x42
62 
63 #define LM78_REG_VID_FANDIV 0x47
64 
65 #define LM78_REG_CONFIG 0x40
66 #define LM78_REG_CHIPID 0x49
67 #define LM78_REG_I2C_ADDR 0x48
68 
69 
70 /* Conversions. Rounding and limit checking is only done on the TO_REG
71    variants. */
72 
73 /* IN: mV, (0V to 4.08V)
74    REG: 16mV/bit */
75 static inline u8 IN_TO_REG(unsigned long val)
76 {
77 	unsigned long nval = SENSORS_LIMIT(val, 0, 4080);
78 	return (nval + 8) / 16;
79 }
80 #define IN_FROM_REG(val) ((val) *  16)
81 
82 static inline u8 FAN_TO_REG(long rpm, int div)
83 {
84 	if (rpm <= 0)
85 		return 255;
86 	return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
87 }
88 
89 static inline int FAN_FROM_REG(u8 val, int div)
90 {
91 	return val==0 ? -1 : val==255 ? 0 : 1350000/(val*div);
92 }
93 
94 /* TEMP: mC (-128C to +127C)
95    REG: 1C/bit, two's complement */
96 static inline s8 TEMP_TO_REG(int val)
97 {
98 	int nval = SENSORS_LIMIT(val, -128000, 127000) ;
99 	return nval<0 ? (nval-500)/1000 : (nval+500)/1000;
100 }
101 
102 static inline int TEMP_FROM_REG(s8 val)
103 {
104 	return val * 1000;
105 }
106 
107 /* VID: mV
108    REG: (see doc/vid) */
109 static inline int VID_FROM_REG(u8 val)
110 {
111 	return val==0x1f ? 0 : val>=0x10 ? 5100-val*100 : 2050-val*50;
112 }
113 
114 #define DIV_FROM_REG(val) (1 << (val))
115 
116 /* There are some complications in a module like this. First off, LM78 chips
117    may be both present on the SMBus and the ISA bus, and we have to handle
118    those cases separately at some places. Second, there might be several
119    LM78 chips available (well, actually, that is probably never done; but
120    it is a clean illustration of how to handle a case like that). Finally,
121    a specific chip may be attached to *both* ISA and SMBus, and we would
122    not like to detect it double. Fortunately, in the case of the LM78 at
123    least, a register tells us what SMBus address we are on, so that helps
124    a bit - except if there could be more than one SMBus. Groan. No solution
125    for this yet. */
126 
127 /* This module may seem overly long and complicated. In fact, it is not so
128    bad. Quite a lot of bookkeeping is done. A real driver can often cut
129    some corners. */
130 
131 /* For each registered LM78, we need to keep some data in memory. That
132    data is pointed to by lm78_list[NR]->data. The structure itself is
133    dynamically allocated, at the same time when a new lm78 client is
134    allocated. */
135 struct lm78_data {
136 	struct i2c_client client;
137 	struct semaphore lock;
138 	enum chips type;
139 
140 	struct semaphore update_lock;
141 	char valid;		/* !=0 if following fields are valid */
142 	unsigned long last_updated;	/* In jiffies */
143 
144 	u8 in[7];		/* Register value */
145 	u8 in_max[7];		/* Register value */
146 	u8 in_min[7];		/* Register value */
147 	u8 fan[3];		/* Register value */
148 	u8 fan_min[3];		/* Register value */
149 	s8 temp;		/* Register value */
150 	s8 temp_over;		/* Register value */
151 	s8 temp_hyst;		/* Register value */
152 	u8 fan_div[3];		/* Register encoding, shifted right */
153 	u8 vid;			/* Register encoding, combined */
154 	u16 alarms;		/* Register encoding, combined */
155 };
156 
157 
158 static int lm78_attach_adapter(struct i2c_adapter *adapter);
159 static int lm78_detect(struct i2c_adapter *adapter, int address, int kind);
160 static int lm78_detach_client(struct i2c_client *client);
161 
162 static int lm78_read_value(struct i2c_client *client, u8 register);
163 static int lm78_write_value(struct i2c_client *client, u8 register, u8 value);
164 static struct lm78_data *lm78_update_device(struct device *dev);
165 static void lm78_init_client(struct i2c_client *client);
166 
167 
168 static struct i2c_driver lm78_driver = {
169 	.owner		= THIS_MODULE,
170 	.name		= "lm78",
171 	.id		= I2C_DRIVERID_LM78,
172 	.flags		= I2C_DF_NOTIFY,
173 	.attach_adapter	= lm78_attach_adapter,
174 	.detach_client	= lm78_detach_client,
175 };
176 
177 /* 7 Voltages */
178 static ssize_t show_in(struct device *dev, char *buf, int nr)
179 {
180 	struct lm78_data *data = lm78_update_device(dev);
181 	return sprintf(buf, "%d\n", IN_FROM_REG(data->in[nr]));
182 }
183 
184 static ssize_t show_in_min(struct device *dev, char *buf, int nr)
185 {
186 	struct lm78_data *data = lm78_update_device(dev);
187 	return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[nr]));
188 }
189 
190 static ssize_t show_in_max(struct device *dev, char *buf, int nr)
191 {
192 	struct lm78_data *data = lm78_update_device(dev);
193 	return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[nr]));
194 }
195 
196 static ssize_t set_in_min(struct device *dev, const char *buf,
197 		size_t count, int nr)
198 {
199 	struct i2c_client *client = to_i2c_client(dev);
200 	struct lm78_data *data = i2c_get_clientdata(client);
201 	unsigned long val = simple_strtoul(buf, NULL, 10);
202 
203 	down(&data->update_lock);
204 	data->in_min[nr] = IN_TO_REG(val);
205 	lm78_write_value(client, LM78_REG_IN_MIN(nr), data->in_min[nr]);
206 	up(&data->update_lock);
207 	return count;
208 }
209 
210 static ssize_t set_in_max(struct device *dev, const char *buf,
211 		size_t count, int nr)
212 {
213 	struct i2c_client *client = to_i2c_client(dev);
214 	struct lm78_data *data = i2c_get_clientdata(client);
215 	unsigned long val = simple_strtoul(buf, NULL, 10);
216 
217 	down(&data->update_lock);
218 	data->in_max[nr] = IN_TO_REG(val);
219 	lm78_write_value(client, LM78_REG_IN_MAX(nr), data->in_max[nr]);
220 	up(&data->update_lock);
221 	return count;
222 }
223 
224 #define show_in_offset(offset)					\
225 static ssize_t							\
226 	show_in##offset (struct device *dev, struct device_attribute *attr, char *buf)		\
227 {								\
228 	return show_in(dev, buf, offset);			\
229 }								\
230 static DEVICE_ATTR(in##offset##_input, S_IRUGO, 		\
231 		show_in##offset, NULL);				\
232 static ssize_t							\
233 	show_in##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)   \
234 {								\
235 	return show_in_min(dev, buf, offset);			\
236 }								\
237 static ssize_t							\
238 	show_in##offset##_max (struct device *dev, struct device_attribute *attr, char *buf)   \
239 {								\
240 	return show_in_max(dev, buf, offset);			\
241 }								\
242 static ssize_t set_in##offset##_min (struct device *dev, struct device_attribute *attr,	\
243 		const char *buf, size_t count)			\
244 {								\
245 	return set_in_min(dev, buf, count, offset);		\
246 }								\
247 static ssize_t set_in##offset##_max (struct device *dev, struct device_attribute *attr,	\
248 		const char *buf, size_t count)			\
249 {								\
250 	return set_in_max(dev, buf, count, offset);		\
251 }								\
252 static DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR,		\
253 		show_in##offset##_min, set_in##offset##_min);	\
254 static DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR,		\
255 		show_in##offset##_max, set_in##offset##_max);
256 
257 show_in_offset(0);
258 show_in_offset(1);
259 show_in_offset(2);
260 show_in_offset(3);
261 show_in_offset(4);
262 show_in_offset(5);
263 show_in_offset(6);
264 
265 /* Temperature */
266 static ssize_t show_temp(struct device *dev, struct device_attribute *attr, char *buf)
267 {
268 	struct lm78_data *data = lm78_update_device(dev);
269 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp));
270 }
271 
272 static ssize_t show_temp_over(struct device *dev, struct device_attribute *attr, char *buf)
273 {
274 	struct lm78_data *data = lm78_update_device(dev);
275 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over));
276 }
277 
278 static ssize_t set_temp_over(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
279 {
280 	struct i2c_client *client = to_i2c_client(dev);
281 	struct lm78_data *data = i2c_get_clientdata(client);
282 	long val = simple_strtol(buf, NULL, 10);
283 
284 	down(&data->update_lock);
285 	data->temp_over = TEMP_TO_REG(val);
286 	lm78_write_value(client, LM78_REG_TEMP_OVER, data->temp_over);
287 	up(&data->update_lock);
288 	return count;
289 }
290 
291 static ssize_t show_temp_hyst(struct device *dev, struct device_attribute *attr, char *buf)
292 {
293 	struct lm78_data *data = lm78_update_device(dev);
294 	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst));
295 }
296 
297 static ssize_t set_temp_hyst(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
298 {
299 	struct i2c_client *client = to_i2c_client(dev);
300 	struct lm78_data *data = i2c_get_clientdata(client);
301 	long val = simple_strtol(buf, NULL, 10);
302 
303 	down(&data->update_lock);
304 	data->temp_hyst = TEMP_TO_REG(val);
305 	lm78_write_value(client, LM78_REG_TEMP_HYST, data->temp_hyst);
306 	up(&data->update_lock);
307 	return count;
308 }
309 
310 static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL);
311 static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR,
312 		show_temp_over, set_temp_over);
313 static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR,
314 		show_temp_hyst, set_temp_hyst);
315 
316 /* 3 Fans */
317 static ssize_t show_fan(struct device *dev, char *buf, int nr)
318 {
319 	struct lm78_data *data = lm78_update_device(dev);
320 	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
321 		DIV_FROM_REG(data->fan_div[nr])) );
322 }
323 
324 static ssize_t show_fan_min(struct device *dev, char *buf, int nr)
325 {
326 	struct lm78_data *data = lm78_update_device(dev);
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, const char *buf,
332 		size_t count, int nr)
333 {
334 	struct i2c_client *client = to_i2c_client(dev);
335 	struct lm78_data *data = i2c_get_clientdata(client);
336 	unsigned long val = simple_strtoul(buf, NULL, 10);
337 
338 	down(&data->update_lock);
339 	data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
340 	lm78_write_value(client, LM78_REG_FAN_MIN(nr), data->fan_min[nr]);
341 	up(&data->update_lock);
342 	return count;
343 }
344 
345 static ssize_t show_fan_div(struct device *dev, char *buf, int nr)
346 {
347 	struct lm78_data *data = lm78_update_device(dev);
348 	return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]) );
349 }
350 
351 /* Note: we save and restore the fan minimum here, because its value is
352    determined in part by the fan divisor.  This follows the principle of
353    least suprise; the user doesn't expect the fan minimum to change just
354    because the divisor changed. */
355 static ssize_t set_fan_div(struct device *dev, const char *buf,
356 	size_t count, int nr)
357 {
358 	struct i2c_client *client = to_i2c_client(dev);
359 	struct lm78_data *data = i2c_get_clientdata(client);
360 	unsigned long val = simple_strtoul(buf, NULL, 10);
361 	unsigned long min;
362 	u8 reg;
363 
364 	down(&data->update_lock);
365 	min = FAN_FROM_REG(data->fan_min[nr],
366 			   DIV_FROM_REG(data->fan_div[nr]));
367 
368 	switch (val) {
369 	case 1: data->fan_div[nr] = 0; break;
370 	case 2: data->fan_div[nr] = 1; break;
371 	case 4: data->fan_div[nr] = 2; break;
372 	case 8: data->fan_div[nr] = 3; break;
373 	default:
374 		dev_err(&client->dev, "fan_div value %ld not "
375 			"supported. Choose one of 1, 2, 4 or 8!\n", val);
376 		up(&data->update_lock);
377 		return -EINVAL;
378 	}
379 
380 	reg = lm78_read_value(client, LM78_REG_VID_FANDIV);
381 	switch (nr) {
382 	case 0:
383 		reg = (reg & 0xcf) | (data->fan_div[nr] << 4);
384 		break;
385 	case 1:
386 		reg = (reg & 0x3f) | (data->fan_div[nr] << 6);
387 		break;
388 	}
389 	lm78_write_value(client, LM78_REG_VID_FANDIV, reg);
390 
391 	data->fan_min[nr] =
392 		FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
393 	lm78_write_value(client, LM78_REG_FAN_MIN(nr), data->fan_min[nr]);
394 	up(&data->update_lock);
395 
396 	return count;
397 }
398 
399 #define show_fan_offset(offset)						\
400 static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf)	\
401 {									\
402 	return show_fan(dev, buf, offset - 1);				\
403 }									\
404 static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf)  \
405 {									\
406 	return show_fan_min(dev, buf, offset - 1);			\
407 }									\
408 static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf)  \
409 {									\
410 	return show_fan_div(dev, buf, offset - 1);			\
411 }									\
412 static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr,		\
413 		const char *buf, size_t count)				\
414 {									\
415 	return set_fan_min(dev, buf, count, offset - 1);		\
416 }									\
417 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset, NULL);\
418 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,		\
419 		show_fan_##offset##_min, set_fan_##offset##_min);
420 
421 static ssize_t set_fan_1_div(struct device *dev, struct device_attribute *attr, const char *buf,
422 		size_t count)
423 {
424 	return set_fan_div(dev, buf, count, 0) ;
425 }
426 
427 static ssize_t set_fan_2_div(struct device *dev, struct device_attribute *attr, const char *buf,
428 		size_t count)
429 {
430 	return set_fan_div(dev, buf, count, 1) ;
431 }
432 
433 show_fan_offset(1);
434 show_fan_offset(2);
435 show_fan_offset(3);
436 
437 /* Fan 3 divisor is locked in H/W */
438 static DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
439 		show_fan_1_div, set_fan_1_div);
440 static DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
441 		show_fan_2_div, set_fan_2_div);
442 static DEVICE_ATTR(fan3_div, S_IRUGO, show_fan_3_div, NULL);
443 
444 /* VID */
445 static ssize_t show_vid(struct device *dev, struct device_attribute *attr, char *buf)
446 {
447 	struct lm78_data *data = lm78_update_device(dev);
448 	return sprintf(buf, "%d\n", VID_FROM_REG(data->vid));
449 }
450 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
451 
452 /* Alarms */
453 static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf)
454 {
455 	struct lm78_data *data = lm78_update_device(dev);
456 	return sprintf(buf, "%u\n", data->alarms);
457 }
458 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
459 
460 /* This function is called when:
461      * lm78_driver is inserted (when this module is loaded), for each
462        available adapter
463      * when a new adapter is inserted (and lm78_driver is still present) */
464 static int lm78_attach_adapter(struct i2c_adapter *adapter)
465 {
466 	if (!(adapter->class & I2C_CLASS_HWMON))
467 		return 0;
468 	return i2c_detect(adapter, &addr_data, lm78_detect);
469 }
470 
471 /* This function is called by i2c_detect */
472 int lm78_detect(struct i2c_adapter *adapter, int address, int kind)
473 {
474 	int i, err;
475 	struct i2c_client *new_client;
476 	struct lm78_data *data;
477 	const char *client_name = "";
478 	int is_isa = i2c_is_isa_adapter(adapter);
479 
480 	if (!is_isa &&
481 	    !i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
482 		err = -ENODEV;
483 		goto ERROR0;
484 	}
485 
486 	/* Reserve the ISA region */
487 	if (is_isa)
488 		if (!request_region(address, LM78_EXTENT, lm78_driver.name)) {
489 			err = -EBUSY;
490 			goto ERROR0;
491 		}
492 
493 	/* Probe whether there is anything available on this address. Already
494 	   done for SMBus clients */
495 	if (kind < 0) {
496 		if (is_isa) {
497 
498 #define REALLY_SLOW_IO
499 			/* We need the timeouts for at least some LM78-like
500 			   chips. But only if we read 'undefined' registers. */
501 			i = inb_p(address + 1);
502 			if (inb_p(address + 2) != i) {
503 				err = -ENODEV;
504 				goto ERROR1;
505 			}
506 			if (inb_p(address + 3) != i) {
507 				err = -ENODEV;
508 				goto ERROR1;
509 			}
510 			if (inb_p(address + 7) != i) {
511 				err = -ENODEV;
512 				goto ERROR1;
513 			}
514 #undef REALLY_SLOW_IO
515 
516 			/* Let's just hope nothing breaks here */
517 			i = inb_p(address + 5) & 0x7f;
518 			outb_p(~i & 0x7f, address + 5);
519 			if ((inb_p(address + 5) & 0x7f) != (~i & 0x7f)) {
520 				outb_p(i, address + 5);
521 				err = -ENODEV;
522 				goto ERROR1;
523 			}
524 		}
525 	}
526 
527 	/* OK. For now, we presume we have a valid client. We now create the
528 	   client structure, even though we cannot fill it completely yet.
529 	   But it allows us to access lm78_{read,write}_value. */
530 
531 	if (!(data = kmalloc(sizeof(struct lm78_data), GFP_KERNEL))) {
532 		err = -ENOMEM;
533 		goto ERROR1;
534 	}
535 	memset(data, 0, sizeof(struct lm78_data));
536 
537 	new_client = &data->client;
538 	if (is_isa)
539 		init_MUTEX(&data->lock);
540 	i2c_set_clientdata(new_client, data);
541 	new_client->addr = address;
542 	new_client->adapter = adapter;
543 	new_client->driver = &lm78_driver;
544 	new_client->flags = 0;
545 
546 	/* Now, we do the remaining detection. */
547 	if (kind < 0) {
548 		if (lm78_read_value(new_client, LM78_REG_CONFIG) & 0x80) {
549 			err = -ENODEV;
550 			goto ERROR2;
551 		}
552 		if (!is_isa && (lm78_read_value(
553 				new_client, LM78_REG_I2C_ADDR) != address)) {
554 			err = -ENODEV;
555 			goto ERROR2;
556 		}
557 	}
558 
559 	/* Determine the chip type. */
560 	if (kind <= 0) {
561 		i = lm78_read_value(new_client, LM78_REG_CHIPID);
562 		if (i == 0x00 || i == 0x20)
563 			kind = lm78;
564 		else if (i == 0x40)
565 			kind = lm78j;
566 		else if ((i & 0xfe) == 0xc0)
567 			kind = lm79;
568 		else {
569 			if (kind == 0)
570 				dev_warn(&adapter->dev, "Ignoring 'force' "
571 					"parameter for unknown chip at "
572 					"adapter %d, address 0x%02x\n",
573 					i2c_adapter_id(adapter), address);
574 			err = -ENODEV;
575 			goto ERROR2;
576 		}
577 	}
578 
579 	if (kind == lm78) {
580 		client_name = "lm78";
581 	} else if (kind == lm78j) {
582 		client_name = "lm78-j";
583 	} else if (kind == lm79) {
584 		client_name = "lm79";
585 	}
586 
587 	/* Fill in the remaining client fields and put into the global list */
588 	strlcpy(new_client->name, client_name, I2C_NAME_SIZE);
589 	data->type = kind;
590 
591 	data->valid = 0;
592 	init_MUTEX(&data->update_lock);
593 
594 	/* Tell the I2C layer a new client has arrived */
595 	if ((err = i2c_attach_client(new_client)))
596 		goto ERROR2;
597 
598 	/* Initialize the LM78 chip */
599 	lm78_init_client(new_client);
600 
601 	/* A few vars need to be filled upon startup */
602 	for (i = 0; i < 3; i++) {
603 		data->fan_min[i] = lm78_read_value(new_client,
604 					LM78_REG_FAN_MIN(i));
605 	}
606 
607 	/* Register sysfs hooks */
608 	device_create_file(&new_client->dev, &dev_attr_in0_input);
609 	device_create_file(&new_client->dev, &dev_attr_in0_min);
610 	device_create_file(&new_client->dev, &dev_attr_in0_max);
611 	device_create_file(&new_client->dev, &dev_attr_in1_input);
612 	device_create_file(&new_client->dev, &dev_attr_in1_min);
613 	device_create_file(&new_client->dev, &dev_attr_in1_max);
614 	device_create_file(&new_client->dev, &dev_attr_in2_input);
615 	device_create_file(&new_client->dev, &dev_attr_in2_min);
616 	device_create_file(&new_client->dev, &dev_attr_in2_max);
617 	device_create_file(&new_client->dev, &dev_attr_in3_input);
618 	device_create_file(&new_client->dev, &dev_attr_in3_min);
619 	device_create_file(&new_client->dev, &dev_attr_in3_max);
620 	device_create_file(&new_client->dev, &dev_attr_in4_input);
621 	device_create_file(&new_client->dev, &dev_attr_in4_min);
622 	device_create_file(&new_client->dev, &dev_attr_in4_max);
623 	device_create_file(&new_client->dev, &dev_attr_in5_input);
624 	device_create_file(&new_client->dev, &dev_attr_in5_min);
625 	device_create_file(&new_client->dev, &dev_attr_in5_max);
626 	device_create_file(&new_client->dev, &dev_attr_in6_input);
627 	device_create_file(&new_client->dev, &dev_attr_in6_min);
628 	device_create_file(&new_client->dev, &dev_attr_in6_max);
629 	device_create_file(&new_client->dev, &dev_attr_temp1_input);
630 	device_create_file(&new_client->dev, &dev_attr_temp1_max);
631 	device_create_file(&new_client->dev, &dev_attr_temp1_max_hyst);
632 	device_create_file(&new_client->dev, &dev_attr_fan1_input);
633 	device_create_file(&new_client->dev, &dev_attr_fan1_min);
634 	device_create_file(&new_client->dev, &dev_attr_fan1_div);
635 	device_create_file(&new_client->dev, &dev_attr_fan2_input);
636 	device_create_file(&new_client->dev, &dev_attr_fan2_min);
637 	device_create_file(&new_client->dev, &dev_attr_fan2_div);
638 	device_create_file(&new_client->dev, &dev_attr_fan3_input);
639 	device_create_file(&new_client->dev, &dev_attr_fan3_min);
640 	device_create_file(&new_client->dev, &dev_attr_fan3_div);
641 	device_create_file(&new_client->dev, &dev_attr_alarms);
642 	device_create_file(&new_client->dev, &dev_attr_cpu0_vid);
643 
644 	return 0;
645 
646 ERROR2:
647 	kfree(data);
648 ERROR1:
649 	if (is_isa)
650 		release_region(address, LM78_EXTENT);
651 ERROR0:
652 	return err;
653 }
654 
655 static int lm78_detach_client(struct i2c_client *client)
656 {
657 	int err;
658 
659 	if ((err = i2c_detach_client(client))) {
660 		dev_err(&client->dev,
661 		    "Client deregistration failed, client not detached.\n");
662 		return err;
663 	}
664 
665 	if(i2c_is_isa_client(client))
666 		release_region(client->addr, LM78_EXTENT);
667 
668 	kfree(i2c_get_clientdata(client));
669 
670 	return 0;
671 }
672 
673 /* The SMBus locks itself, but ISA access must be locked explicitly!
674    We don't want to lock the whole ISA bus, so we lock each client
675    separately.
676    We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks,
677    would slow down the LM78 access and should not be necessary.  */
678 static int lm78_read_value(struct i2c_client *client, u8 reg)
679 {
680 	int res;
681 	if (i2c_is_isa_client(client)) {
682 		struct lm78_data *data = i2c_get_clientdata(client);
683 		down(&data->lock);
684 		outb_p(reg, client->addr + LM78_ADDR_REG_OFFSET);
685 		res = inb_p(client->addr + LM78_DATA_REG_OFFSET);
686 		up(&data->lock);
687 		return res;
688 	} else
689 		return i2c_smbus_read_byte_data(client, reg);
690 }
691 
692 /* The SMBus locks itself, but ISA access muse be locked explicitly!
693    We don't want to lock the whole ISA bus, so we lock each client
694    separately.
695    We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks,
696    would slow down the LM78 access and should not be necessary.
697    There are some ugly typecasts here, but the good new is - they should
698    nowhere else be necessary! */
699 static int lm78_write_value(struct i2c_client *client, u8 reg, u8 value)
700 {
701 	if (i2c_is_isa_client(client)) {
702 		struct lm78_data *data = i2c_get_clientdata(client);
703 		down(&data->lock);
704 		outb_p(reg, client->addr + LM78_ADDR_REG_OFFSET);
705 		outb_p(value, client->addr + LM78_DATA_REG_OFFSET);
706 		up(&data->lock);
707 		return 0;
708 	} else
709 		return i2c_smbus_write_byte_data(client, reg, value);
710 }
711 
712 /* Called when we have found a new LM78. It should set limits, etc. */
713 static void lm78_init_client(struct i2c_client *client)
714 {
715 	u8 config = lm78_read_value(client, LM78_REG_CONFIG);
716 
717 	/* Start monitoring */
718 	if (!(config & 0x01))
719 		lm78_write_value(client, LM78_REG_CONFIG,
720 				 (config & 0xf7) | 0x01);
721 }
722 
723 static struct lm78_data *lm78_update_device(struct device *dev)
724 {
725 	struct i2c_client *client = to_i2c_client(dev);
726 	struct lm78_data *data = i2c_get_clientdata(client);
727 	int i;
728 
729 	down(&data->update_lock);
730 
731 	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
732 	    || !data->valid) {
733 
734 		dev_dbg(&client->dev, "Starting lm78 update\n");
735 
736 		for (i = 0; i <= 6; i++) {
737 			data->in[i] =
738 			    lm78_read_value(client, LM78_REG_IN(i));
739 			data->in_min[i] =
740 			    lm78_read_value(client, LM78_REG_IN_MIN(i));
741 			data->in_max[i] =
742 			    lm78_read_value(client, LM78_REG_IN_MAX(i));
743 		}
744 		for (i = 0; i < 3; i++) {
745 			data->fan[i] =
746 			    lm78_read_value(client, LM78_REG_FAN(i));
747 			data->fan_min[i] =
748 			    lm78_read_value(client, LM78_REG_FAN_MIN(i));
749 		}
750 		data->temp = lm78_read_value(client, LM78_REG_TEMP);
751 		data->temp_over =
752 		    lm78_read_value(client, LM78_REG_TEMP_OVER);
753 		data->temp_hyst =
754 		    lm78_read_value(client, LM78_REG_TEMP_HYST);
755 		i = lm78_read_value(client, LM78_REG_VID_FANDIV);
756 		data->vid = i & 0x0f;
757 		if (data->type == lm79)
758 			data->vid |=
759 			    (lm78_read_value(client, LM78_REG_CHIPID) &
760 			     0x01) << 4;
761 		else
762 			data->vid |= 0x10;
763 		data->fan_div[0] = (i >> 4) & 0x03;
764 		data->fan_div[1] = i >> 6;
765 		data->alarms = lm78_read_value(client, LM78_REG_ALARM1) +
766 		    (lm78_read_value(client, LM78_REG_ALARM2) << 8);
767 		data->last_updated = jiffies;
768 		data->valid = 1;
769 
770 		data->fan_div[2] = 1;
771 	}
772 
773 	up(&data->update_lock);
774 
775 	return data;
776 }
777 
778 static int __init sm_lm78_init(void)
779 {
780 	return i2c_add_driver(&lm78_driver);
781 }
782 
783 static void __exit sm_lm78_exit(void)
784 {
785 	i2c_del_driver(&lm78_driver);
786 }
787 
788 
789 
790 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
791 MODULE_DESCRIPTION("LM78, LM78-J and LM79 driver");
792 MODULE_LICENSE("GPL");
793 
794 module_init(sm_lm78_init);
795 module_exit(sm_lm78_exit);
796