xref: /linux/drivers/hwmon/w83627hf.c (revision 2b8232ce512105e28453f301d1510de8363bccd1)
1 /*
2     w83627hf.c - Part of lm_sensors, Linux kernel modules for hardware
3                 monitoring
4     Copyright (c) 1998 - 2003  Frodo Looijaard <frodol@dds.nl>,
5     Philip Edelbrock <phil@netroedge.com>,
6     and Mark Studebaker <mdsxyz123@yahoo.com>
7     Ported to 2.6 by Bernhard C. Schrenk <clemy@clemy.org>
8     Copyright (c) 2007  Jean Delvare <khali@linux-fr.org>
9 
10     This program is free software; you can redistribute it and/or modify
11     it under the terms of the GNU General Public License as published by
12     the Free Software Foundation; either version 2 of the License, or
13     (at your option) any later version.
14 
15     This program is distributed in the hope that it will be useful,
16     but WITHOUT ANY WARRANTY; without even the implied warranty of
17     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18     GNU General Public License for more details.
19 
20     You should have received a copy of the GNU General Public License
21     along with this program; if not, write to the Free Software
22     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 */
24 
25 /*
26     Supports following chips:
27 
28     Chip	#vin	#fanin	#pwm	#temp	wchipid	vendid	i2c	ISA
29     w83627hf	9	3	2	3	0x20	0x5ca3	no	yes(LPC)
30     w83627thf	7	3	3	3	0x90	0x5ca3	no	yes(LPC)
31     w83637hf	7	3	3	3	0x80	0x5ca3	no	yes(LPC)
32     w83687thf	7	3	3	3	0x90	0x5ca3	no	yes(LPC)
33     w83697hf	8	2	2	2	0x60	0x5ca3	no	yes(LPC)
34 
35     For other winbond chips, and for i2c support in the above chips,
36     use w83781d.c.
37 
38     Note: automatic ("cruise") fan control for 697, 637 & 627thf not
39     supported yet.
40 */
41 
42 #include <linux/module.h>
43 #include <linux/init.h>
44 #include <linux/slab.h>
45 #include <linux/jiffies.h>
46 #include <linux/platform_device.h>
47 #include <linux/hwmon.h>
48 #include <linux/hwmon-vid.h>
49 #include <linux/err.h>
50 #include <linux/mutex.h>
51 #include <linux/ioport.h>
52 #include <asm/io.h>
53 #include "lm75.h"
54 
55 static struct platform_device *pdev;
56 
57 #define DRVNAME "w83627hf"
58 enum chips { w83627hf, w83627thf, w83697hf, w83637hf, w83687thf };
59 
60 static u16 force_addr;
61 module_param(force_addr, ushort, 0);
62 MODULE_PARM_DESC(force_addr,
63 		 "Initialize the base address of the sensors");
64 static u8 force_i2c = 0x1f;
65 module_param(force_i2c, byte, 0);
66 MODULE_PARM_DESC(force_i2c,
67 		 "Initialize the i2c address of the sensors");
68 
69 static int reset;
70 module_param(reset, bool, 0);
71 MODULE_PARM_DESC(reset, "Set to one to reset chip on load");
72 
73 static int init = 1;
74 module_param(init, bool, 0);
75 MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");
76 
77 /* modified from kernel/include/traps.c */
78 static int REG;		/* The register to read/write */
79 #define	DEV	0x07	/* Register: Logical device select */
80 static int VAL;		/* The value to read/write */
81 
82 /* logical device numbers for superio_select (below) */
83 #define W83627HF_LD_FDC		0x00
84 #define W83627HF_LD_PRT		0x01
85 #define W83627HF_LD_UART1	0x02
86 #define W83627HF_LD_UART2	0x03
87 #define W83627HF_LD_KBC		0x05
88 #define W83627HF_LD_CIR		0x06 /* w83627hf only */
89 #define W83627HF_LD_GAME	0x07
90 #define W83627HF_LD_MIDI	0x07
91 #define W83627HF_LD_GPIO1	0x07
92 #define W83627HF_LD_GPIO5	0x07 /* w83627thf only */
93 #define W83627HF_LD_GPIO2	0x08
94 #define W83627HF_LD_GPIO3	0x09
95 #define W83627HF_LD_GPIO4	0x09 /* w83627thf only */
96 #define W83627HF_LD_ACPI	0x0a
97 #define W83627HF_LD_HWM		0x0b
98 
99 #define	DEVID	0x20	/* Register: Device ID */
100 
101 #define W83627THF_GPIO5_EN	0x30 /* w83627thf only */
102 #define W83627THF_GPIO5_IOSR	0xf3 /* w83627thf only */
103 #define W83627THF_GPIO5_DR	0xf4 /* w83627thf only */
104 
105 #define W83687THF_VID_EN	0x29 /* w83687thf only */
106 #define W83687THF_VID_CFG	0xF0 /* w83687thf only */
107 #define W83687THF_VID_DATA	0xF1 /* w83687thf only */
108 
109 static inline void
110 superio_outb(int reg, int val)
111 {
112 	outb(reg, REG);
113 	outb(val, VAL);
114 }
115 
116 static inline int
117 superio_inb(int reg)
118 {
119 	outb(reg, REG);
120 	return inb(VAL);
121 }
122 
123 static inline void
124 superio_select(int ld)
125 {
126 	outb(DEV, REG);
127 	outb(ld, VAL);
128 }
129 
130 static inline void
131 superio_enter(void)
132 {
133 	outb(0x87, REG);
134 	outb(0x87, REG);
135 }
136 
137 static inline void
138 superio_exit(void)
139 {
140 	outb(0xAA, REG);
141 }
142 
143 #define W627_DEVID 0x52
144 #define W627THF_DEVID 0x82
145 #define W697_DEVID 0x60
146 #define W637_DEVID 0x70
147 #define W687THF_DEVID 0x85
148 #define WINB_ACT_REG 0x30
149 #define WINB_BASE_REG 0x60
150 /* Constants specified below */
151 
152 /* Alignment of the base address */
153 #define WINB_ALIGNMENT		~7
154 
155 /* Offset & size of I/O region we are interested in */
156 #define WINB_REGION_OFFSET	5
157 #define WINB_REGION_SIZE	2
158 
159 /* Where are the sensors address/data registers relative to the region offset */
160 #define W83781D_ADDR_REG_OFFSET 0
161 #define W83781D_DATA_REG_OFFSET 1
162 
163 /* The W83781D registers */
164 /* The W83782D registers for nr=7,8 are in bank 5 */
165 #define W83781D_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
166 					   (0x554 + (((nr) - 7) * 2)))
167 #define W83781D_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
168 					   (0x555 + (((nr) - 7) * 2)))
169 #define W83781D_REG_IN(nr)     ((nr < 7) ? (0x20 + (nr)) : \
170 					   (0x550 + (nr) - 7))
171 
172 #define W83781D_REG_FAN_MIN(nr) (0x3a + (nr))
173 #define W83781D_REG_FAN(nr) (0x27 + (nr))
174 
175 #define W83781D_REG_TEMP2_CONFIG 0x152
176 #define W83781D_REG_TEMP3_CONFIG 0x252
177 #define W83781D_REG_TEMP(nr)		((nr == 3) ? (0x0250) : \
178 					((nr == 2) ? (0x0150) : \
179 					             (0x27)))
180 #define W83781D_REG_TEMP_HYST(nr)	((nr == 3) ? (0x253) : \
181 					((nr == 2) ? (0x153) : \
182 					             (0x3A)))
183 #define W83781D_REG_TEMP_OVER(nr)	((nr == 3) ? (0x255) : \
184 					((nr == 2) ? (0x155) : \
185 					             (0x39)))
186 
187 #define W83781D_REG_BANK 0x4E
188 
189 #define W83781D_REG_CONFIG 0x40
190 #define W83781D_REG_ALARM1 0x459
191 #define W83781D_REG_ALARM2 0x45A
192 #define W83781D_REG_ALARM3 0x45B
193 
194 #define W83781D_REG_BEEP_CONFIG 0x4D
195 #define W83781D_REG_BEEP_INTS1 0x56
196 #define W83781D_REG_BEEP_INTS2 0x57
197 #define W83781D_REG_BEEP_INTS3 0x453
198 
199 #define W83781D_REG_VID_FANDIV 0x47
200 
201 #define W83781D_REG_CHIPID 0x49
202 #define W83781D_REG_WCHIPID 0x58
203 #define W83781D_REG_CHIPMAN 0x4F
204 #define W83781D_REG_PIN 0x4B
205 
206 #define W83781D_REG_VBAT 0x5D
207 
208 #define W83627HF_REG_PWM1 0x5A
209 #define W83627HF_REG_PWM2 0x5B
210 
211 #define W83627THF_REG_PWM1		0x01	/* 697HF/637HF/687THF too */
212 #define W83627THF_REG_PWM2		0x03	/* 697HF/637HF/687THF too */
213 #define W83627THF_REG_PWM3		0x11	/* 637HF/687THF too */
214 
215 #define W83627THF_REG_VRM_OVT_CFG 	0x18	/* 637HF/687THF too */
216 
217 static const u8 regpwm_627hf[] = { W83627HF_REG_PWM1, W83627HF_REG_PWM2 };
218 static const u8 regpwm[] = { W83627THF_REG_PWM1, W83627THF_REG_PWM2,
219                              W83627THF_REG_PWM3 };
220 #define W836X7HF_REG_PWM(type, nr) (((type) == w83627hf) ? \
221                                      regpwm_627hf[(nr) - 1] : regpwm[(nr) - 1])
222 
223 #define W83627HF_REG_PWM_FREQ		0x5C	/* Only for the 627HF */
224 
225 #define W83637HF_REG_PWM_FREQ1		0x00	/* 697HF/687THF too */
226 #define W83637HF_REG_PWM_FREQ2		0x02	/* 697HF/687THF too */
227 #define W83637HF_REG_PWM_FREQ3		0x10	/* 687THF too */
228 
229 static const u8 W83637HF_REG_PWM_FREQ[] = { W83637HF_REG_PWM_FREQ1,
230 					W83637HF_REG_PWM_FREQ2,
231 					W83637HF_REG_PWM_FREQ3 };
232 
233 #define W83627HF_BASE_PWM_FREQ	46870
234 
235 #define W83781D_REG_I2C_ADDR 0x48
236 #define W83781D_REG_I2C_SUBADDR 0x4A
237 
238 /* Sensor selection */
239 #define W83781D_REG_SCFG1 0x5D
240 static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };
241 #define W83781D_REG_SCFG2 0x59
242 static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 };
243 #define W83781D_DEFAULT_BETA 3435
244 
245 /* Conversions. Limit checking is only done on the TO_REG
246    variants. Note that you should be a bit careful with which arguments
247    these macros are called: arguments may be evaluated more than once.
248    Fixing this is just not worth it. */
249 #define IN_TO_REG(val)  (SENSORS_LIMIT((((val) + 8)/16),0,255))
250 #define IN_FROM_REG(val) ((val) * 16)
251 
252 static inline u8 FAN_TO_REG(long rpm, int div)
253 {
254 	if (rpm == 0)
255 		return 255;
256 	rpm = SENSORS_LIMIT(rpm, 1, 1000000);
257 	return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1,
258 			     254);
259 }
260 
261 #define TEMP_MIN (-128000)
262 #define TEMP_MAX ( 127000)
263 
264 /* TEMP: 0.001C/bit (-128C to +127C)
265    REG: 1C/bit, two's complement */
266 static u8 TEMP_TO_REG(int temp)
267 {
268         int ntemp = SENSORS_LIMIT(temp, TEMP_MIN, TEMP_MAX);
269         ntemp += (ntemp<0 ? -500 : 500);
270         return (u8)(ntemp / 1000);
271 }
272 
273 static int TEMP_FROM_REG(u8 reg)
274 {
275         return (s8)reg * 1000;
276 }
277 
278 #define FAN_FROM_REG(val,div) ((val)==0?-1:(val)==255?0:1350000/((val)*(div)))
279 
280 #define PWM_TO_REG(val) (SENSORS_LIMIT((val),0,255))
281 
282 static inline unsigned long pwm_freq_from_reg_627hf(u8 reg)
283 {
284 	unsigned long freq;
285 	freq = W83627HF_BASE_PWM_FREQ >> reg;
286 	return freq;
287 }
288 static inline u8 pwm_freq_to_reg_627hf(unsigned long val)
289 {
290 	u8 i;
291 	/* Only 5 dividers (1 2 4 8 16)
292 	   Search for the nearest available frequency */
293 	for (i = 0; i < 4; i++) {
294 		if (val > (((W83627HF_BASE_PWM_FREQ >> i) +
295 			    (W83627HF_BASE_PWM_FREQ >> (i+1))) / 2))
296 			break;
297 	}
298 	return i;
299 }
300 
301 static inline unsigned long pwm_freq_from_reg(u8 reg)
302 {
303 	/* Clock bit 8 -> 180 kHz or 24 MHz */
304 	unsigned long clock = (reg & 0x80) ? 180000UL : 24000000UL;
305 
306 	reg &= 0x7f;
307 	/* This should not happen but anyway... */
308 	if (reg == 0)
309 		reg++;
310 	return (clock / (reg << 8));
311 }
312 static inline u8 pwm_freq_to_reg(unsigned long val)
313 {
314 	/* Minimum divider value is 0x01 and maximum is 0x7F */
315 	if (val >= 93750)	/* The highest we can do */
316 		return 0x01;
317 	if (val >= 720)	/* Use 24 MHz clock */
318 		return (24000000UL / (val << 8));
319 	if (val < 6)		/* The lowest we can do */
320 		return 0xFF;
321 	else			/* Use 180 kHz clock */
322 		return (0x80 | (180000UL / (val << 8)));
323 }
324 
325 #define BEEP_MASK_FROM_REG(val)		 (val)
326 #define BEEP_MASK_TO_REG(val)		((val) & 0xffffff)
327 #define BEEP_ENABLE_TO_REG(val)		((val)?1:0)
328 #define BEEP_ENABLE_FROM_REG(val)	((val)?1:0)
329 
330 #define DIV_FROM_REG(val) (1 << (val))
331 
332 static inline u8 DIV_TO_REG(long val)
333 {
334 	int i;
335 	val = SENSORS_LIMIT(val, 1, 128) >> 1;
336 	for (i = 0; i < 7; i++) {
337 		if (val == 0)
338 			break;
339 		val >>= 1;
340 	}
341 	return ((u8) i);
342 }
343 
344 /* For each registered chip, we need to keep some data in memory.
345    The structure is dynamically allocated. */
346 struct w83627hf_data {
347 	unsigned short addr;
348 	const char *name;
349 	struct class_device *class_dev;
350 	struct mutex lock;
351 	enum chips type;
352 
353 	struct mutex update_lock;
354 	char valid;		/* !=0 if following fields are valid */
355 	unsigned long last_updated;	/* In jiffies */
356 
357 	u8 in[9];		/* Register value */
358 	u8 in_max[9];		/* Register value */
359 	u8 in_min[9];		/* Register value */
360 	u8 fan[3];		/* Register value */
361 	u8 fan_min[3];		/* Register value */
362 	u8 temp;
363 	u8 temp_max;		/* Register value */
364 	u8 temp_max_hyst;	/* Register value */
365 	u16 temp_add[2];	/* Register value */
366 	u16 temp_max_add[2];	/* Register value */
367 	u16 temp_max_hyst_add[2]; /* Register value */
368 	u8 fan_div[3];		/* Register encoding, shifted right */
369 	u8 vid;			/* Register encoding, combined */
370 	u32 alarms;		/* Register encoding, combined */
371 	u32 beep_mask;		/* Register encoding, combined */
372 	u8 beep_enable;		/* Boolean */
373 	u8 pwm[3];		/* Register value */
374 	u8 pwm_freq[3];		/* Register value */
375 	u16 sens[3];		/* 782D/783S only.
376 				   1 = pentium diode; 2 = 3904 diode;
377 				   3000-5000 = thermistor beta.
378 				   Default = 3435.
379 				   Other Betas unimplemented */
380 	u8 vrm;
381 	u8 vrm_ovt;		/* Register value, 627THF/637HF/687THF only */
382 };
383 
384 struct w83627hf_sio_data {
385 	enum chips type;
386 };
387 
388 
389 static int w83627hf_probe(struct platform_device *pdev);
390 static int __devexit w83627hf_remove(struct platform_device *pdev);
391 
392 static int w83627hf_read_value(struct w83627hf_data *data, u16 reg);
393 static int w83627hf_write_value(struct w83627hf_data *data, u16 reg, u16 value);
394 static struct w83627hf_data *w83627hf_update_device(struct device *dev);
395 static void w83627hf_init_device(struct platform_device *pdev);
396 
397 static struct platform_driver w83627hf_driver = {
398 	.driver = {
399 		.owner	= THIS_MODULE,
400 		.name	= DRVNAME,
401 	},
402 	.probe		= w83627hf_probe,
403 	.remove		= __devexit_p(w83627hf_remove),
404 };
405 
406 /* following are the sysfs callback functions */
407 #define show_in_reg(reg) \
408 static ssize_t show_##reg (struct device *dev, char *buf, int nr) \
409 { \
410 	struct w83627hf_data *data = w83627hf_update_device(dev); \
411 	return sprintf(buf,"%ld\n", (long)IN_FROM_REG(data->reg[nr])); \
412 }
413 show_in_reg(in)
414 show_in_reg(in_min)
415 show_in_reg(in_max)
416 
417 #define store_in_reg(REG, reg) \
418 static ssize_t \
419 store_in_##reg (struct device *dev, const char *buf, size_t count, int nr) \
420 { \
421 	struct w83627hf_data *data = dev_get_drvdata(dev); \
422 	u32 val; \
423 	 \
424 	val = simple_strtoul(buf, NULL, 10); \
425 	 \
426 	mutex_lock(&data->update_lock); \
427 	data->in_##reg[nr] = IN_TO_REG(val); \
428 	w83627hf_write_value(data, W83781D_REG_IN_##REG(nr), \
429 			    data->in_##reg[nr]); \
430 	 \
431 	mutex_unlock(&data->update_lock); \
432 	return count; \
433 }
434 store_in_reg(MIN, min)
435 store_in_reg(MAX, max)
436 
437 #define sysfs_in_offset(offset) \
438 static ssize_t \
439 show_regs_in_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
440 { \
441         return show_in(dev, buf, offset); \
442 } \
443 static DEVICE_ATTR(in##offset##_input, S_IRUGO, show_regs_in_##offset, NULL);
444 
445 #define sysfs_in_reg_offset(reg, offset) \
446 static ssize_t show_regs_in_##reg##offset (struct device *dev, struct device_attribute *attr, char *buf) \
447 { \
448 	return show_in_##reg (dev, buf, offset); \
449 } \
450 static ssize_t \
451 store_regs_in_##reg##offset (struct device *dev, struct device_attribute *attr, \
452 			    const char *buf, size_t count) \
453 { \
454 	return store_in_##reg (dev, buf, count, offset); \
455 } \
456 static DEVICE_ATTR(in##offset##_##reg, S_IRUGO| S_IWUSR, \
457 		  show_regs_in_##reg##offset, store_regs_in_##reg##offset);
458 
459 #define sysfs_in_offsets(offset) \
460 sysfs_in_offset(offset) \
461 sysfs_in_reg_offset(min, offset) \
462 sysfs_in_reg_offset(max, offset)
463 
464 sysfs_in_offsets(1);
465 sysfs_in_offsets(2);
466 sysfs_in_offsets(3);
467 sysfs_in_offsets(4);
468 sysfs_in_offsets(5);
469 sysfs_in_offsets(6);
470 sysfs_in_offsets(7);
471 sysfs_in_offsets(8);
472 
473 /* use a different set of functions for in0 */
474 static ssize_t show_in_0(struct w83627hf_data *data, char *buf, u8 reg)
475 {
476 	long in0;
477 
478 	if ((data->vrm_ovt & 0x01) &&
479 		(w83627thf == data->type || w83637hf == data->type
480 		 || w83687thf == data->type))
481 
482 		/* use VRM9 calculation */
483 		in0 = (long)((reg * 488 + 70000 + 50) / 100);
484 	else
485 		/* use VRM8 (standard) calculation */
486 		in0 = (long)IN_FROM_REG(reg);
487 
488 	return sprintf(buf,"%ld\n", in0);
489 }
490 
491 static ssize_t show_regs_in_0(struct device *dev, struct device_attribute *attr, char *buf)
492 {
493 	struct w83627hf_data *data = w83627hf_update_device(dev);
494 	return show_in_0(data, buf, data->in[0]);
495 }
496 
497 static ssize_t show_regs_in_min0(struct device *dev, struct device_attribute *attr, char *buf)
498 {
499 	struct w83627hf_data *data = w83627hf_update_device(dev);
500 	return show_in_0(data, buf, data->in_min[0]);
501 }
502 
503 static ssize_t show_regs_in_max0(struct device *dev, struct device_attribute *attr, char *buf)
504 {
505 	struct w83627hf_data *data = w83627hf_update_device(dev);
506 	return show_in_0(data, buf, data->in_max[0]);
507 }
508 
509 static ssize_t store_regs_in_min0(struct device *dev, struct device_attribute *attr,
510 	const char *buf, size_t count)
511 {
512 	struct w83627hf_data *data = dev_get_drvdata(dev);
513 	u32 val;
514 
515 	val = simple_strtoul(buf, NULL, 10);
516 
517 	mutex_lock(&data->update_lock);
518 
519 	if ((data->vrm_ovt & 0x01) &&
520 		(w83627thf == data->type || w83637hf == data->type
521 		 || w83687thf == data->type))
522 
523 		/* use VRM9 calculation */
524 		data->in_min[0] =
525 			SENSORS_LIMIT(((val * 100) - 70000 + 244) / 488, 0,
526 					255);
527 	else
528 		/* use VRM8 (standard) calculation */
529 		data->in_min[0] = IN_TO_REG(val);
530 
531 	w83627hf_write_value(data, W83781D_REG_IN_MIN(0), data->in_min[0]);
532 	mutex_unlock(&data->update_lock);
533 	return count;
534 }
535 
536 static ssize_t store_regs_in_max0(struct device *dev, struct device_attribute *attr,
537 	const char *buf, size_t count)
538 {
539 	struct w83627hf_data *data = dev_get_drvdata(dev);
540 	u32 val;
541 
542 	val = simple_strtoul(buf, NULL, 10);
543 
544 	mutex_lock(&data->update_lock);
545 
546 	if ((data->vrm_ovt & 0x01) &&
547 		(w83627thf == data->type || w83637hf == data->type
548 		 || w83687thf == data->type))
549 
550 		/* use VRM9 calculation */
551 		data->in_max[0] =
552 			SENSORS_LIMIT(((val * 100) - 70000 + 244) / 488, 0,
553 					255);
554 	else
555 		/* use VRM8 (standard) calculation */
556 		data->in_max[0] = IN_TO_REG(val);
557 
558 	w83627hf_write_value(data, W83781D_REG_IN_MAX(0), data->in_max[0]);
559 	mutex_unlock(&data->update_lock);
560 	return count;
561 }
562 
563 static DEVICE_ATTR(in0_input, S_IRUGO, show_regs_in_0, NULL);
564 static DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR,
565 	show_regs_in_min0, store_regs_in_min0);
566 static DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR,
567 	show_regs_in_max0, store_regs_in_max0);
568 
569 #define show_fan_reg(reg) \
570 static ssize_t show_##reg (struct device *dev, char *buf, int nr) \
571 { \
572 	struct w83627hf_data *data = w83627hf_update_device(dev); \
573 	return sprintf(buf,"%ld\n", \
574 		FAN_FROM_REG(data->reg[nr-1], \
575 			    (long)DIV_FROM_REG(data->fan_div[nr-1]))); \
576 }
577 show_fan_reg(fan);
578 show_fan_reg(fan_min);
579 
580 static ssize_t
581 store_fan_min(struct device *dev, const char *buf, size_t count, int nr)
582 {
583 	struct w83627hf_data *data = dev_get_drvdata(dev);
584 	u32 val;
585 
586 	val = simple_strtoul(buf, NULL, 10);
587 
588 	mutex_lock(&data->update_lock);
589 	data->fan_min[nr - 1] =
590 	    FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr - 1]));
591 	w83627hf_write_value(data, W83781D_REG_FAN_MIN(nr),
592 			    data->fan_min[nr - 1]);
593 
594 	mutex_unlock(&data->update_lock);
595 	return count;
596 }
597 
598 #define sysfs_fan_offset(offset) \
599 static ssize_t show_regs_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
600 { \
601 	return show_fan(dev, buf, offset); \
602 } \
603 static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_regs_fan_##offset, NULL);
604 
605 #define sysfs_fan_min_offset(offset) \
606 static ssize_t show_regs_fan_min##offset (struct device *dev, struct device_attribute *attr, char *buf) \
607 { \
608 	return show_fan_min(dev, buf, offset); \
609 } \
610 static ssize_t \
611 store_regs_fan_min##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
612 { \
613 	return store_fan_min(dev, buf, count, offset); \
614 } \
615 static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
616 		  show_regs_fan_min##offset, store_regs_fan_min##offset);
617 
618 sysfs_fan_offset(1);
619 sysfs_fan_min_offset(1);
620 sysfs_fan_offset(2);
621 sysfs_fan_min_offset(2);
622 sysfs_fan_offset(3);
623 sysfs_fan_min_offset(3);
624 
625 #define show_temp_reg(reg) \
626 static ssize_t show_##reg (struct device *dev, char *buf, int nr) \
627 { \
628 	struct w83627hf_data *data = w83627hf_update_device(dev); \
629 	if (nr >= 2) {	/* TEMP2 and TEMP3 */ \
630 		return sprintf(buf,"%ld\n", \
631 			(long)LM75_TEMP_FROM_REG(data->reg##_add[nr-2])); \
632 	} else {	/* TEMP1 */ \
633 		return sprintf(buf,"%ld\n", (long)TEMP_FROM_REG(data->reg)); \
634 	} \
635 }
636 show_temp_reg(temp);
637 show_temp_reg(temp_max);
638 show_temp_reg(temp_max_hyst);
639 
640 #define store_temp_reg(REG, reg) \
641 static ssize_t \
642 store_temp_##reg (struct device *dev, const char *buf, size_t count, int nr) \
643 { \
644 	struct w83627hf_data *data = dev_get_drvdata(dev); \
645 	u32 val; \
646 	 \
647 	val = simple_strtoul(buf, NULL, 10); \
648 	 \
649 	mutex_lock(&data->update_lock); \
650 	 \
651 	if (nr >= 2) {	/* TEMP2 and TEMP3 */ \
652 		data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \
653 		w83627hf_write_value(data, W83781D_REG_TEMP_##REG(nr), \
654 				data->temp_##reg##_add[nr-2]); \
655 	} else {	/* TEMP1 */ \
656 		data->temp_##reg = TEMP_TO_REG(val); \
657 		w83627hf_write_value(data, W83781D_REG_TEMP_##REG(nr), \
658 			data->temp_##reg); \
659 	} \
660 	 \
661 	mutex_unlock(&data->update_lock); \
662 	return count; \
663 }
664 store_temp_reg(OVER, max);
665 store_temp_reg(HYST, max_hyst);
666 
667 #define sysfs_temp_offset(offset) \
668 static ssize_t \
669 show_regs_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
670 { \
671 	return show_temp(dev, buf, offset); \
672 } \
673 static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_regs_temp_##offset, NULL);
674 
675 #define sysfs_temp_reg_offset(reg, offset) \
676 static ssize_t show_regs_temp_##reg##offset (struct device *dev, struct device_attribute *attr, char *buf) \
677 { \
678 	return show_temp_##reg (dev, buf, offset); \
679 } \
680 static ssize_t \
681 store_regs_temp_##reg##offset (struct device *dev, struct device_attribute *attr, \
682 			      const char *buf, size_t count) \
683 { \
684 	return store_temp_##reg (dev, buf, count, offset); \
685 } \
686 static DEVICE_ATTR(temp##offset##_##reg, S_IRUGO| S_IWUSR, \
687 		  show_regs_temp_##reg##offset, store_regs_temp_##reg##offset);
688 
689 #define sysfs_temp_offsets(offset) \
690 sysfs_temp_offset(offset) \
691 sysfs_temp_reg_offset(max, offset) \
692 sysfs_temp_reg_offset(max_hyst, offset)
693 
694 sysfs_temp_offsets(1);
695 sysfs_temp_offsets(2);
696 sysfs_temp_offsets(3);
697 
698 static ssize_t
699 show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf)
700 {
701 	struct w83627hf_data *data = w83627hf_update_device(dev);
702 	return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
703 }
704 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);
705 
706 static ssize_t
707 show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf)
708 {
709 	struct w83627hf_data *data = w83627hf_update_device(dev);
710 	return sprintf(buf, "%ld\n", (long) data->vrm);
711 }
712 static ssize_t
713 store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
714 {
715 	struct w83627hf_data *data = dev_get_drvdata(dev);
716 	u32 val;
717 
718 	val = simple_strtoul(buf, NULL, 10);
719 	data->vrm = val;
720 
721 	return count;
722 }
723 static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);
724 
725 static ssize_t
726 show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf)
727 {
728 	struct w83627hf_data *data = w83627hf_update_device(dev);
729 	return sprintf(buf, "%ld\n", (long) data->alarms);
730 }
731 static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);
732 
733 #define show_beep_reg(REG, reg) \
734 static ssize_t show_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \
735 { \
736 	struct w83627hf_data *data = w83627hf_update_device(dev); \
737 	return sprintf(buf,"%ld\n", \
738 		      (long)BEEP_##REG##_FROM_REG(data->beep_##reg)); \
739 }
740 show_beep_reg(ENABLE, enable)
741 show_beep_reg(MASK, mask)
742 
743 #define BEEP_ENABLE			0	/* Store beep_enable */
744 #define BEEP_MASK			1	/* Store beep_mask */
745 
746 static ssize_t
747 store_beep_reg(struct device *dev, const char *buf, size_t count,
748 	       int update_mask)
749 {
750 	struct w83627hf_data *data = dev_get_drvdata(dev);
751 	u32 val, val2;
752 
753 	val = simple_strtoul(buf, NULL, 10);
754 
755 	mutex_lock(&data->update_lock);
756 
757 	if (update_mask == BEEP_MASK) {	/* We are storing beep_mask */
758 		data->beep_mask = BEEP_MASK_TO_REG(val);
759 		w83627hf_write_value(data, W83781D_REG_BEEP_INTS1,
760 				    data->beep_mask & 0xff);
761 		w83627hf_write_value(data, W83781D_REG_BEEP_INTS3,
762 				    ((data->beep_mask) >> 16) & 0xff);
763 		val2 = (data->beep_mask >> 8) & 0x7f;
764 	} else {		/* We are storing beep_enable */
765 		val2 =
766 		    w83627hf_read_value(data, W83781D_REG_BEEP_INTS2) & 0x7f;
767 		data->beep_enable = BEEP_ENABLE_TO_REG(val);
768 	}
769 
770 	w83627hf_write_value(data, W83781D_REG_BEEP_INTS2,
771 			    val2 | data->beep_enable << 7);
772 
773 	mutex_unlock(&data->update_lock);
774 	return count;
775 }
776 
777 #define sysfs_beep(REG, reg) \
778 static ssize_t show_regs_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \
779 { \
780 	return show_beep_##reg(dev, attr, buf); \
781 } \
782 static ssize_t \
783 store_regs_beep_##reg (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
784 { \
785 	return store_beep_reg(dev, buf, count, BEEP_##REG); \
786 } \
787 static DEVICE_ATTR(beep_##reg, S_IRUGO | S_IWUSR, \
788 		  show_regs_beep_##reg, store_regs_beep_##reg);
789 
790 sysfs_beep(ENABLE, enable);
791 sysfs_beep(MASK, mask);
792 
793 static ssize_t
794 show_fan_div_reg(struct device *dev, char *buf, int nr)
795 {
796 	struct w83627hf_data *data = w83627hf_update_device(dev);
797 	return sprintf(buf, "%ld\n",
798 		       (long) DIV_FROM_REG(data->fan_div[nr - 1]));
799 }
800 
801 /* Note: we save and restore the fan minimum here, because its value is
802    determined in part by the fan divisor.  This follows the principle of
803    least surprise; the user doesn't expect the fan minimum to change just
804    because the divisor changed. */
805 static ssize_t
806 store_fan_div_reg(struct device *dev, const char *buf, size_t count, int nr)
807 {
808 	struct w83627hf_data *data = dev_get_drvdata(dev);
809 	unsigned long min;
810 	u8 reg;
811 	unsigned long val = simple_strtoul(buf, NULL, 10);
812 
813 	mutex_lock(&data->update_lock);
814 
815 	/* Save fan_min */
816 	min = FAN_FROM_REG(data->fan_min[nr],
817 			   DIV_FROM_REG(data->fan_div[nr]));
818 
819 	data->fan_div[nr] = DIV_TO_REG(val);
820 
821 	reg = (w83627hf_read_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
822 	       & (nr==0 ? 0xcf : 0x3f))
823 	    | ((data->fan_div[nr] & 0x03) << (nr==0 ? 4 : 6));
824 	w83627hf_write_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
825 
826 	reg = (w83627hf_read_value(data, W83781D_REG_VBAT)
827 	       & ~(1 << (5 + nr)))
828 	    | ((data->fan_div[nr] & 0x04) << (3 + nr));
829 	w83627hf_write_value(data, W83781D_REG_VBAT, reg);
830 
831 	/* Restore fan_min */
832 	data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
833 	w83627hf_write_value(data, W83781D_REG_FAN_MIN(nr+1), data->fan_min[nr]);
834 
835 	mutex_unlock(&data->update_lock);
836 	return count;
837 }
838 
839 #define sysfs_fan_div(offset) \
840 static ssize_t show_regs_fan_div_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
841 { \
842 	return show_fan_div_reg(dev, buf, offset); \
843 } \
844 static ssize_t \
845 store_regs_fan_div_##offset (struct device *dev, struct device_attribute *attr, \
846 			    const char *buf, size_t count) \
847 { \
848 	return store_fan_div_reg(dev, buf, count, offset - 1); \
849 } \
850 static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
851 		  show_regs_fan_div_##offset, store_regs_fan_div_##offset);
852 
853 sysfs_fan_div(1);
854 sysfs_fan_div(2);
855 sysfs_fan_div(3);
856 
857 static ssize_t
858 show_pwm_reg(struct device *dev, char *buf, int nr)
859 {
860 	struct w83627hf_data *data = w83627hf_update_device(dev);
861 	return sprintf(buf, "%ld\n", (long) data->pwm[nr - 1]);
862 }
863 
864 static ssize_t
865 store_pwm_reg(struct device *dev, const char *buf, size_t count, int nr)
866 {
867 	struct w83627hf_data *data = dev_get_drvdata(dev);
868 	u32 val;
869 
870 	val = simple_strtoul(buf, NULL, 10);
871 
872 	mutex_lock(&data->update_lock);
873 
874 	if (data->type == w83627thf) {
875 		/* bits 0-3 are reserved  in 627THF */
876 		data->pwm[nr - 1] = PWM_TO_REG(val) & 0xf0;
877 		w83627hf_write_value(data,
878 				     W836X7HF_REG_PWM(data->type, nr),
879 				     data->pwm[nr - 1] |
880 				     (w83627hf_read_value(data,
881 				     W836X7HF_REG_PWM(data->type, nr)) & 0x0f));
882 	} else {
883 		data->pwm[nr - 1] = PWM_TO_REG(val);
884 		w83627hf_write_value(data,
885 				     W836X7HF_REG_PWM(data->type, nr),
886 				     data->pwm[nr - 1]);
887 	}
888 
889 	mutex_unlock(&data->update_lock);
890 	return count;
891 }
892 
893 #define sysfs_pwm(offset) \
894 static ssize_t show_regs_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
895 { \
896 	return show_pwm_reg(dev, buf, offset); \
897 } \
898 static ssize_t \
899 store_regs_pwm_##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
900 { \
901 	return store_pwm_reg(dev, buf, count, offset); \
902 } \
903 static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \
904 		  show_regs_pwm_##offset, store_regs_pwm_##offset);
905 
906 sysfs_pwm(1);
907 sysfs_pwm(2);
908 sysfs_pwm(3);
909 
910 static ssize_t
911 show_pwm_freq_reg(struct device *dev, char *buf, int nr)
912 {
913 	struct w83627hf_data *data = w83627hf_update_device(dev);
914 	if (data->type == w83627hf)
915 		return sprintf(buf, "%ld\n",
916 			pwm_freq_from_reg_627hf(data->pwm_freq[nr - 1]));
917 	else
918 		return sprintf(buf, "%ld\n",
919 			pwm_freq_from_reg(data->pwm_freq[nr - 1]));
920 }
921 
922 static ssize_t
923 store_pwm_freq_reg(struct device *dev, const char *buf, size_t count, int nr)
924 {
925 	struct w83627hf_data *data = dev_get_drvdata(dev);
926 	static const u8 mask[]={0xF8, 0x8F};
927 	u32 val;
928 
929 	val = simple_strtoul(buf, NULL, 10);
930 
931 	mutex_lock(&data->update_lock);
932 
933 	if (data->type == w83627hf) {
934 		data->pwm_freq[nr - 1] = pwm_freq_to_reg_627hf(val);
935 		w83627hf_write_value(data, W83627HF_REG_PWM_FREQ,
936 				(data->pwm_freq[nr - 1] << ((nr - 1)*4)) |
937 				(w83627hf_read_value(data,
938 				W83627HF_REG_PWM_FREQ) & mask[nr - 1]));
939 	} else {
940 		data->pwm_freq[nr - 1] = pwm_freq_to_reg(val);
941 		w83627hf_write_value(data, W83637HF_REG_PWM_FREQ[nr - 1],
942 				data->pwm_freq[nr - 1]);
943 	}
944 
945 	mutex_unlock(&data->update_lock);
946 	return count;
947 }
948 
949 #define sysfs_pwm_freq(offset) \
950 static ssize_t show_regs_pwm_freq_##offset(struct device *dev, \
951 		struct device_attribute *attr, char *buf) \
952 { \
953 	return show_pwm_freq_reg(dev, buf, offset); \
954 } \
955 static ssize_t \
956 store_regs_pwm_freq_##offset(struct device *dev, \
957 		struct device_attribute *attr, const char *buf, size_t count) \
958 { \
959 	return store_pwm_freq_reg(dev, buf, count, offset); \
960 } \
961 static DEVICE_ATTR(pwm##offset##_freq, S_IRUGO | S_IWUSR, \
962 		  show_regs_pwm_freq_##offset, store_regs_pwm_freq_##offset);
963 
964 sysfs_pwm_freq(1);
965 sysfs_pwm_freq(2);
966 sysfs_pwm_freq(3);
967 
968 static ssize_t
969 show_sensor_reg(struct device *dev, char *buf, int nr)
970 {
971 	struct w83627hf_data *data = w83627hf_update_device(dev);
972 	return sprintf(buf, "%ld\n", (long) data->sens[nr - 1]);
973 }
974 
975 static ssize_t
976 store_sensor_reg(struct device *dev, const char *buf, size_t count, int nr)
977 {
978 	struct w83627hf_data *data = dev_get_drvdata(dev);
979 	u32 val, tmp;
980 
981 	val = simple_strtoul(buf, NULL, 10);
982 
983 	mutex_lock(&data->update_lock);
984 
985 	switch (val) {
986 	case 1:		/* PII/Celeron diode */
987 		tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
988 		w83627hf_write_value(data, W83781D_REG_SCFG1,
989 				    tmp | BIT_SCFG1[nr - 1]);
990 		tmp = w83627hf_read_value(data, W83781D_REG_SCFG2);
991 		w83627hf_write_value(data, W83781D_REG_SCFG2,
992 				    tmp | BIT_SCFG2[nr - 1]);
993 		data->sens[nr - 1] = val;
994 		break;
995 	case 2:		/* 3904 */
996 		tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
997 		w83627hf_write_value(data, W83781D_REG_SCFG1,
998 				    tmp | BIT_SCFG1[nr - 1]);
999 		tmp = w83627hf_read_value(data, W83781D_REG_SCFG2);
1000 		w83627hf_write_value(data, W83781D_REG_SCFG2,
1001 				    tmp & ~BIT_SCFG2[nr - 1]);
1002 		data->sens[nr - 1] = val;
1003 		break;
1004 	case W83781D_DEFAULT_BETA:	/* thermistor */
1005 		tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1006 		w83627hf_write_value(data, W83781D_REG_SCFG1,
1007 				    tmp & ~BIT_SCFG1[nr - 1]);
1008 		data->sens[nr - 1] = val;
1009 		break;
1010 	default:
1011 		dev_err(dev,
1012 		       "Invalid sensor type %ld; must be 1, 2, or %d\n",
1013 		       (long) val, W83781D_DEFAULT_BETA);
1014 		break;
1015 	}
1016 
1017 	mutex_unlock(&data->update_lock);
1018 	return count;
1019 }
1020 
1021 #define sysfs_sensor(offset) \
1022 static ssize_t show_regs_sensor_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
1023 { \
1024     return show_sensor_reg(dev, buf, offset); \
1025 } \
1026 static ssize_t \
1027 store_regs_sensor_##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
1028 { \
1029     return store_sensor_reg(dev, buf, count, offset); \
1030 } \
1031 static DEVICE_ATTR(temp##offset##_type, S_IRUGO | S_IWUSR, \
1032 		  show_regs_sensor_##offset, store_regs_sensor_##offset);
1033 
1034 sysfs_sensor(1);
1035 sysfs_sensor(2);
1036 sysfs_sensor(3);
1037 
1038 static ssize_t show_name(struct device *dev, struct device_attribute
1039 			 *devattr, char *buf)
1040 {
1041 	struct w83627hf_data *data = dev_get_drvdata(dev);
1042 
1043 	return sprintf(buf, "%s\n", data->name);
1044 }
1045 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1046 
1047 static int __init w83627hf_find(int sioaddr, unsigned short *addr,
1048 				struct w83627hf_sio_data *sio_data)
1049 {
1050 	int err = -ENODEV;
1051 	u16 val;
1052 
1053 	static const __initdata char *names[] = {
1054 		"W83627HF",
1055 		"W83627THF",
1056 		"W83697HF",
1057 		"W83637HF",
1058 		"W83687THF",
1059 	};
1060 
1061 	REG = sioaddr;
1062 	VAL = sioaddr + 1;
1063 
1064 	superio_enter();
1065 	val= superio_inb(DEVID);
1066 	switch (val) {
1067 	case W627_DEVID:
1068 		sio_data->type = w83627hf;
1069 		break;
1070 	case W627THF_DEVID:
1071 		sio_data->type = w83627thf;
1072 		break;
1073 	case W697_DEVID:
1074 		sio_data->type = w83697hf;
1075 		break;
1076 	case W637_DEVID:
1077 		sio_data->type = w83637hf;
1078 		break;
1079 	case W687THF_DEVID:
1080 		sio_data->type = w83687thf;
1081 		break;
1082 	case 0xff:	/* No device at all */
1083 		goto exit;
1084 	default:
1085 		pr_debug(DRVNAME ": Unsupported chip (DEVID=0x%02x)\n", val);
1086 		goto exit;
1087 	}
1088 
1089 	superio_select(W83627HF_LD_HWM);
1090 	force_addr &= WINB_ALIGNMENT;
1091 	if (force_addr) {
1092 		printk(KERN_WARNING DRVNAME ": Forcing address 0x%x\n",
1093 		       force_addr);
1094 		superio_outb(WINB_BASE_REG, force_addr >> 8);
1095 		superio_outb(WINB_BASE_REG + 1, force_addr & 0xff);
1096 	}
1097 	val = (superio_inb(WINB_BASE_REG) << 8) |
1098 	       superio_inb(WINB_BASE_REG + 1);
1099 	*addr = val & WINB_ALIGNMENT;
1100 	if (*addr == 0) {
1101 		printk(KERN_WARNING DRVNAME ": Base address not set, "
1102 		       "skipping\n");
1103 		goto exit;
1104 	}
1105 
1106 	val = superio_inb(WINB_ACT_REG);
1107 	if (!(val & 0x01)) {
1108 		printk(KERN_WARNING DRVNAME ": Enabling HWM logical device\n");
1109 		superio_outb(WINB_ACT_REG, val | 0x01);
1110 	}
1111 
1112 	err = 0;
1113 	pr_info(DRVNAME ": Found %s chip at %#x\n",
1114 		names[sio_data->type], *addr);
1115 
1116  exit:
1117 	superio_exit();
1118 	return err;
1119 }
1120 
1121 static struct attribute *w83627hf_attributes[] = {
1122 	&dev_attr_in0_input.attr,
1123 	&dev_attr_in0_min.attr,
1124 	&dev_attr_in0_max.attr,
1125 	&dev_attr_in2_input.attr,
1126 	&dev_attr_in2_min.attr,
1127 	&dev_attr_in2_max.attr,
1128 	&dev_attr_in3_input.attr,
1129 	&dev_attr_in3_min.attr,
1130 	&dev_attr_in3_max.attr,
1131 	&dev_attr_in4_input.attr,
1132 	&dev_attr_in4_min.attr,
1133 	&dev_attr_in4_max.attr,
1134 	&dev_attr_in7_input.attr,
1135 	&dev_attr_in7_min.attr,
1136 	&dev_attr_in7_max.attr,
1137 	&dev_attr_in8_input.attr,
1138 	&dev_attr_in8_min.attr,
1139 	&dev_attr_in8_max.attr,
1140 
1141 	&dev_attr_fan1_input.attr,
1142 	&dev_attr_fan1_min.attr,
1143 	&dev_attr_fan1_div.attr,
1144 	&dev_attr_fan2_input.attr,
1145 	&dev_attr_fan2_min.attr,
1146 	&dev_attr_fan2_div.attr,
1147 
1148 	&dev_attr_temp1_input.attr,
1149 	&dev_attr_temp1_max.attr,
1150 	&dev_attr_temp1_max_hyst.attr,
1151 	&dev_attr_temp1_type.attr,
1152 	&dev_attr_temp2_input.attr,
1153 	&dev_attr_temp2_max.attr,
1154 	&dev_attr_temp2_max_hyst.attr,
1155 	&dev_attr_temp2_type.attr,
1156 
1157 	&dev_attr_alarms.attr,
1158 	&dev_attr_beep_enable.attr,
1159 	&dev_attr_beep_mask.attr,
1160 
1161 	&dev_attr_pwm1.attr,
1162 	&dev_attr_pwm2.attr,
1163 
1164 	&dev_attr_name.attr,
1165 	NULL
1166 };
1167 
1168 static const struct attribute_group w83627hf_group = {
1169 	.attrs = w83627hf_attributes,
1170 };
1171 
1172 static struct attribute *w83627hf_attributes_opt[] = {
1173 	&dev_attr_in1_input.attr,
1174 	&dev_attr_in1_min.attr,
1175 	&dev_attr_in1_max.attr,
1176 	&dev_attr_in5_input.attr,
1177 	&dev_attr_in5_min.attr,
1178 	&dev_attr_in5_max.attr,
1179 	&dev_attr_in6_input.attr,
1180 	&dev_attr_in6_min.attr,
1181 	&dev_attr_in6_max.attr,
1182 
1183 	&dev_attr_fan3_input.attr,
1184 	&dev_attr_fan3_min.attr,
1185 	&dev_attr_fan3_div.attr,
1186 
1187 	&dev_attr_temp3_input.attr,
1188 	&dev_attr_temp3_max.attr,
1189 	&dev_attr_temp3_max_hyst.attr,
1190 	&dev_attr_temp3_type.attr,
1191 
1192 	&dev_attr_pwm3.attr,
1193 
1194 	&dev_attr_pwm1_freq.attr,
1195 	&dev_attr_pwm2_freq.attr,
1196 	&dev_attr_pwm3_freq.attr,
1197 	NULL
1198 };
1199 
1200 static const struct attribute_group w83627hf_group_opt = {
1201 	.attrs = w83627hf_attributes_opt,
1202 };
1203 
1204 static int __devinit w83627hf_probe(struct platform_device *pdev)
1205 {
1206 	struct device *dev = &pdev->dev;
1207 	struct w83627hf_sio_data *sio_data = dev->platform_data;
1208 	struct w83627hf_data *data;
1209 	struct resource *res;
1210 	int err;
1211 
1212 	static const char *names[] = {
1213 		"w83627hf",
1214 		"w83627thf",
1215 		"w83697hf",
1216 		"w83637hf",
1217 		"w83687thf",
1218 	};
1219 
1220 	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1221 	if (!request_region(res->start, WINB_REGION_SIZE, DRVNAME)) {
1222 		dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1223 			(unsigned long)res->start,
1224 			(unsigned long)(res->start + WINB_REGION_SIZE - 1));
1225 		err = -EBUSY;
1226 		goto ERROR0;
1227 	}
1228 
1229 	if (!(data = kzalloc(sizeof(struct w83627hf_data), GFP_KERNEL))) {
1230 		err = -ENOMEM;
1231 		goto ERROR1;
1232 	}
1233 	data->addr = res->start;
1234 	data->type = sio_data->type;
1235 	data->name = names[sio_data->type];
1236 	mutex_init(&data->lock);
1237 	mutex_init(&data->update_lock);
1238 	platform_set_drvdata(pdev, data);
1239 
1240 	/* Initialize the chip */
1241 	w83627hf_init_device(pdev);
1242 
1243 	/* A few vars need to be filled upon startup */
1244 	data->fan_min[0] = w83627hf_read_value(data, W83781D_REG_FAN_MIN(1));
1245 	data->fan_min[1] = w83627hf_read_value(data, W83781D_REG_FAN_MIN(2));
1246 	data->fan_min[2] = w83627hf_read_value(data, W83781D_REG_FAN_MIN(3));
1247 
1248 	/* Register common device attributes */
1249 	if ((err = sysfs_create_group(&dev->kobj, &w83627hf_group)))
1250 		goto ERROR3;
1251 
1252 	/* Register chip-specific device attributes */
1253 	if (data->type == w83627hf || data->type == w83697hf)
1254 		if ((err = device_create_file(dev, &dev_attr_in5_input))
1255 		 || (err = device_create_file(dev, &dev_attr_in5_min))
1256 		 || (err = device_create_file(dev, &dev_attr_in5_max))
1257 		 || (err = device_create_file(dev, &dev_attr_in6_input))
1258 		 || (err = device_create_file(dev, &dev_attr_in6_min))
1259 		 || (err = device_create_file(dev, &dev_attr_in6_max))
1260 		 || (err = device_create_file(dev, &dev_attr_pwm1_freq))
1261 		 || (err = device_create_file(dev, &dev_attr_pwm2_freq)))
1262 			goto ERROR4;
1263 
1264 	if (data->type != w83697hf)
1265 		if ((err = device_create_file(dev, &dev_attr_in1_input))
1266 		 || (err = device_create_file(dev, &dev_attr_in1_min))
1267 		 || (err = device_create_file(dev, &dev_attr_in1_max))
1268 		 || (err = device_create_file(dev, &dev_attr_fan3_input))
1269 		 || (err = device_create_file(dev, &dev_attr_fan3_min))
1270 		 || (err = device_create_file(dev, &dev_attr_fan3_div))
1271 		 || (err = device_create_file(dev, &dev_attr_temp3_input))
1272 		 || (err = device_create_file(dev, &dev_attr_temp3_max))
1273 		 || (err = device_create_file(dev, &dev_attr_temp3_max_hyst))
1274 		 || (err = device_create_file(dev, &dev_attr_temp3_type)))
1275 			goto ERROR4;
1276 
1277 	if (data->type != w83697hf && data->vid != 0xff) {
1278 		/* Convert VID to voltage based on VRM */
1279 		data->vrm = vid_which_vrm();
1280 
1281 		if ((err = device_create_file(dev, &dev_attr_cpu0_vid))
1282 		 || (err = device_create_file(dev, &dev_attr_vrm)))
1283 			goto ERROR4;
1284 	}
1285 
1286 	if (data->type == w83627thf || data->type == w83637hf
1287 	 || data->type == w83687thf)
1288 		if ((err = device_create_file(dev, &dev_attr_pwm3)))
1289 			goto ERROR4;
1290 
1291 	if (data->type == w83637hf || data->type == w83687thf)
1292 		if ((err = device_create_file(dev, &dev_attr_pwm1_freq))
1293 		 || (err = device_create_file(dev, &dev_attr_pwm2_freq))
1294 		 || (err = device_create_file(dev, &dev_attr_pwm3_freq)))
1295 			goto ERROR4;
1296 
1297 	data->class_dev = hwmon_device_register(dev);
1298 	if (IS_ERR(data->class_dev)) {
1299 		err = PTR_ERR(data->class_dev);
1300 		goto ERROR4;
1301 	}
1302 
1303 	return 0;
1304 
1305       ERROR4:
1306 	sysfs_remove_group(&dev->kobj, &w83627hf_group);
1307 	sysfs_remove_group(&dev->kobj, &w83627hf_group_opt);
1308       ERROR3:
1309 	platform_set_drvdata(pdev, NULL);
1310 	kfree(data);
1311       ERROR1:
1312 	release_region(res->start, WINB_REGION_SIZE);
1313       ERROR0:
1314 	return err;
1315 }
1316 
1317 static int __devexit w83627hf_remove(struct platform_device *pdev)
1318 {
1319 	struct w83627hf_data *data = platform_get_drvdata(pdev);
1320 	struct resource *res;
1321 
1322 	hwmon_device_unregister(data->class_dev);
1323 
1324 	sysfs_remove_group(&pdev->dev.kobj, &w83627hf_group);
1325 	sysfs_remove_group(&pdev->dev.kobj, &w83627hf_group_opt);
1326 	platform_set_drvdata(pdev, NULL);
1327 	kfree(data);
1328 
1329 	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1330 	release_region(res->start, WINB_REGION_SIZE);
1331 
1332 	return 0;
1333 }
1334 
1335 
1336 static int w83627hf_read_value(struct w83627hf_data *data, u16 reg)
1337 {
1338 	int res, word_sized;
1339 
1340 	mutex_lock(&data->lock);
1341 	word_sized = (((reg & 0xff00) == 0x100)
1342 		   || ((reg & 0xff00) == 0x200))
1343 		  && (((reg & 0x00ff) == 0x50)
1344 		   || ((reg & 0x00ff) == 0x53)
1345 		   || ((reg & 0x00ff) == 0x55));
1346 	if (reg & 0xff00) {
1347 		outb_p(W83781D_REG_BANK,
1348 		       data->addr + W83781D_ADDR_REG_OFFSET);
1349 		outb_p(reg >> 8,
1350 		       data->addr + W83781D_DATA_REG_OFFSET);
1351 	}
1352 	outb_p(reg & 0xff, data->addr + W83781D_ADDR_REG_OFFSET);
1353 	res = inb_p(data->addr + W83781D_DATA_REG_OFFSET);
1354 	if (word_sized) {
1355 		outb_p((reg & 0xff) + 1,
1356 		       data->addr + W83781D_ADDR_REG_OFFSET);
1357 		res =
1358 		    (res << 8) + inb_p(data->addr +
1359 				       W83781D_DATA_REG_OFFSET);
1360 	}
1361 	if (reg & 0xff00) {
1362 		outb_p(W83781D_REG_BANK,
1363 		       data->addr + W83781D_ADDR_REG_OFFSET);
1364 		outb_p(0, data->addr + W83781D_DATA_REG_OFFSET);
1365 	}
1366 	mutex_unlock(&data->lock);
1367 	return res;
1368 }
1369 
1370 static int __devinit w83627thf_read_gpio5(struct platform_device *pdev)
1371 {
1372 	int res = 0xff, sel;
1373 
1374 	superio_enter();
1375 	superio_select(W83627HF_LD_GPIO5);
1376 
1377 	/* Make sure these GPIO pins are enabled */
1378 	if (!(superio_inb(W83627THF_GPIO5_EN) & (1<<3))) {
1379 		dev_dbg(&pdev->dev, "GPIO5 disabled, no VID function\n");
1380 		goto exit;
1381 	}
1382 
1383 	/* Make sure the pins are configured for input
1384 	   There must be at least five (VRM 9), and possibly 6 (VRM 10) */
1385 	sel = superio_inb(W83627THF_GPIO5_IOSR) & 0x3f;
1386 	if ((sel & 0x1f) != 0x1f) {
1387 		dev_dbg(&pdev->dev, "GPIO5 not configured for VID "
1388 			"function\n");
1389 		goto exit;
1390 	}
1391 
1392 	dev_info(&pdev->dev, "Reading VID from GPIO5\n");
1393 	res = superio_inb(W83627THF_GPIO5_DR) & sel;
1394 
1395 exit:
1396 	superio_exit();
1397 	return res;
1398 }
1399 
1400 static int __devinit w83687thf_read_vid(struct platform_device *pdev)
1401 {
1402 	int res = 0xff;
1403 
1404 	superio_enter();
1405 	superio_select(W83627HF_LD_HWM);
1406 
1407 	/* Make sure these GPIO pins are enabled */
1408 	if (!(superio_inb(W83687THF_VID_EN) & (1 << 2))) {
1409 		dev_dbg(&pdev->dev, "VID disabled, no VID function\n");
1410 		goto exit;
1411 	}
1412 
1413 	/* Make sure the pins are configured for input */
1414 	if (!(superio_inb(W83687THF_VID_CFG) & (1 << 4))) {
1415 		dev_dbg(&pdev->dev, "VID configured as output, "
1416 			"no VID function\n");
1417 		goto exit;
1418 	}
1419 
1420 	res = superio_inb(W83687THF_VID_DATA) & 0x3f;
1421 
1422 exit:
1423 	superio_exit();
1424 	return res;
1425 }
1426 
1427 static int w83627hf_write_value(struct w83627hf_data *data, u16 reg, u16 value)
1428 {
1429 	int word_sized;
1430 
1431 	mutex_lock(&data->lock);
1432 	word_sized = (((reg & 0xff00) == 0x100)
1433 		   || ((reg & 0xff00) == 0x200))
1434 		  && (((reg & 0x00ff) == 0x53)
1435 		   || ((reg & 0x00ff) == 0x55));
1436 	if (reg & 0xff00) {
1437 		outb_p(W83781D_REG_BANK,
1438 		       data->addr + W83781D_ADDR_REG_OFFSET);
1439 		outb_p(reg >> 8,
1440 		       data->addr + W83781D_DATA_REG_OFFSET);
1441 	}
1442 	outb_p(reg & 0xff, data->addr + W83781D_ADDR_REG_OFFSET);
1443 	if (word_sized) {
1444 		outb_p(value >> 8,
1445 		       data->addr + W83781D_DATA_REG_OFFSET);
1446 		outb_p((reg & 0xff) + 1,
1447 		       data->addr + W83781D_ADDR_REG_OFFSET);
1448 	}
1449 	outb_p(value & 0xff,
1450 	       data->addr + W83781D_DATA_REG_OFFSET);
1451 	if (reg & 0xff00) {
1452 		outb_p(W83781D_REG_BANK,
1453 		       data->addr + W83781D_ADDR_REG_OFFSET);
1454 		outb_p(0, data->addr + W83781D_DATA_REG_OFFSET);
1455 	}
1456 	mutex_unlock(&data->lock);
1457 	return 0;
1458 }
1459 
1460 static void __devinit w83627hf_init_device(struct platform_device *pdev)
1461 {
1462 	struct w83627hf_data *data = platform_get_drvdata(pdev);
1463 	int i;
1464 	enum chips type = data->type;
1465 	u8 tmp;
1466 
1467 	if (reset) {
1468 		/* Resetting the chip has been the default for a long time,
1469 		   but repeatedly caused problems (fans going to full
1470 		   speed...) so it is now optional. It might even go away if
1471 		   nobody reports it as being useful, as I see very little
1472 		   reason why this would be needed at all. */
1473 		dev_info(&pdev->dev, "If reset=1 solved a problem you were "
1474 			 "having, please report!\n");
1475 
1476 		/* save this register */
1477 		i = w83627hf_read_value(data, W83781D_REG_BEEP_CONFIG);
1478 		/* Reset all except Watchdog values and last conversion values
1479 		   This sets fan-divs to 2, among others */
1480 		w83627hf_write_value(data, W83781D_REG_CONFIG, 0x80);
1481 		/* Restore the register and disable power-on abnormal beep.
1482 		   This saves FAN 1/2/3 input/output values set by BIOS. */
1483 		w83627hf_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
1484 		/* Disable master beep-enable (reset turns it on).
1485 		   Individual beeps should be reset to off but for some reason
1486 		   disabling this bit helps some people not get beeped */
1487 		w83627hf_write_value(data, W83781D_REG_BEEP_INTS2, 0);
1488 	}
1489 
1490 	/* Minimize conflicts with other winbond i2c-only clients...  */
1491 	/* disable i2c subclients... how to disable main i2c client?? */
1492 	/* force i2c address to relatively uncommon address */
1493 	w83627hf_write_value(data, W83781D_REG_I2C_SUBADDR, 0x89);
1494 	w83627hf_write_value(data, W83781D_REG_I2C_ADDR, force_i2c);
1495 
1496 	/* Read VID only once */
1497 	if (type == w83627hf || type == w83637hf) {
1498 		int lo = w83627hf_read_value(data, W83781D_REG_VID_FANDIV);
1499 		int hi = w83627hf_read_value(data, W83781D_REG_CHIPID);
1500 		data->vid = (lo & 0x0f) | ((hi & 0x01) << 4);
1501 	} else if (type == w83627thf) {
1502 		data->vid = w83627thf_read_gpio5(pdev);
1503 	} else if (type == w83687thf) {
1504 		data->vid = w83687thf_read_vid(pdev);
1505 	}
1506 
1507 	/* Read VRM & OVT Config only once */
1508 	if (type == w83627thf || type == w83637hf || type == w83687thf) {
1509 		data->vrm_ovt =
1510 			w83627hf_read_value(data, W83627THF_REG_VRM_OVT_CFG);
1511 	}
1512 
1513 	tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1514 	for (i = 1; i <= 3; i++) {
1515 		if (!(tmp & BIT_SCFG1[i - 1])) {
1516 			data->sens[i - 1] = W83781D_DEFAULT_BETA;
1517 		} else {
1518 			if (w83627hf_read_value
1519 			    (data,
1520 			     W83781D_REG_SCFG2) & BIT_SCFG2[i - 1])
1521 				data->sens[i - 1] = 1;
1522 			else
1523 				data->sens[i - 1] = 2;
1524 		}
1525 		if ((type == w83697hf) && (i == 2))
1526 			break;
1527 	}
1528 
1529 	if(init) {
1530 		/* Enable temp2 */
1531 		tmp = w83627hf_read_value(data, W83781D_REG_TEMP2_CONFIG);
1532 		if (tmp & 0x01) {
1533 			dev_warn(&pdev->dev, "Enabling temp2, readings "
1534 				 "might not make sense\n");
1535 			w83627hf_write_value(data, W83781D_REG_TEMP2_CONFIG,
1536 				tmp & 0xfe);
1537 		}
1538 
1539 		/* Enable temp3 */
1540 		if (type != w83697hf) {
1541 			tmp = w83627hf_read_value(data,
1542 				W83781D_REG_TEMP3_CONFIG);
1543 			if (tmp & 0x01) {
1544 				dev_warn(&pdev->dev, "Enabling temp3, "
1545 					 "readings might not make sense\n");
1546 				w83627hf_write_value(data,
1547 					W83781D_REG_TEMP3_CONFIG, tmp & 0xfe);
1548 			}
1549 		}
1550 	}
1551 
1552 	/* Start monitoring */
1553 	w83627hf_write_value(data, W83781D_REG_CONFIG,
1554 			    (w83627hf_read_value(data,
1555 						W83781D_REG_CONFIG) & 0xf7)
1556 			    | 0x01);
1557 }
1558 
1559 static struct w83627hf_data *w83627hf_update_device(struct device *dev)
1560 {
1561 	struct w83627hf_data *data = dev_get_drvdata(dev);
1562 	int i;
1563 
1564 	mutex_lock(&data->update_lock);
1565 
1566 	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
1567 	    || !data->valid) {
1568 		for (i = 0; i <= 8; i++) {
1569 			/* skip missing sensors */
1570 			if (((data->type == w83697hf) && (i == 1)) ||
1571 			    ((data->type != w83627hf && data->type != w83697hf)
1572 			    && (i == 5 || i == 6)))
1573 				continue;
1574 			data->in[i] =
1575 			    w83627hf_read_value(data, W83781D_REG_IN(i));
1576 			data->in_min[i] =
1577 			    w83627hf_read_value(data,
1578 					       W83781D_REG_IN_MIN(i));
1579 			data->in_max[i] =
1580 			    w83627hf_read_value(data,
1581 					       W83781D_REG_IN_MAX(i));
1582 		}
1583 		for (i = 1; i <= 3; i++) {
1584 			data->fan[i - 1] =
1585 			    w83627hf_read_value(data, W83781D_REG_FAN(i));
1586 			data->fan_min[i - 1] =
1587 			    w83627hf_read_value(data,
1588 					       W83781D_REG_FAN_MIN(i));
1589 		}
1590 		for (i = 1; i <= 3; i++) {
1591 			u8 tmp = w83627hf_read_value(data,
1592 				W836X7HF_REG_PWM(data->type, i));
1593  			/* bits 0-3 are reserved  in 627THF */
1594  			if (data->type == w83627thf)
1595 				tmp &= 0xf0;
1596 			data->pwm[i - 1] = tmp;
1597 			if(i == 2 &&
1598 			   (data->type == w83627hf || data->type == w83697hf))
1599 				break;
1600 		}
1601 		if (data->type == w83627hf) {
1602 				u8 tmp = w83627hf_read_value(data,
1603 						W83627HF_REG_PWM_FREQ);
1604 				data->pwm_freq[0] = tmp & 0x07;
1605 				data->pwm_freq[1] = (tmp >> 4) & 0x07;
1606 		} else if (data->type != w83627thf) {
1607 			for (i = 1; i <= 3; i++) {
1608 				data->pwm_freq[i - 1] =
1609 					w83627hf_read_value(data,
1610 						W83637HF_REG_PWM_FREQ[i - 1]);
1611 				if (i == 2 && (data->type == w83697hf))
1612 					break;
1613 			}
1614 		}
1615 
1616 		data->temp = w83627hf_read_value(data, W83781D_REG_TEMP(1));
1617 		data->temp_max =
1618 		    w83627hf_read_value(data, W83781D_REG_TEMP_OVER(1));
1619 		data->temp_max_hyst =
1620 		    w83627hf_read_value(data, W83781D_REG_TEMP_HYST(1));
1621 		data->temp_add[0] =
1622 		    w83627hf_read_value(data, W83781D_REG_TEMP(2));
1623 		data->temp_max_add[0] =
1624 		    w83627hf_read_value(data, W83781D_REG_TEMP_OVER(2));
1625 		data->temp_max_hyst_add[0] =
1626 		    w83627hf_read_value(data, W83781D_REG_TEMP_HYST(2));
1627 		if (data->type != w83697hf) {
1628 			data->temp_add[1] =
1629 			  w83627hf_read_value(data, W83781D_REG_TEMP(3));
1630 			data->temp_max_add[1] =
1631 			  w83627hf_read_value(data, W83781D_REG_TEMP_OVER(3));
1632 			data->temp_max_hyst_add[1] =
1633 			  w83627hf_read_value(data, W83781D_REG_TEMP_HYST(3));
1634 		}
1635 
1636 		i = w83627hf_read_value(data, W83781D_REG_VID_FANDIV);
1637 		data->fan_div[0] = (i >> 4) & 0x03;
1638 		data->fan_div[1] = (i >> 6) & 0x03;
1639 		if (data->type != w83697hf) {
1640 			data->fan_div[2] = (w83627hf_read_value(data,
1641 					       W83781D_REG_PIN) >> 6) & 0x03;
1642 		}
1643 		i = w83627hf_read_value(data, W83781D_REG_VBAT);
1644 		data->fan_div[0] |= (i >> 3) & 0x04;
1645 		data->fan_div[1] |= (i >> 4) & 0x04;
1646 		if (data->type != w83697hf)
1647 			data->fan_div[2] |= (i >> 5) & 0x04;
1648 		data->alarms =
1649 		    w83627hf_read_value(data, W83781D_REG_ALARM1) |
1650 		    (w83627hf_read_value(data, W83781D_REG_ALARM2) << 8) |
1651 		    (w83627hf_read_value(data, W83781D_REG_ALARM3) << 16);
1652 		i = w83627hf_read_value(data, W83781D_REG_BEEP_INTS2);
1653 		data->beep_enable = i >> 7;
1654 		data->beep_mask = ((i & 0x7f) << 8) |
1655 		    w83627hf_read_value(data, W83781D_REG_BEEP_INTS1) |
1656 		    w83627hf_read_value(data, W83781D_REG_BEEP_INTS3) << 16;
1657 		data->last_updated = jiffies;
1658 		data->valid = 1;
1659 	}
1660 
1661 	mutex_unlock(&data->update_lock);
1662 
1663 	return data;
1664 }
1665 
1666 static int __init w83627hf_device_add(unsigned short address,
1667 				      const struct w83627hf_sio_data *sio_data)
1668 {
1669 	struct resource res = {
1670 		.start	= address + WINB_REGION_OFFSET,
1671 		.end	= address + WINB_REGION_OFFSET + WINB_REGION_SIZE - 1,
1672 		.name	= DRVNAME,
1673 		.flags	= IORESOURCE_IO,
1674 	};
1675 	int err;
1676 
1677 	pdev = platform_device_alloc(DRVNAME, address);
1678 	if (!pdev) {
1679 		err = -ENOMEM;
1680 		printk(KERN_ERR DRVNAME ": Device allocation failed\n");
1681 		goto exit;
1682 	}
1683 
1684 	err = platform_device_add_resources(pdev, &res, 1);
1685 	if (err) {
1686 		printk(KERN_ERR DRVNAME ": Device resource addition failed "
1687 		       "(%d)\n", err);
1688 		goto exit_device_put;
1689 	}
1690 
1691 	err = platform_device_add_data(pdev, sio_data,
1692 				       sizeof(struct w83627hf_sio_data));
1693 	if (err) {
1694 		printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1695 		goto exit_device_put;
1696 	}
1697 
1698 	err = platform_device_add(pdev);
1699 	if (err) {
1700 		printk(KERN_ERR DRVNAME ": Device addition failed (%d)\n",
1701 		       err);
1702 		goto exit_device_put;
1703 	}
1704 
1705 	return 0;
1706 
1707 exit_device_put:
1708 	platform_device_put(pdev);
1709 exit:
1710 	return err;
1711 }
1712 
1713 static int __init sensors_w83627hf_init(void)
1714 {
1715 	int err;
1716 	unsigned short address;
1717 	struct w83627hf_sio_data sio_data;
1718 
1719 	if (w83627hf_find(0x2e, &address, &sio_data)
1720 	 && w83627hf_find(0x4e, &address, &sio_data))
1721 		return -ENODEV;
1722 
1723 	err = platform_driver_register(&w83627hf_driver);
1724 	if (err)
1725 		goto exit;
1726 
1727 	/* Sets global pdev as a side effect */
1728 	err = w83627hf_device_add(address, &sio_data);
1729 	if (err)
1730 		goto exit_driver;
1731 
1732 	return 0;
1733 
1734 exit_driver:
1735 	platform_driver_unregister(&w83627hf_driver);
1736 exit:
1737 	return err;
1738 }
1739 
1740 static void __exit sensors_w83627hf_exit(void)
1741 {
1742 	platform_device_unregister(pdev);
1743 	platform_driver_unregister(&w83627hf_driver);
1744 }
1745 
1746 MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
1747 	      "Philip Edelbrock <phil@netroedge.com>, "
1748 	      "and Mark Studebaker <mdsxyz123@yahoo.com>");
1749 MODULE_DESCRIPTION("W83627HF driver");
1750 MODULE_LICENSE("GPL");
1751 
1752 module_init(sensors_w83627hf_init);
1753 module_exit(sensors_w83627hf_exit);
1754