blob: 7a4a15f4bf8ba2fd42ebab9c42a9667768dad348 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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>
Jean Delvare787c72b2007-05-08 17:22:00 +02008 Copyright (c) 2007 Jean Delvare <khali@linux-fr.org>
Linus Torvalds1da177e2005-04-16 15:20:36 -07009
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)
Jean Delvarec2db6ce2006-01-18 23:22:12 +010032 w83687thf 7 3 3 3 0x90 0x5ca3 no yes(LPC)
Linus Torvalds1da177e2005-04-16 15:20:36 -070033 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>
Jean Delvare787c72b2007-05-08 17:22:00 +020046#include <linux/platform_device.h>
Mark M. Hoffman943b0832005-07-15 21:39:18 -040047#include <linux/hwmon.h>
Jean Delvare303760b2005-07-31 21:52:01 +020048#include <linux/hwmon-vid.h>
Mark M. Hoffman943b0832005-07-15 21:39:18 -040049#include <linux/err.h>
Ingo Molnar9a61bf62006-01-18 23:19:26 +010050#include <linux/mutex.h>
Jean Delvared27c37c2007-05-08 17:21:59 +020051#include <linux/ioport.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070052#include <asm/io.h>
53#include "lm75.h"
54
Jean Delvare787c72b2007-05-08 17:22:00 +020055static struct platform_device *pdev;
Jean Delvared27c37c2007-05-08 17:21:59 +020056
57#define DRVNAME "w83627hf"
58enum chips { w83627hf, w83627thf, w83697hf, w83637hf, w83687thf };
59
Linus Torvalds1da177e2005-04-16 15:20:36 -070060static u16 force_addr;
61module_param(force_addr, ushort, 0);
62MODULE_PARM_DESC(force_addr,
63 "Initialize the base address of the sensors");
64static u8 force_i2c = 0x1f;
65module_param(force_i2c, byte, 0);
66MODULE_PARM_DESC(force_i2c,
67 "Initialize the i2c address of the sensors");
68
Jean Delvare2251cf12005-09-04 22:52:17 +020069static int reset;
70module_param(reset, bool, 0);
71MODULE_PARM_DESC(reset, "Set to one to reset chip on load");
72
Linus Torvalds1da177e2005-04-16 15:20:36 -070073static int init = 1;
74module_param(init, bool, 0);
75MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");
76
77/* modified from kernel/include/traps.c */
78static int REG; /* The register to read/write */
79#define DEV 0x07 /* Register: Logical device select */
80static 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
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100105#define W83687THF_VID_EN 0x29 /* w83687thf only */
106#define W83687THF_VID_CFG 0xF0 /* w83687thf only */
107#define W83687THF_VID_DATA 0xF1 /* w83687thf only */
108
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109static inline void
110superio_outb(int reg, int val)
111{
112 outb(reg, REG);
113 outb(val, VAL);
114}
115
116static inline int
117superio_inb(int reg)
118{
119 outb(reg, REG);
120 return inb(VAL);
121}
122
123static inline void
124superio_select(int ld)
125{
126 outb(DEV, REG);
127 outb(ld, VAL);
128}
129
130static inline void
131superio_enter(void)
132{
133 outb(0x87, REG);
134 outb(0x87, REG);
135}
136
137static inline void
138superio_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
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100147#define W687THF_DEVID 0x85
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148#define WINB_ACT_REG 0x30
149#define WINB_BASE_REG 0x60
150/* Constants specified below */
151
Petr Vandrovecada0c2f2005-10-07 23:11:03 +0200152/* Alignment of the base address */
153#define WINB_ALIGNMENT ~7
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154
Petr Vandrovecada0c2f2005-10-07 23:11:03 +0200155/* Offset & size of I/O region we are interested in */
156#define WINB_REGION_OFFSET 5
157#define WINB_REGION_SIZE 2
158
Jean Delvare787c72b2007-05-08 17:22:00 +0200159/* 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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162
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
Yuan Mu4a1c44472005-11-07 22:19:04 +0100190#define W83781D_REG_ALARM1 0x459
191#define W83781D_REG_ALARM2 0x45A
192#define W83781D_REG_ALARM3 0x45B
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194#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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100211#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 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100215#define W83627THF_REG_VRM_OVT_CFG 0x18 /* 637HF/687THF too */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216
217static const u8 regpwm_627hf[] = { W83627HF_REG_PWM1, W83627HF_REG_PWM2 };
218static 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
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -0400223#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
229static 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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235#define W83781D_REG_I2C_ADDR 0x48
236#define W83781D_REG_I2C_SUBADDR 0x4A
237
238/* Sensor selection */
239#define W83781D_REG_SCFG1 0x5D
240static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };
241#define W83781D_REG_SCFG2 0x59
242static 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
252static 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 */
266static 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
273static 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
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -0400282static 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}
288static 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
301static 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}
312static 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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325#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
332static inline u8 DIV_TO_REG(long val)
333{
334 int i;
335 val = SENSORS_LIMIT(val, 1, 128) >> 1;
Grant Coadyabc01922005-05-12 13:41:51 +1000336 for (i = 0; i < 7; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 if (val == 0)
338 break;
339 val >>= 1;
340 }
341 return ((u8) i);
342}
343
Jean Delvareed6bafb2007-02-14 21:15:03 +0100344/* For each registered chip, we need to keep some data in memory.
345 The structure is dynamically allocated. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346struct w83627hf_data {
Jean Delvare787c72b2007-05-08 17:22:00 +0200347 unsigned short addr;
348 const char *name;
Mark M. Hoffman943b0832005-07-15 21:39:18 -0400349 struct class_device *class_dev;
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100350 struct mutex lock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 enum chips type;
352
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100353 struct mutex update_lock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354 char valid; /* !=0 if following fields are valid */
355 unsigned long last_updated; /* In jiffies */
356
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357 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 */
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -0400374 u8 pwm_freq[3]; /* Register value */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375 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;
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100381 u8 vrm_ovt; /* Register value, 627THF/637HF/687THF only */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382};
383
Jean Delvare787c72b2007-05-08 17:22:00 +0200384struct w83627hf_sio_data {
385 enum chips type;
386};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Jean Delvare787c72b2007-05-08 17:22:00 +0200389static int w83627hf_probe(struct platform_device *pdev);
Jean Delvared0546122007-07-22 12:09:48 +0200390static int __devexit w83627hf_remove(struct platform_device *pdev);
Jean Delvare787c72b2007-05-08 17:22:00 +0200391
392static int w83627hf_read_value(struct w83627hf_data *data, u16 reg);
393static int w83627hf_write_value(struct w83627hf_data *data, u16 reg, u16 value);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394static struct w83627hf_data *w83627hf_update_device(struct device *dev);
Jean Delvare787c72b2007-05-08 17:22:00 +0200395static void w83627hf_init_device(struct platform_device *pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
Jean Delvare787c72b2007-05-08 17:22:00 +0200397static struct platform_driver w83627hf_driver = {
Laurent Riffardcdaf7932005-11-26 20:37:41 +0100398 .driver = {
Jean Delvare87218842006-09-03 22:36:14 +0200399 .owner = THIS_MODULE,
Jean Delvared27c37c2007-05-08 17:21:59 +0200400 .name = DRVNAME,
Laurent Riffardcdaf7932005-11-26 20:37:41 +0100401 },
Jean Delvare787c72b2007-05-08 17:22:00 +0200402 .probe = w83627hf_probe,
403 .remove = __devexit_p(w83627hf_remove),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404};
405
406/* following are the sysfs callback functions */
407#define show_in_reg(reg) \
408static 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}
413show_in_reg(in)
414show_in_reg(in_min)
415show_in_reg(in_max)
416
417#define store_in_reg(REG, reg) \
418static ssize_t \
419store_in_##reg (struct device *dev, const char *buf, size_t count, int nr) \
420{ \
Jean Delvare787c72b2007-05-08 17:22:00 +0200421 struct w83627hf_data *data = dev_get_drvdata(dev); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422 u32 val; \
423 \
424 val = simple_strtoul(buf, NULL, 10); \
425 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100426 mutex_lock(&data->update_lock); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427 data->in_##reg[nr] = IN_TO_REG(val); \
Jean Delvare787c72b2007-05-08 17:22:00 +0200428 w83627hf_write_value(data, W83781D_REG_IN_##REG(nr), \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429 data->in_##reg[nr]); \
430 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100431 mutex_unlock(&data->update_lock); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432 return count; \
433}
434store_in_reg(MIN, min)
435store_in_reg(MAX, max)
436
437#define sysfs_in_offset(offset) \
438static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400439show_regs_in_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440{ \
441 return show_in(dev, buf, offset); \
442} \
443static DEVICE_ATTR(in##offset##_input, S_IRUGO, show_regs_in_##offset, NULL);
444
445#define sysfs_in_reg_offset(reg, offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400446static ssize_t show_regs_in_##reg##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447{ \
448 return show_in_##reg (dev, buf, offset); \
449} \
450static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400451store_regs_in_##reg##offset (struct device *dev, struct device_attribute *attr, \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 const char *buf, size_t count) \
453{ \
454 return store_in_##reg (dev, buf, count, offset); \
455} \
456static 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) \
460sysfs_in_offset(offset) \
461sysfs_in_reg_offset(min, offset) \
462sysfs_in_reg_offset(max, offset)
463
464sysfs_in_offsets(1);
465sysfs_in_offsets(2);
466sysfs_in_offsets(3);
467sysfs_in_offsets(4);
468sysfs_in_offsets(5);
469sysfs_in_offsets(6);
470sysfs_in_offsets(7);
471sysfs_in_offsets(8);
472
473/* use a different set of functions for in0 */
474static ssize_t show_in_0(struct w83627hf_data *data, char *buf, u8 reg)
475{
476 long in0;
477
478 if ((data->vrm_ovt & 0x01) &&
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100479 (w83627thf == data->type || w83637hf == data->type
480 || w83687thf == data->type))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481
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
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400491static ssize_t show_regs_in_0(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492{
493 struct w83627hf_data *data = w83627hf_update_device(dev);
494 return show_in_0(data, buf, data->in[0]);
495}
496
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400497static ssize_t show_regs_in_min0(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498{
499 struct w83627hf_data *data = w83627hf_update_device(dev);
500 return show_in_0(data, buf, data->in_min[0]);
501}
502
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400503static ssize_t show_regs_in_max0(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504{
505 struct w83627hf_data *data = w83627hf_update_device(dev);
506 return show_in_0(data, buf, data->in_max[0]);
507}
508
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400509static ssize_t store_regs_in_min0(struct device *dev, struct device_attribute *attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 const char *buf, size_t count)
511{
Jean Delvare787c72b2007-05-08 17:22:00 +0200512 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513 u32 val;
514
515 val = simple_strtoul(buf, NULL, 10);
516
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100517 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518
519 if ((data->vrm_ovt & 0x01) &&
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100520 (w83627thf == data->type || w83637hf == data->type
521 || w83687thf == data->type))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522
523 /* use VRM9 calculation */
Yuan Mu2723ab92005-11-23 15:44:21 -0800524 data->in_min[0] =
525 SENSORS_LIMIT(((val * 100) - 70000 + 244) / 488, 0,
526 255);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527 else
528 /* use VRM8 (standard) calculation */
529 data->in_min[0] = IN_TO_REG(val);
530
Jean Delvare787c72b2007-05-08 17:22:00 +0200531 w83627hf_write_value(data, W83781D_REG_IN_MIN(0), data->in_min[0]);
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100532 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533 return count;
534}
535
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400536static ssize_t store_regs_in_max0(struct device *dev, struct device_attribute *attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537 const char *buf, size_t count)
538{
Jean Delvare787c72b2007-05-08 17:22:00 +0200539 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540 u32 val;
541
542 val = simple_strtoul(buf, NULL, 10);
543
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100544 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545
546 if ((data->vrm_ovt & 0x01) &&
Jean Delvarec2db6ce2006-01-18 23:22:12 +0100547 (w83627thf == data->type || w83637hf == data->type
548 || w83687thf == data->type))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549
550 /* use VRM9 calculation */
Yuan Mu2723ab92005-11-23 15:44:21 -0800551 data->in_max[0] =
552 SENSORS_LIMIT(((val * 100) - 70000 + 244) / 488, 0,
553 255);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554 else
555 /* use VRM8 (standard) calculation */
556 data->in_max[0] = IN_TO_REG(val);
557
Jean Delvare787c72b2007-05-08 17:22:00 +0200558 w83627hf_write_value(data, W83781D_REG_IN_MAX(0), data->in_max[0]);
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100559 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560 return count;
561}
562
563static DEVICE_ATTR(in0_input, S_IRUGO, show_regs_in_0, NULL);
564static DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR,
565 show_regs_in_min0, store_regs_in_min0);
566static DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR,
567 show_regs_in_max0, store_regs_in_max0);
568
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569#define show_fan_reg(reg) \
570static 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}
577show_fan_reg(fan);
578show_fan_reg(fan_min);
579
580static ssize_t
581store_fan_min(struct device *dev, const char *buf, size_t count, int nr)
582{
Jean Delvare787c72b2007-05-08 17:22:00 +0200583 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584 u32 val;
585
586 val = simple_strtoul(buf, NULL, 10);
587
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100588 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 data->fan_min[nr - 1] =
590 FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr - 1]));
Jean Delvare787c72b2007-05-08 17:22:00 +0200591 w83627hf_write_value(data, W83781D_REG_FAN_MIN(nr),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 data->fan_min[nr - 1]);
593
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100594 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595 return count;
596}
597
598#define sysfs_fan_offset(offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400599static ssize_t show_regs_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600{ \
601 return show_fan(dev, buf, offset); \
602} \
603static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_regs_fan_##offset, NULL);
604
605#define sysfs_fan_min_offset(offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400606static ssize_t show_regs_fan_min##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607{ \
608 return show_fan_min(dev, buf, offset); \
609} \
610static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400611store_regs_fan_min##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612{ \
613 return store_fan_min(dev, buf, count, offset); \
614} \
615static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \
616 show_regs_fan_min##offset, store_regs_fan_min##offset);
617
618sysfs_fan_offset(1);
619sysfs_fan_min_offset(1);
620sysfs_fan_offset(2);
621sysfs_fan_min_offset(2);
622sysfs_fan_offset(3);
623sysfs_fan_min_offset(3);
624
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625#define show_temp_reg(reg) \
626static 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}
636show_temp_reg(temp);
637show_temp_reg(temp_max);
638show_temp_reg(temp_max_hyst);
639
640#define store_temp_reg(REG, reg) \
641static ssize_t \
642store_temp_##reg (struct device *dev, const char *buf, size_t count, int nr) \
643{ \
Jean Delvare787c72b2007-05-08 17:22:00 +0200644 struct w83627hf_data *data = dev_get_drvdata(dev); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645 u32 val; \
646 \
647 val = simple_strtoul(buf, NULL, 10); \
648 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100649 mutex_lock(&data->update_lock); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650 \
651 if (nr >= 2) { /* TEMP2 and TEMP3 */ \
652 data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \
Jean Delvare787c72b2007-05-08 17:22:00 +0200653 w83627hf_write_value(data, W83781D_REG_TEMP_##REG(nr), \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 data->temp_##reg##_add[nr-2]); \
655 } else { /* TEMP1 */ \
656 data->temp_##reg = TEMP_TO_REG(val); \
Jean Delvare787c72b2007-05-08 17:22:00 +0200657 w83627hf_write_value(data, W83781D_REG_TEMP_##REG(nr), \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 data->temp_##reg); \
659 } \
660 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100661 mutex_unlock(&data->update_lock); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662 return count; \
663}
664store_temp_reg(OVER, max);
665store_temp_reg(HYST, max_hyst);
666
667#define sysfs_temp_offset(offset) \
668static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400669show_regs_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670{ \
671 return show_temp(dev, buf, offset); \
672} \
673static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_regs_temp_##offset, NULL);
674
675#define sysfs_temp_reg_offset(reg, offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400676static ssize_t show_regs_temp_##reg##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677{ \
678 return show_temp_##reg (dev, buf, offset); \
679} \
680static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400681store_regs_temp_##reg##offset (struct device *dev, struct device_attribute *attr, \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682 const char *buf, size_t count) \
683{ \
684 return store_temp_##reg (dev, buf, count, offset); \
685} \
686static 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) \
690sysfs_temp_offset(offset) \
691sysfs_temp_reg_offset(max, offset) \
692sysfs_temp_reg_offset(max_hyst, offset)
693
694sysfs_temp_offsets(1);
695sysfs_temp_offsets(2);
696sysfs_temp_offsets(3);
697
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698static ssize_t
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400699show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700{
701 struct w83627hf_data *data = w83627hf_update_device(dev);
702 return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
703}
704static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705
706static ssize_t
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400707show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708{
709 struct w83627hf_data *data = w83627hf_update_device(dev);
710 return sprintf(buf, "%ld\n", (long) data->vrm);
711}
712static ssize_t
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400713store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714{
Jean Delvare787c72b2007-05-08 17:22:00 +0200715 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 u32 val;
717
718 val = simple_strtoul(buf, NULL, 10);
719 data->vrm = val;
720
721 return count;
722}
723static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724
725static ssize_t
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400726show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700727{
728 struct w83627hf_data *data = w83627hf_update_device(dev);
729 return sprintf(buf, "%ld\n", (long) data->alarms);
730}
731static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732
733#define show_beep_reg(REG, reg) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400734static ssize_t show_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735{ \
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}
740show_beep_reg(ENABLE, enable)
741show_beep_reg(MASK, mask)
742
743#define BEEP_ENABLE 0 /* Store beep_enable */
744#define BEEP_MASK 1 /* Store beep_mask */
745
746static ssize_t
747store_beep_reg(struct device *dev, const char *buf, size_t count,
748 int update_mask)
749{
Jean Delvare787c72b2007-05-08 17:22:00 +0200750 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 u32 val, val2;
752
753 val = simple_strtoul(buf, NULL, 10);
754
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100755 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756
757 if (update_mask == BEEP_MASK) { /* We are storing beep_mask */
758 data->beep_mask = BEEP_MASK_TO_REG(val);
Jean Delvare787c72b2007-05-08 17:22:00 +0200759 w83627hf_write_value(data, W83781D_REG_BEEP_INTS1,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700760 data->beep_mask & 0xff);
Jean Delvare787c72b2007-05-08 17:22:00 +0200761 w83627hf_write_value(data, W83781D_REG_BEEP_INTS3,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 ((data->beep_mask) >> 16) & 0xff);
763 val2 = (data->beep_mask >> 8) & 0x7f;
764 } else { /* We are storing beep_enable */
765 val2 =
Jean Delvare787c72b2007-05-08 17:22:00 +0200766 w83627hf_read_value(data, W83781D_REG_BEEP_INTS2) & 0x7f;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700767 data->beep_enable = BEEP_ENABLE_TO_REG(val);
768 }
769
Jean Delvare787c72b2007-05-08 17:22:00 +0200770 w83627hf_write_value(data, W83781D_REG_BEEP_INTS2,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 val2 | data->beep_enable << 7);
772
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100773 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 return count;
775}
776
777#define sysfs_beep(REG, reg) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400778static ssize_t show_regs_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779{ \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400780 return show_beep_##reg(dev, attr, buf); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781} \
782static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400783store_regs_beep_##reg (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784{ \
785 return store_beep_reg(dev, buf, count, BEEP_##REG); \
786} \
787static DEVICE_ATTR(beep_##reg, S_IRUGO | S_IWUSR, \
788 show_regs_beep_##reg, store_regs_beep_##reg);
789
790sysfs_beep(ENABLE, enable);
791sysfs_beep(MASK, mask);
792
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793static ssize_t
794show_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
Andreas Mohrd6e05ed2006-06-26 18:35:02 +0200803 least surprise; the user doesn't expect the fan minimum to change just
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804 because the divisor changed. */
805static ssize_t
806store_fan_div_reg(struct device *dev, const char *buf, size_t count, int nr)
807{
Jean Delvare787c72b2007-05-08 17:22:00 +0200808 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 unsigned long min;
810 u8 reg;
811 unsigned long val = simple_strtoul(buf, NULL, 10);
812
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100813 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814
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
Jean Delvare787c72b2007-05-08 17:22:00 +0200821 reg = (w83627hf_read_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822 & (nr==0 ? 0xcf : 0x3f))
823 | ((data->fan_div[nr] & 0x03) << (nr==0 ? 4 : 6));
Jean Delvare787c72b2007-05-08 17:22:00 +0200824 w83627hf_write_value(data, nr==2 ? W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825
Jean Delvare787c72b2007-05-08 17:22:00 +0200826 reg = (w83627hf_read_value(data, W83781D_REG_VBAT)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827 & ~(1 << (5 + nr)))
828 | ((data->fan_div[nr] & 0x04) << (3 + nr));
Jean Delvare787c72b2007-05-08 17:22:00 +0200829 w83627hf_write_value(data, W83781D_REG_VBAT, reg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830
831 /* Restore fan_min */
832 data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
Jean Delvare787c72b2007-05-08 17:22:00 +0200833 w83627hf_write_value(data, W83781D_REG_FAN_MIN(nr+1), data->fan_min[nr]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100835 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700836 return count;
837}
838
839#define sysfs_fan_div(offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400840static ssize_t show_regs_fan_div_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841{ \
842 return show_fan_div_reg(dev, buf, offset); \
843} \
844static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400845store_regs_fan_div_##offset (struct device *dev, struct device_attribute *attr, \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700846 const char *buf, size_t count) \
847{ \
848 return store_fan_div_reg(dev, buf, count, offset - 1); \
849} \
850static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \
851 show_regs_fan_div_##offset, store_regs_fan_div_##offset);
852
853sysfs_fan_div(1);
854sysfs_fan_div(2);
855sysfs_fan_div(3);
856
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857static ssize_t
858show_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
864static ssize_t
865store_pwm_reg(struct device *dev, const char *buf, size_t count, int nr)
866{
Jean Delvare787c72b2007-05-08 17:22:00 +0200867 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868 u32 val;
869
870 val = simple_strtoul(buf, NULL, 10);
871
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100872 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700873
874 if (data->type == w83627thf) {
875 /* bits 0-3 are reserved in 627THF */
876 data->pwm[nr - 1] = PWM_TO_REG(val) & 0xf0;
Jean Delvare787c72b2007-05-08 17:22:00 +0200877 w83627hf_write_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700878 W836X7HF_REG_PWM(data->type, nr),
879 data->pwm[nr - 1] |
Jean Delvare787c72b2007-05-08 17:22:00 +0200880 (w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 W836X7HF_REG_PWM(data->type, nr)) & 0x0f));
882 } else {
883 data->pwm[nr - 1] = PWM_TO_REG(val);
Jean Delvare787c72b2007-05-08 17:22:00 +0200884 w83627hf_write_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 W836X7HF_REG_PWM(data->type, nr),
886 data->pwm[nr - 1]);
887 }
888
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100889 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700890 return count;
891}
892
893#define sysfs_pwm(offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400894static ssize_t show_regs_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700895{ \
896 return show_pwm_reg(dev, buf, offset); \
897} \
898static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -0400899store_regs_pwm_##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900{ \
901 return store_pwm_reg(dev, buf, count, offset); \
902} \
903static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \
904 show_regs_pwm_##offset, store_regs_pwm_##offset);
905
906sysfs_pwm(1);
907sysfs_pwm(2);
908sysfs_pwm(3);
909
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910static ssize_t
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -0400911show_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
922static ssize_t
923store_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) \
950static 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} \
955static ssize_t \
956store_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} \
961static DEVICE_ATTR(pwm##offset##_freq, S_IRUGO | S_IWUSR, \
962 show_regs_pwm_freq_##offset, store_regs_pwm_freq_##offset);
963
964sysfs_pwm_freq(1);
965sysfs_pwm_freq(2);
966sysfs_pwm_freq(3);
967
968static ssize_t
Linus Torvalds1da177e2005-04-16 15:20:36 -0700969show_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
975static ssize_t
976store_sensor_reg(struct device *dev, const char *buf, size_t count, int nr)
977{
Jean Delvare787c72b2007-05-08 17:22:00 +0200978 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700979 u32 val, tmp;
980
981 val = simple_strtoul(buf, NULL, 10);
982
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100983 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984
985 switch (val) {
986 case 1: /* PII/Celeron diode */
Jean Delvare787c72b2007-05-08 17:22:00 +0200987 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
988 w83627hf_write_value(data, W83781D_REG_SCFG1,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989 tmp | BIT_SCFG1[nr - 1]);
Jean Delvare787c72b2007-05-08 17:22:00 +0200990 tmp = w83627hf_read_value(data, W83781D_REG_SCFG2);
991 w83627hf_write_value(data, W83781D_REG_SCFG2,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992 tmp | BIT_SCFG2[nr - 1]);
993 data->sens[nr - 1] = val;
994 break;
995 case 2: /* 3904 */
Jean Delvare787c72b2007-05-08 17:22:00 +0200996 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
997 w83627hf_write_value(data, W83781D_REG_SCFG1,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 tmp | BIT_SCFG1[nr - 1]);
Jean Delvare787c72b2007-05-08 17:22:00 +0200999 tmp = w83627hf_read_value(data, W83781D_REG_SCFG2);
1000 w83627hf_write_value(data, W83781D_REG_SCFG2,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001 tmp & ~BIT_SCFG2[nr - 1]);
1002 data->sens[nr - 1] = val;
1003 break;
1004 case W83781D_DEFAULT_BETA: /* thermistor */
Jean Delvare787c72b2007-05-08 17:22:00 +02001005 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
1006 w83627hf_write_value(data, W83781D_REG_SCFG1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007 tmp & ~BIT_SCFG1[nr - 1]);
1008 data->sens[nr - 1] = val;
1009 break;
1010 default:
Jean Delvare787c72b2007-05-08 17:22:00 +02001011 dev_err(dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012 "Invalid sensor type %ld; must be 1, 2, or %d\n",
1013 (long) val, W83781D_DEFAULT_BETA);
1014 break;
1015 }
1016
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001017 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018 return count;
1019}
1020
1021#define sysfs_sensor(offset) \
Yani Ioannoua5099cf2005-05-17 06:42:25 -04001022static ssize_t show_regs_sensor_##offset (struct device *dev, struct device_attribute *attr, char *buf) \
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023{ \
1024 return show_sensor_reg(dev, buf, offset); \
1025} \
1026static ssize_t \
Yani Ioannoua5099cf2005-05-17 06:42:25 -04001027store_regs_sensor_##offset (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028{ \
1029 return store_sensor_reg(dev, buf, count, offset); \
1030} \
1031static DEVICE_ATTR(temp##offset##_type, S_IRUGO | S_IWUSR, \
1032 show_regs_sensor_##offset, store_regs_sensor_##offset);
1033
1034sysfs_sensor(1);
1035sysfs_sensor(2);
1036sysfs_sensor(3);
1037
Jean Delvare787c72b2007-05-08 17:22:00 +02001038static 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}
1045static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1046
1047static int __init w83627hf_find(int sioaddr, unsigned short *addr,
1048 struct w83627hf_sio_data *sio_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049{
Jean Delvared27c37c2007-05-08 17:21:59 +02001050 int err = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051 u16 val;
1052
Jean Delvare787c72b2007-05-08 17:22:00 +02001053 static const __initdata char *names[] = {
1054 "W83627HF",
1055 "W83627THF",
1056 "W83697HF",
1057 "W83637HF",
1058 "W83687THF",
1059 };
1060
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061 REG = sioaddr;
1062 VAL = sioaddr + 1;
1063
1064 superio_enter();
1065 val= superio_inb(DEVID);
Jean Delvare787c72b2007-05-08 17:22:00 +02001066 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;
Jean Delvaree142e2a2007-05-27 22:17:43 +02001082 case 0xff: /* No device at all */
1083 goto exit;
Jean Delvare787c72b2007-05-08 17:22:00 +02001084 default:
Jean Delvaree142e2a2007-05-27 22:17:43 +02001085 pr_debug(DRVNAME ": Unsupported chip (DEVID=0x%02x)\n", val);
Jean Delvared27c37c2007-05-08 17:21:59 +02001086 goto exit;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001087 }
1088
1089 superio_select(W83627HF_LD_HWM);
Jean Delvared27c37c2007-05-08 17:21:59 +02001090 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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097 val = (superio_inb(WINB_BASE_REG) << 8) |
1098 superio_inb(WINB_BASE_REG + 1);
Petr Vandrovecada0c2f2005-10-07 23:11:03 +02001099 *addr = val & WINB_ALIGNMENT;
Jean Delvared27c37c2007-05-08 17:21:59 +02001100 if (*addr == 0) {
1101 printk(KERN_WARNING DRVNAME ": Base address not set, "
1102 "skipping\n");
1103 goto exit;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001105
Jean Delvared27c37c2007-05-08 17:21:59 +02001106 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;
Jean Delvare787c72b2007-05-08 17:22:00 +02001113 pr_info(DRVNAME ": Found %s chip at %#x\n",
1114 names[sio_data->type], *addr);
Jean Delvared27c37c2007-05-08 17:21:59 +02001115
1116 exit:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117 superio_exit();
Jean Delvared27c37c2007-05-08 17:21:59 +02001118 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119}
1120
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001121static 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
Jean Delvare787c72b2007-05-08 17:22:00 +02001164 &dev_attr_name.attr,
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001165 NULL
1166};
1167
1168static const struct attribute_group w83627hf_group = {
1169 .attrs = w83627hf_attributes,
1170};
1171
1172static 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
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -04001194 &dev_attr_pwm1_freq.attr,
1195 &dev_attr_pwm2_freq.attr,
1196 &dev_attr_pwm3_freq.attr,
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001197 NULL
1198};
1199
1200static const struct attribute_group w83627hf_group_opt = {
1201 .attrs = w83627hf_attributes_opt,
1202};
1203
Jean Delvare787c72b2007-05-08 17:22:00 +02001204static int __devinit w83627hf_probe(struct platform_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001205{
Jean Delvare787c72b2007-05-08 17:22:00 +02001206 struct device *dev = &pdev->dev;
1207 struct w83627hf_sio_data *sio_data = dev->platform_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208 struct w83627hf_data *data;
Jean Delvare787c72b2007-05-08 17:22:00 +02001209 struct resource *res;
1210 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001211
Jean Delvare787c72b2007-05-08 17:22:00 +02001212 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));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225 err = -EBUSY;
1226 goto ERROR0;
1227 }
1228
Deepak Saxenaba9c2e82005-10-17 23:08:32 +02001229 if (!(data = kzalloc(sizeof(struct w83627hf_data), GFP_KERNEL))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230 err = -ENOMEM;
1231 goto ERROR1;
1232 }
Jean Delvare787c72b2007-05-08 17:22:00 +02001233 data->addr = res->start;
1234 data->type = sio_data->type;
1235 data->name = names[sio_data->type];
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001236 mutex_init(&data->lock);
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001237 mutex_init(&data->update_lock);
Jean Delvare787c72b2007-05-08 17:22:00 +02001238 platform_set_drvdata(pdev, data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001239
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240 /* Initialize the chip */
Jean Delvare787c72b2007-05-08 17:22:00 +02001241 w83627hf_init_device(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242
1243 /* A few vars need to be filled upon startup */
Jean Delvare787c72b2007-05-08 17:22:00 +02001244 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));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001248 /* Register common device attributes */
Jean Delvare787c72b2007-05-08 17:22:00 +02001249 if ((err = sysfs_create_group(&dev->kobj, &w83627hf_group)))
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001250 goto ERROR3;
1251
1252 /* Register chip-specific device attributes */
Jean Delvare787c72b2007-05-08 17:22:00 +02001253 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))
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -04001259 || (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)))
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001262 goto ERROR4;
1263
Jean Delvare787c72b2007-05-08 17:22:00 +02001264 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)))
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001275 goto ERROR4;
1276
Jean Delvare787c72b2007-05-08 17:22:00 +02001277 if (data->type != w83697hf && data->vid != 0xff) {
Jean Delvare8a665a02007-05-08 17:21:59 +02001278 /* Convert VID to voltage based on VRM */
1279 data->vrm = vid_which_vrm();
1280
Jean Delvare787c72b2007-05-08 17:22:00 +02001281 if ((err = device_create_file(dev, &dev_attr_cpu0_vid))
1282 || (err = device_create_file(dev, &dev_attr_vrm)))
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001283 goto ERROR4;
Jean Delvare8a665a02007-05-08 17:21:59 +02001284 }
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001285
Jean Delvare787c72b2007-05-08 17:22:00 +02001286 if (data->type == w83627thf || data->type == w83637hf
1287 || data->type == w83687thf)
1288 if ((err = device_create_file(dev, &dev_attr_pwm3)))
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001289 goto ERROR4;
1290
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -04001291 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
Jean Delvare787c72b2007-05-08 17:22:00 +02001297 data->class_dev = hwmon_device_register(dev);
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001298 if (IS_ERR(data->class_dev)) {
1299 err = PTR_ERR(data->class_dev);
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001300 goto ERROR4;
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001301 }
1302
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303 return 0;
1304
Mark M. Hoffmanc1685f62006-09-24 20:59:49 +02001305 ERROR4:
Jean Delvare787c72b2007-05-08 17:22:00 +02001306 sysfs_remove_group(&dev->kobj, &w83627hf_group);
1307 sysfs_remove_group(&dev->kobj, &w83627hf_group_opt);
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001308 ERROR3:
Jean Delvare04a62172007-06-12 13:57:19 +02001309 platform_set_drvdata(pdev, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310 kfree(data);
1311 ERROR1:
Jean Delvare787c72b2007-05-08 17:22:00 +02001312 release_region(res->start, WINB_REGION_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001313 ERROR0:
1314 return err;
1315}
1316
Jean Delvare787c72b2007-05-08 17:22:00 +02001317static int __devexit w83627hf_remove(struct platform_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318{
Jean Delvare787c72b2007-05-08 17:22:00 +02001319 struct w83627hf_data *data = platform_get_drvdata(pdev);
1320 struct resource *res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001322 hwmon_device_unregister(data->class_dev);
1323
Jean Delvare787c72b2007-05-08 17:22:00 +02001324 sysfs_remove_group(&pdev->dev.kobj, &w83627hf_group);
1325 sysfs_remove_group(&pdev->dev.kobj, &w83627hf_group_opt);
Jean Delvare04a62172007-06-12 13:57:19 +02001326 platform_set_drvdata(pdev, NULL);
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001327 kfree(data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328
Jean Delvare787c72b2007-05-08 17:22:00 +02001329 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1330 release_region(res->start, WINB_REGION_SIZE);
1331
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 return 0;
1333}
1334
1335
Jean Delvare787c72b2007-05-08 17:22:00 +02001336static int w83627hf_read_value(struct w83627hf_data *data, u16 reg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 int res, word_sized;
1339
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001340 mutex_lock(&data->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001341 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,
Jean Delvare787c72b2007-05-08 17:22:00 +02001348 data->addr + W83781D_ADDR_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 outb_p(reg >> 8,
Jean Delvare787c72b2007-05-08 17:22:00 +02001350 data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001351 }
Jean Delvare787c72b2007-05-08 17:22:00 +02001352 outb_p(reg & 0xff, data->addr + W83781D_ADDR_REG_OFFSET);
1353 res = inb_p(data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001354 if (word_sized) {
1355 outb_p((reg & 0xff) + 1,
Jean Delvare787c72b2007-05-08 17:22:00 +02001356 data->addr + W83781D_ADDR_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357 res =
Jean Delvare787c72b2007-05-08 17:22:00 +02001358 (res << 8) + inb_p(data->addr +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359 W83781D_DATA_REG_OFFSET);
1360 }
1361 if (reg & 0xff00) {
1362 outb_p(W83781D_REG_BANK,
Jean Delvare787c72b2007-05-08 17:22:00 +02001363 data->addr + W83781D_ADDR_REG_OFFSET);
1364 outb_p(0, data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001365 }
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001366 mutex_unlock(&data->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367 return res;
1368}
1369
Jean Delvare787c72b2007-05-08 17:22:00 +02001370static int __devinit w83627thf_read_gpio5(struct platform_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001371{
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))) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001379 dev_dbg(&pdev->dev, "GPIO5 disabled, no VID function\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001380 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) */
Yuan Mudd149c52005-11-26 20:13:18 +01001385 sel = superio_inb(W83627THF_GPIO5_IOSR) & 0x3f;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001386 if ((sel & 0x1f) != 0x1f) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001387 dev_dbg(&pdev->dev, "GPIO5 not configured for VID "
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388 "function\n");
1389 goto exit;
1390 }
1391
Jean Delvare787c72b2007-05-08 17:22:00 +02001392 dev_info(&pdev->dev, "Reading VID from GPIO5\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001393 res = superio_inb(W83627THF_GPIO5_DR) & sel;
1394
1395exit:
1396 superio_exit();
1397 return res;
1398}
1399
Jean Delvare787c72b2007-05-08 17:22:00 +02001400static int __devinit w83687thf_read_vid(struct platform_device *pdev)
Jean Delvarec2db6ce2006-01-18 23:22:12 +01001401{
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))) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001409 dev_dbg(&pdev->dev, "VID disabled, no VID function\n");
Jean Delvarec2db6ce2006-01-18 23:22:12 +01001410 goto exit;
1411 }
1412
1413 /* Make sure the pins are configured for input */
1414 if (!(superio_inb(W83687THF_VID_CFG) & (1 << 4))) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001415 dev_dbg(&pdev->dev, "VID configured as output, "
Jean Delvarec2db6ce2006-01-18 23:22:12 +01001416 "no VID function\n");
1417 goto exit;
1418 }
1419
1420 res = superio_inb(W83687THF_VID_DATA) & 0x3f;
1421
1422exit:
1423 superio_exit();
1424 return res;
1425}
1426
Jean Delvare787c72b2007-05-08 17:22:00 +02001427static int w83627hf_write_value(struct w83627hf_data *data, u16 reg, u16 value)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001428{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001429 int word_sized;
1430
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001431 mutex_lock(&data->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001432 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,
Jean Delvare787c72b2007-05-08 17:22:00 +02001438 data->addr + W83781D_ADDR_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439 outb_p(reg >> 8,
Jean Delvare787c72b2007-05-08 17:22:00 +02001440 data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001441 }
Jean Delvare787c72b2007-05-08 17:22:00 +02001442 outb_p(reg & 0xff, data->addr + W83781D_ADDR_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001443 if (word_sized) {
1444 outb_p(value >> 8,
Jean Delvare787c72b2007-05-08 17:22:00 +02001445 data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446 outb_p((reg & 0xff) + 1,
Jean Delvare787c72b2007-05-08 17:22:00 +02001447 data->addr + W83781D_ADDR_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001448 }
1449 outb_p(value & 0xff,
Jean Delvare787c72b2007-05-08 17:22:00 +02001450 data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001451 if (reg & 0xff00) {
1452 outb_p(W83781D_REG_BANK,
Jean Delvare787c72b2007-05-08 17:22:00 +02001453 data->addr + W83781D_ADDR_REG_OFFSET);
1454 outb_p(0, data->addr + W83781D_DATA_REG_OFFSET);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001455 }
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001456 mutex_unlock(&data->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001457 return 0;
1458}
1459
Jean Delvare787c72b2007-05-08 17:22:00 +02001460static void __devinit w83627hf_init_device(struct platform_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461{
Jean Delvare787c72b2007-05-08 17:22:00 +02001462 struct w83627hf_data *data = platform_get_drvdata(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001463 int i;
Jean Delvared27c37c2007-05-08 17:21:59 +02001464 enum chips type = data->type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001465 u8 tmp;
1466
Jean Delvare2251cf12005-09-04 22:52:17 +02001467 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. */
Jean Delvare787c72b2007-05-08 17:22:00 +02001473 dev_info(&pdev->dev, "If reset=1 solved a problem you were "
Jean Delvare2251cf12005-09-04 22:52:17 +02001474 "having, please report!\n");
1475
Linus Torvalds1da177e2005-04-16 15:20:36 -07001476 /* save this register */
Jean Delvare787c72b2007-05-08 17:22:00 +02001477 i = w83627hf_read_value(data, W83781D_REG_BEEP_CONFIG);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001478 /* Reset all except Watchdog values and last conversion values
1479 This sets fan-divs to 2, among others */
Jean Delvare787c72b2007-05-08 17:22:00 +02001480 w83627hf_write_value(data, W83781D_REG_CONFIG, 0x80);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001481 /* Restore the register and disable power-on abnormal beep.
1482 This saves FAN 1/2/3 input/output values set by BIOS. */
Jean Delvare787c72b2007-05-08 17:22:00 +02001483 w83627hf_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001484 /* 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 */
Jean Delvare787c72b2007-05-08 17:22:00 +02001487 w83627hf_write_value(data, W83781D_REG_BEEP_INTS2, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488 }
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 */
Jean Delvare787c72b2007-05-08 17:22:00 +02001493 w83627hf_write_value(data, W83781D_REG_I2C_SUBADDR, 0x89);
1494 w83627hf_write_value(data, W83781D_REG_I2C_ADDR, force_i2c);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001495
1496 /* Read VID only once */
Jean Delvared27c37c2007-05-08 17:21:59 +02001497 if (type == w83627hf || type == w83637hf) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001498 int lo = w83627hf_read_value(data, W83781D_REG_VID_FANDIV);
1499 int hi = w83627hf_read_value(data, W83781D_REG_CHIPID);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500 data->vid = (lo & 0x0f) | ((hi & 0x01) << 4);
Jean Delvared27c37c2007-05-08 17:21:59 +02001501 } else if (type == w83627thf) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001502 data->vid = w83627thf_read_gpio5(pdev);
Jean Delvared27c37c2007-05-08 17:21:59 +02001503 } else if (type == w83687thf) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001504 data->vid = w83687thf_read_vid(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001505 }
1506
1507 /* Read VRM & OVT Config only once */
Jean Delvared27c37c2007-05-08 17:21:59 +02001508 if (type == w83627thf || type == w83637hf || type == w83687thf) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001509 data->vrm_ovt =
Jean Delvare787c72b2007-05-08 17:22:00 +02001510 w83627hf_read_value(data, W83627THF_REG_VRM_OVT_CFG);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 }
1512
Jean Delvare787c72b2007-05-08 17:22:00 +02001513 tmp = w83627hf_read_value(data, W83781D_REG_SCFG1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 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
Jean Delvare787c72b2007-05-08 17:22:00 +02001519 (data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520 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 */
Jean Delvare787c72b2007-05-08 17:22:00 +02001531 tmp = w83627hf_read_value(data, W83781D_REG_TEMP2_CONFIG);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532 if (tmp & 0x01) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001533 dev_warn(&pdev->dev, "Enabling temp2, readings "
Linus Torvalds1da177e2005-04-16 15:20:36 -07001534 "might not make sense\n");
Jean Delvare787c72b2007-05-08 17:22:00 +02001535 w83627hf_write_value(data, W83781D_REG_TEMP2_CONFIG,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536 tmp & 0xfe);
1537 }
1538
1539 /* Enable temp3 */
1540 if (type != w83697hf) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001541 tmp = w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542 W83781D_REG_TEMP3_CONFIG);
1543 if (tmp & 0x01) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001544 dev_warn(&pdev->dev, "Enabling temp3, "
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545 "readings might not make sense\n");
Jean Delvare787c72b2007-05-08 17:22:00 +02001546 w83627hf_write_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547 W83781D_REG_TEMP3_CONFIG, tmp & 0xfe);
1548 }
1549 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001550 }
1551
1552 /* Start monitoring */
Jean Delvare787c72b2007-05-08 17:22:00 +02001553 w83627hf_write_value(data, W83781D_REG_CONFIG,
1554 (w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001555 W83781D_REG_CONFIG) & 0xf7)
1556 | 0x01);
1557}
1558
1559static struct w83627hf_data *w83627hf_update_device(struct device *dev)
1560{
Jean Delvare787c72b2007-05-08 17:22:00 +02001561 struct w83627hf_data *data = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001562 int i;
1563
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001564 mutex_lock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001565
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)) ||
Jean Delvarec2db6ce2006-01-18 23:22:12 +01001571 ((data->type != w83627hf && data->type != w83697hf)
Yuan Mu4a1c44472005-11-07 22:19:04 +01001572 && (i == 5 || i == 6)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001573 continue;
1574 data->in[i] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001575 w83627hf_read_value(data, W83781D_REG_IN(i));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576 data->in_min[i] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001577 w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578 W83781D_REG_IN_MIN(i));
1579 data->in_max[i] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001580 w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001581 W83781D_REG_IN_MAX(i));
1582 }
1583 for (i = 1; i <= 3; i++) {
1584 data->fan[i - 1] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001585 w83627hf_read_value(data, W83781D_REG_FAN(i));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586 data->fan_min[i - 1] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001587 w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001588 W83781D_REG_FAN_MIN(i));
1589 }
1590 for (i = 1; i <= 3; i++) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001591 u8 tmp = w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001592 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 }
Carlos Olalla Martinez1550cb62007-06-09 10:11:16 -04001601 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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615
Jean Delvare787c72b2007-05-08 17:22:00 +02001616 data->temp = w83627hf_read_value(data, W83781D_REG_TEMP(1));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617 data->temp_max =
Jean Delvare787c72b2007-05-08 17:22:00 +02001618 w83627hf_read_value(data, W83781D_REG_TEMP_OVER(1));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001619 data->temp_max_hyst =
Jean Delvare787c72b2007-05-08 17:22:00 +02001620 w83627hf_read_value(data, W83781D_REG_TEMP_HYST(1));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621 data->temp_add[0] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001622 w83627hf_read_value(data, W83781D_REG_TEMP(2));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001623 data->temp_max_add[0] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001624 w83627hf_read_value(data, W83781D_REG_TEMP_OVER(2));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001625 data->temp_max_hyst_add[0] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001626 w83627hf_read_value(data, W83781D_REG_TEMP_HYST(2));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627 if (data->type != w83697hf) {
1628 data->temp_add[1] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001629 w83627hf_read_value(data, W83781D_REG_TEMP(3));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001630 data->temp_max_add[1] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001631 w83627hf_read_value(data, W83781D_REG_TEMP_OVER(3));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632 data->temp_max_hyst_add[1] =
Jean Delvare787c72b2007-05-08 17:22:00 +02001633 w83627hf_read_value(data, W83781D_REG_TEMP_HYST(3));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001634 }
1635
Jean Delvare787c72b2007-05-08 17:22:00 +02001636 i = w83627hf_read_value(data, W83781D_REG_VID_FANDIV);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637 data->fan_div[0] = (i >> 4) & 0x03;
1638 data->fan_div[1] = (i >> 6) & 0x03;
1639 if (data->type != w83697hf) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001640 data->fan_div[2] = (w83627hf_read_value(data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641 W83781D_REG_PIN) >> 6) & 0x03;
1642 }
Jean Delvare787c72b2007-05-08 17:22:00 +02001643 i = w83627hf_read_value(data, W83781D_REG_VBAT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644 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 =
Jean Delvare787c72b2007-05-08 17:22:00 +02001649 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001653 data->beep_enable = i >> 7;
1654 data->beep_mask = ((i & 0x7f) << 8) |
Jean Delvare787c72b2007-05-08 17:22:00 +02001655 w83627hf_read_value(data, W83781D_REG_BEEP_INTS1) |
1656 w83627hf_read_value(data, W83781D_REG_BEEP_INTS3) << 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001657 data->last_updated = jiffies;
1658 data->valid = 1;
1659 }
1660
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001661 mutex_unlock(&data->update_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001662
1663 return data;
1664}
1665
Jean Delvare787c72b2007-05-08 17:22:00 +02001666static int __init w83627hf_device_add(unsigned short address,
1667 const struct w83627hf_sio_data *sio_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001668{
Jean Delvare787c72b2007-05-08 17:22:00 +02001669 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001682 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001683
Jean Delvare787c72b2007-05-08 17:22:00 +02001684 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
Jean Delvare2df6d812007-06-09 10:11:16 -04001691 err = platform_device_add_data(pdev, sio_data,
1692 sizeof(struct w83627hf_sio_data));
1693 if (err) {
Jean Delvare787c72b2007-05-08 17:22:00 +02001694 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1695 goto exit_device_put;
1696 }
Jean Delvare787c72b2007-05-08 17:22:00 +02001697
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
1707exit_device_put:
1708 platform_device_put(pdev);
1709exit:
1710 return err;
1711}
1712
1713static 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
1734exit_driver:
1735 platform_driver_unregister(&w83627hf_driver);
1736exit:
1737 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001738}
1739
1740static void __exit sensors_w83627hf_exit(void)
1741{
Jean Delvare787c72b2007-05-08 17:22:00 +02001742 platform_device_unregister(pdev);
1743 platform_driver_unregister(&w83627hf_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001744}
1745
1746MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
1747 "Philip Edelbrock <phil@netroedge.com>, "
1748 "and Mark Studebaker <mdsxyz123@yahoo.com>");
1749MODULE_DESCRIPTION("W83627HF driver");
1750MODULE_LICENSE("GPL");
1751
1752module_init(sensors_w83627hf_init);
1753module_exit(sensors_w83627hf_exit);