blob: bca7fbcfbeced0210040214e7a86b4b7a46cc1c4 [file] [log] [blame]
Jean Delvare08e7e272005-04-25 22:43:25 +02001/*
2 w83627ehf - Driver for the hardware monitoring functionality of
3 the Winbond W83627EHF Super-I/O chip
4 Copyright (C) 2005 Jean Delvare <khali@linux-fr.org>
Jean Delvare3379cee2006-09-24 21:25:52 +02005 Copyright (C) 2006 Yuan Mu (Winbond),
Jean Delvare7188cc62006-12-12 18:18:30 +01006 Rudolf Marek <r.marek@assembler.cz>
David Hubbardc18beb52006-09-24 21:04:38 +02007 David Hubbard <david.c.hubbard@gmail.com>
Jean Delvare08e7e272005-04-25 22:43:25 +02008
9 Shamelessly ripped from the w83627hf driver
10 Copyright (C) 2003 Mark Studebaker
11
12 Thanks to Leon Moonen, Steve Cliffe and Grant Coady for their help
13 in testing and debugging this driver.
14
Jean Delvare8dd2d2c2005-07-27 21:33:15 +020015 This driver also supports the W83627EHG, which is the lead-free
16 version of the W83627EHF.
17
Jean Delvare08e7e272005-04-25 22:43:25 +020018 This program is free software; you can redistribute it and/or modify
19 it under the terms of the GNU General Public License as published by
20 the Free Software Foundation; either version 2 of the License, or
21 (at your option) any later version.
22
23 This program is distributed in the hope that it will be useful,
24 but WITHOUT ANY WARRANTY; without even the implied warranty of
25 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
26 GNU General Public License for more details.
27
28 You should have received a copy of the GNU General Public License
29 along with this program; if not, write to the Free Software
30 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
31
32
33 Supports the following chips:
34
David Hubbard657c93b2007-02-14 21:15:04 +010035 Chip #vin #fan #pwm #temp chip IDs man ID
36 w83627ehf 10 5 4 3 0x8850 0x88 0x5ca3
37 0x8860 0xa1
38 w83627dhg 9 5 4 3 0xa020 0xc1 0x5ca3
Jean Delvare08e7e272005-04-25 22:43:25 +020039*/
40
41#include <linux/module.h>
42#include <linux/init.h>
43#include <linux/slab.h>
David Hubbard1ea6dd32007-06-24 11:16:15 +020044#include <linux/jiffies.h>
45#include <linux/platform_device.h>
Mark M. Hoffman943b0832005-07-15 21:39:18 -040046#include <linux/hwmon.h>
Yuan Mu412fec82006-02-05 23:24:16 +010047#include <linux/hwmon-sysfs.h>
Jean Delvarefc18d6c2007-06-24 11:19:42 +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 Delvare08e7e272005-04-25 22:43:25 +020051#include <asm/io.h>
52#include "lm75.h"
53
David Hubbard1ea6dd32007-06-24 11:16:15 +020054enum kinds { w83627ehf, w83627dhg };
55
56/* used to set data->name = w83627ehf_device_names[data->sio_kind] */
57static const char * w83627ehf_device_names[] = {
58 "w83627ehf",
59 "w83627dhg",
60};
61
62#define DRVNAME "w83627ehf"
Jean Delvare08e7e272005-04-25 22:43:25 +020063
64/*
65 * Super-I/O constants and functions
66 */
67
Jean Delvare08e7e272005-04-25 22:43:25 +020068#define W83627EHF_LD_HWM 0x0b
69
70#define SIO_REG_LDSEL 0x07 /* Logical device select */
71#define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */
Jean Delvarefc18d6c2007-06-24 11:19:42 +020072#define SIO_REG_EN_VRM10 0x2C /* GPIO3, GPIO4 selection */
Jean Delvare08e7e272005-04-25 22:43:25 +020073#define SIO_REG_ENABLE 0x30 /* Logical device enable */
74#define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
Jean Delvarefc18d6c2007-06-24 11:19:42 +020075#define SIO_REG_VID_CTRL 0xF0 /* VID control */
76#define SIO_REG_VID_DATA 0xF1 /* VID data */
Jean Delvare08e7e272005-04-25 22:43:25 +020077
David Hubbard657c93b2007-02-14 21:15:04 +010078#define SIO_W83627EHF_ID 0x8850
79#define SIO_W83627EHG_ID 0x8860
80#define SIO_W83627DHG_ID 0xa020
81#define SIO_ID_MASK 0xFFF0
Jean Delvare08e7e272005-04-25 22:43:25 +020082
83static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +020084superio_outb(int ioreg, int reg, int val)
Jean Delvare08e7e272005-04-25 22:43:25 +020085{
David Hubbard1ea6dd32007-06-24 11:16:15 +020086 outb(reg, ioreg);
87 outb(val, ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +020088}
89
90static inline int
David Hubbard1ea6dd32007-06-24 11:16:15 +020091superio_inb(int ioreg, int reg)
Jean Delvare08e7e272005-04-25 22:43:25 +020092{
David Hubbard1ea6dd32007-06-24 11:16:15 +020093 outb(reg, ioreg);
94 return inb(ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +020095}
96
97static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +020098superio_select(int ioreg, int ld)
Jean Delvare08e7e272005-04-25 22:43:25 +020099{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200100 outb(SIO_REG_LDSEL, ioreg);
101 outb(ld, ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +0200102}
103
104static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +0200105superio_enter(int ioreg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200106{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200107 outb(0x87, ioreg);
108 outb(0x87, ioreg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200109}
110
111static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +0200112superio_exit(int ioreg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200113{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200114 outb(0x02, ioreg);
115 outb(0x02, ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +0200116}
117
118/*
119 * ISA constants
120 */
121
Jean Delvare1a641fc2007-04-23 14:41:16 -0700122#define IOREGION_ALIGNMENT ~7
123#define IOREGION_OFFSET 5
124#define IOREGION_LENGTH 2
David Hubbard1ea6dd32007-06-24 11:16:15 +0200125#define ADDR_REG_OFFSET 0
126#define DATA_REG_OFFSET 1
Jean Delvare08e7e272005-04-25 22:43:25 +0200127
128#define W83627EHF_REG_BANK 0x4E
129#define W83627EHF_REG_CONFIG 0x40
David Hubbard657c93b2007-02-14 21:15:04 +0100130
131/* Not currently used:
132 * REG_MAN_ID has the value 0x5ca3 for all supported chips.
133 * REG_CHIP_ID == 0x88/0xa1/0xc1 depending on chip model.
134 * REG_MAN_ID is at port 0x4f
135 * REG_CHIP_ID is at port 0x58 */
Jean Delvare08e7e272005-04-25 22:43:25 +0200136
137static const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 };
138static const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c };
139
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100140/* The W83627EHF registers for nr=7,8,9 are in bank 5 */
141#define W83627EHF_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
142 (0x554 + (((nr) - 7) * 2)))
143#define W83627EHF_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
144 (0x555 + (((nr) - 7) * 2)))
145#define W83627EHF_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \
146 (0x550 + (nr) - 7))
147
Jean Delvare08e7e272005-04-25 22:43:25 +0200148#define W83627EHF_REG_TEMP1 0x27
149#define W83627EHF_REG_TEMP1_HYST 0x3a
150#define W83627EHF_REG_TEMP1_OVER 0x39
151static const u16 W83627EHF_REG_TEMP[] = { 0x150, 0x250 };
152static const u16 W83627EHF_REG_TEMP_HYST[] = { 0x153, 0x253 };
153static const u16 W83627EHF_REG_TEMP_OVER[] = { 0x155, 0x255 };
154static const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0x152, 0x252 };
155
156/* Fan clock dividers are spread over the following five registers */
157#define W83627EHF_REG_FANDIV1 0x47
158#define W83627EHF_REG_FANDIV2 0x4B
159#define W83627EHF_REG_VBAT 0x5D
160#define W83627EHF_REG_DIODE 0x59
161#define W83627EHF_REG_SMI_OVT 0x4C
162
Jean Delvarea4589db2006-03-23 16:30:29 +0100163#define W83627EHF_REG_ALARM1 0x459
164#define W83627EHF_REG_ALARM2 0x45A
165#define W83627EHF_REG_ALARM3 0x45B
166
Rudolf Marek08c79952006-07-05 18:14:31 +0200167/* SmartFan registers */
168/* DC or PWM output fan configuration */
169static const u8 W83627EHF_REG_PWM_ENABLE[] = {
170 0x04, /* SYS FAN0 output mode and PWM mode */
171 0x04, /* CPU FAN0 output mode and PWM mode */
172 0x12, /* AUX FAN mode */
173 0x62, /* CPU fan1 mode */
174};
175
176static const u8 W83627EHF_PWM_MODE_SHIFT[] = { 0, 1, 0, 6 };
177static const u8 W83627EHF_PWM_ENABLE_SHIFT[] = { 2, 4, 1, 4 };
178
179/* FAN Duty Cycle, be used to control */
180static const u8 W83627EHF_REG_PWM[] = { 0x01, 0x03, 0x11, 0x61 };
181static const u8 W83627EHF_REG_TARGET[] = { 0x05, 0x06, 0x13, 0x63 };
182static const u8 W83627EHF_REG_TOLERANCE[] = { 0x07, 0x07, 0x14, 0x62 };
183
184
185/* Advanced Fan control, some values are common for all fans */
186static const u8 W83627EHF_REG_FAN_MIN_OUTPUT[] = { 0x08, 0x09, 0x15, 0x64 };
187static const u8 W83627EHF_REG_FAN_STOP_TIME[] = { 0x0C, 0x0D, 0x17, 0x66 };
188
Jean Delvare08e7e272005-04-25 22:43:25 +0200189/*
190 * Conversions
191 */
192
Rudolf Marek08c79952006-07-05 18:14:31 +0200193/* 1 is PWM mode, output in ms */
194static inline unsigned int step_time_from_reg(u8 reg, u8 mode)
195{
196 return mode ? 100 * reg : 400 * reg;
197}
198
199static inline u8 step_time_to_reg(unsigned int msec, u8 mode)
200{
201 return SENSORS_LIMIT((mode ? (msec + 50) / 100 :
202 (msec + 200) / 400), 1, 255);
203}
204
Jean Delvare08e7e272005-04-25 22:43:25 +0200205static inline unsigned int
206fan_from_reg(u8 reg, unsigned int div)
207{
208 if (reg == 0 || reg == 255)
209 return 0;
210 return 1350000U / (reg * div);
211}
212
213static inline unsigned int
214div_from_reg(u8 reg)
215{
216 return 1 << reg;
217}
218
219static inline int
220temp1_from_reg(s8 reg)
221{
222 return reg * 1000;
223}
224
225static inline s8
Rudolf Marek08c79952006-07-05 18:14:31 +0200226temp1_to_reg(int temp, int min, int max)
Jean Delvare08e7e272005-04-25 22:43:25 +0200227{
Rudolf Marek08c79952006-07-05 18:14:31 +0200228 if (temp <= min)
229 return min / 1000;
230 if (temp >= max)
231 return max / 1000;
Jean Delvare08e7e272005-04-25 22:43:25 +0200232 if (temp < 0)
233 return (temp - 500) / 1000;
234 return (temp + 500) / 1000;
235}
236
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100237/* Some of analog inputs have internal scaling (2x), 8mV is ADC LSB */
238
239static u8 scale_in[10] = { 8, 8, 16, 16, 8, 8, 8, 16, 16, 8 };
240
241static inline long in_from_reg(u8 reg, u8 nr)
242{
243 return reg * scale_in[nr];
244}
245
246static inline u8 in_to_reg(u32 val, u8 nr)
247{
248 return SENSORS_LIMIT(((val + (scale_in[nr] / 2)) / scale_in[nr]), 0, 255);
249}
250
Jean Delvare08e7e272005-04-25 22:43:25 +0200251/*
252 * Data structures and manipulation thereof
253 */
254
255struct w83627ehf_data {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200256 int addr; /* IO base of hw monitor block */
257 const char *name;
258
Mark M. Hoffman943b0832005-07-15 21:39:18 -0400259 struct class_device *class_dev;
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100260 struct mutex lock;
Jean Delvare08e7e272005-04-25 22:43:25 +0200261
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100262 struct mutex update_lock;
Jean Delvare08e7e272005-04-25 22:43:25 +0200263 char valid; /* !=0 if following fields are valid */
264 unsigned long last_updated; /* In jiffies */
265
266 /* Register values */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200267 u8 in_num; /* number of in inputs we have */
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100268 u8 in[10]; /* Register value */
269 u8 in_max[10]; /* Register value */
270 u8 in_min[10]; /* Register value */
Jean Delvare08e7e272005-04-25 22:43:25 +0200271 u8 fan[5];
272 u8 fan_min[5];
273 u8 fan_div[5];
274 u8 has_fan; /* some fan inputs can be disabled */
Jean Delvareda667362007-06-24 11:21:02 +0200275 u8 temp_type[3];
Jean Delvare08e7e272005-04-25 22:43:25 +0200276 s8 temp1;
277 s8 temp1_max;
278 s8 temp1_max_hyst;
279 s16 temp[2];
280 s16 temp_max[2];
281 s16 temp_max_hyst[2];
Jean Delvarea4589db2006-03-23 16:30:29 +0100282 u32 alarms;
Rudolf Marek08c79952006-07-05 18:14:31 +0200283
284 u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */
285 u8 pwm_enable[4]; /* 1->manual
286 2->thermal cruise (also called SmartFan I) */
287 u8 pwm[4];
288 u8 target_temp[4];
289 u8 tolerance[4];
290
291 u8 fan_min_output[4]; /* minimum fan speed */
292 u8 fan_stop_time[4];
Jean Delvarefc18d6c2007-06-24 11:19:42 +0200293
294 u8 vid;
295 u8 vrm;
Jean Delvare08e7e272005-04-25 22:43:25 +0200296};
297
David Hubbard1ea6dd32007-06-24 11:16:15 +0200298struct w83627ehf_sio_data {
299 int sioreg;
300 enum kinds kind;
301};
302
Jean Delvare08e7e272005-04-25 22:43:25 +0200303static inline int is_word_sized(u16 reg)
304{
305 return (((reg & 0xff00) == 0x100
306 || (reg & 0xff00) == 0x200)
307 && ((reg & 0x00ff) == 0x50
308 || (reg & 0x00ff) == 0x53
309 || (reg & 0x00ff) == 0x55));
310}
311
312/* We assume that the default bank is 0, thus the following two functions do
313 nothing for registers which live in bank 0. For others, they respectively
314 set the bank register to the correct value (before the register is
315 accessed), and back to 0 (afterwards). */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200316static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200317{
318 if (reg & 0xff00) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200319 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
320 outb_p(reg >> 8, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200321 }
322}
323
David Hubbard1ea6dd32007-06-24 11:16:15 +0200324static inline void w83627ehf_reset_bank(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200325{
326 if (reg & 0xff00) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200327 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
328 outb_p(0, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200329 }
330}
331
David Hubbard1ea6dd32007-06-24 11:16:15 +0200332static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200333{
Jean Delvare08e7e272005-04-25 22:43:25 +0200334 int res, word_sized = is_word_sized(reg);
335
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100336 mutex_lock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200337
David Hubbard1ea6dd32007-06-24 11:16:15 +0200338 w83627ehf_set_bank(data, reg);
339 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
340 res = inb_p(data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200341 if (word_sized) {
342 outb_p((reg & 0xff) + 1,
David Hubbard1ea6dd32007-06-24 11:16:15 +0200343 data->addr + ADDR_REG_OFFSET);
344 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200345 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200346 w83627ehf_reset_bank(data, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200347
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100348 mutex_unlock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200349
350 return res;
351}
352
David Hubbard1ea6dd32007-06-24 11:16:15 +0200353static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg, u16 value)
Jean Delvare08e7e272005-04-25 22:43:25 +0200354{
Jean Delvare08e7e272005-04-25 22:43:25 +0200355 int word_sized = is_word_sized(reg);
356
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100357 mutex_lock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200358
David Hubbard1ea6dd32007-06-24 11:16:15 +0200359 w83627ehf_set_bank(data, reg);
360 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200361 if (word_sized) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200362 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200363 outb_p((reg & 0xff) + 1,
David Hubbard1ea6dd32007-06-24 11:16:15 +0200364 data->addr + ADDR_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200365 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200366 outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
367 w83627ehf_reset_bank(data, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200368
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100369 mutex_unlock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200370 return 0;
371}
372
373/* This function assumes that the caller holds data->update_lock */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200374static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr)
Jean Delvare08e7e272005-04-25 22:43:25 +0200375{
Jean Delvare08e7e272005-04-25 22:43:25 +0200376 u8 reg;
377
378 switch (nr) {
379 case 0:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200380 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200381 | ((data->fan_div[0] & 0x03) << 4);
Rudolf Marek14992c72006-10-08 22:02:09 +0200382 /* fan5 input control bit is write only, compute the value */
383 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200384 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
385 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200386 | ((data->fan_div[0] & 0x04) << 3);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200387 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200388 break;
389 case 1:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200390 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200391 | ((data->fan_div[1] & 0x03) << 6);
Rudolf Marek14992c72006-10-08 22:02:09 +0200392 /* fan5 input control bit is write only, compute the value */
393 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200394 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
395 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200396 | ((data->fan_div[1] & 0x04) << 4);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200397 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200398 break;
399 case 2:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200400 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200401 | ((data->fan_div[2] & 0x03) << 6);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200402 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg);
403 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200404 | ((data->fan_div[2] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200405 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200406 break;
407 case 3:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200408 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc)
Jean Delvare08e7e272005-04-25 22:43:25 +0200409 | (data->fan_div[3] & 0x03);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200410 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
411 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200412 | ((data->fan_div[3] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200413 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200414 break;
415 case 4:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200416 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73)
Jean Delvare33725ad2007-04-17 00:32:27 -0700417 | ((data->fan_div[4] & 0x03) << 2)
Jean Delvare08e7e272005-04-25 22:43:25 +0200418 | ((data->fan_div[4] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200419 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200420 break;
421 }
422}
423
Mark M. Hoffmanea7be662007-08-05 12:19:01 -0400424static void w83627ehf_update_fan_div(struct w83627ehf_data *data)
425{
426 int i;
427
428 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
429 data->fan_div[0] = (i >> 4) & 0x03;
430 data->fan_div[1] = (i >> 6) & 0x03;
431 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2);
432 data->fan_div[2] = (i >> 6) & 0x03;
433 i = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
434 data->fan_div[0] |= (i >> 3) & 0x04;
435 data->fan_div[1] |= (i >> 4) & 0x04;
436 data->fan_div[2] |= (i >> 5) & 0x04;
437 if (data->has_fan & ((1 << 3) | (1 << 4))) {
438 i = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
439 data->fan_div[3] = i & 0x03;
440 data->fan_div[4] = ((i >> 2) & 0x03)
441 | ((i >> 5) & 0x04);
442 }
443 if (data->has_fan & (1 << 3)) {
444 i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT);
445 data->fan_div[3] |= (i >> 5) & 0x04;
446 }
447}
448
Jean Delvare08e7e272005-04-25 22:43:25 +0200449static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
450{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200451 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200452 int pwmcfg = 0, tolerance = 0; /* shut up the compiler */
Jean Delvare08e7e272005-04-25 22:43:25 +0200453 int i;
454
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100455 mutex_lock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200456
Jean Delvare6b3e4642007-06-24 11:19:01 +0200457 if (time_after(jiffies, data->last_updated + HZ + HZ/2)
Jean Delvare08e7e272005-04-25 22:43:25 +0200458 || !data->valid) {
459 /* Fan clock dividers */
Mark M. Hoffmanea7be662007-08-05 12:19:01 -0400460 w83627ehf_update_fan_div(data);
Jean Delvare08e7e272005-04-25 22:43:25 +0200461
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100462 /* Measured voltages and limits */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200463 for (i = 0; i < data->in_num; i++) {
464 data->in[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100465 W83627EHF_REG_IN(i));
David Hubbard1ea6dd32007-06-24 11:16:15 +0200466 data->in_min[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100467 W83627EHF_REG_IN_MIN(i));
David Hubbard1ea6dd32007-06-24 11:16:15 +0200468 data->in_max[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100469 W83627EHF_REG_IN_MAX(i));
470 }
471
Jean Delvare08e7e272005-04-25 22:43:25 +0200472 /* Measured fan speeds and limits */
473 for (i = 0; i < 5; i++) {
474 if (!(data->has_fan & (1 << i)))
475 continue;
476
David Hubbard1ea6dd32007-06-24 11:16:15 +0200477 data->fan[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200478 W83627EHF_REG_FAN[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200479 data->fan_min[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200480 W83627EHF_REG_FAN_MIN[i]);
481
482 /* If we failed to measure the fan speed and clock
483 divider can be increased, let's try that for next
484 time */
485 if (data->fan[i] == 0xff
486 && data->fan_div[i] < 0x07) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200487 dev_dbg(dev, "Increasing fan%d "
Jean Delvare08e7e272005-04-25 22:43:25 +0200488 "clock divider from %u to %u\n",
Jean Delvare33725ad2007-04-17 00:32:27 -0700489 i + 1, div_from_reg(data->fan_div[i]),
Jean Delvare08e7e272005-04-25 22:43:25 +0200490 div_from_reg(data->fan_div[i] + 1));
491 data->fan_div[i]++;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200492 w83627ehf_write_fan_div(data, i);
Jean Delvare08e7e272005-04-25 22:43:25 +0200493 /* Preserve min limit if possible */
494 if (data->fan_min[i] >= 2
495 && data->fan_min[i] != 255)
David Hubbard1ea6dd32007-06-24 11:16:15 +0200496 w83627ehf_write_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200497 W83627EHF_REG_FAN_MIN[i],
498 (data->fan_min[i] /= 2));
499 }
500 }
501
Rudolf Marek08c79952006-07-05 18:14:31 +0200502 for (i = 0; i < 4; i++) {
503 /* pwmcfg, tolarance mapped for i=0, i=1 to same reg */
504 if (i != 1) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200505 pwmcfg = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200506 W83627EHF_REG_PWM_ENABLE[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200507 tolerance = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200508 W83627EHF_REG_TOLERANCE[i]);
509 }
510 data->pwm_mode[i] =
511 ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1)
512 ? 0 : 1;
513 data->pwm_enable[i] =
514 ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i])
515 & 3) + 1;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200516 data->pwm[i] = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200517 W83627EHF_REG_PWM[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200518 data->fan_min_output[i] = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200519 W83627EHF_REG_FAN_MIN_OUTPUT[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200520 data->fan_stop_time[i] = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200521 W83627EHF_REG_FAN_STOP_TIME[i]);
522 data->target_temp[i] =
David Hubbard1ea6dd32007-06-24 11:16:15 +0200523 w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200524 W83627EHF_REG_TARGET[i]) &
525 (data->pwm_mode[i] == 1 ? 0x7f : 0xff);
526 data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0))
527 & 0x0f;
528 }
529
Jean Delvare08e7e272005-04-25 22:43:25 +0200530 /* Measured temperatures and limits */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200531 data->temp1 = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200532 W83627EHF_REG_TEMP1);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200533 data->temp1_max = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200534 W83627EHF_REG_TEMP1_OVER);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200535 data->temp1_max_hyst = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200536 W83627EHF_REG_TEMP1_HYST);
537 for (i = 0; i < 2; i++) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200538 data->temp[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200539 W83627EHF_REG_TEMP[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200540 data->temp_max[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200541 W83627EHF_REG_TEMP_OVER[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200542 data->temp_max_hyst[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200543 W83627EHF_REG_TEMP_HYST[i]);
544 }
545
David Hubbard1ea6dd32007-06-24 11:16:15 +0200546 data->alarms = w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100547 W83627EHF_REG_ALARM1) |
David Hubbard1ea6dd32007-06-24 11:16:15 +0200548 (w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100549 W83627EHF_REG_ALARM2) << 8) |
David Hubbard1ea6dd32007-06-24 11:16:15 +0200550 (w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100551 W83627EHF_REG_ALARM3) << 16);
552
Jean Delvare08e7e272005-04-25 22:43:25 +0200553 data->last_updated = jiffies;
554 data->valid = 1;
555 }
556
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100557 mutex_unlock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200558 return data;
559}
560
561/*
562 * Sysfs callback functions
563 */
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100564#define show_in_reg(reg) \
565static ssize_t \
566show_##reg(struct device *dev, struct device_attribute *attr, \
567 char *buf) \
568{ \
569 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
570 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
571 int nr = sensor_attr->index; \
572 return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr)); \
573}
574show_in_reg(in)
575show_in_reg(in_min)
576show_in_reg(in_max)
577
578#define store_in_reg(REG, reg) \
579static ssize_t \
580store_in_##reg (struct device *dev, struct device_attribute *attr, \
581 const char *buf, size_t count) \
582{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200583 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100584 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
585 int nr = sensor_attr->index; \
586 u32 val = simple_strtoul(buf, NULL, 10); \
587 \
588 mutex_lock(&data->update_lock); \
589 data->in_##reg[nr] = in_to_reg(val, nr); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200590 w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100591 data->in_##reg[nr]); \
592 mutex_unlock(&data->update_lock); \
593 return count; \
594}
595
596store_in_reg(MIN, min)
597store_in_reg(MAX, max)
598
Jean Delvarea4589db2006-03-23 16:30:29 +0100599static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, char *buf)
600{
601 struct w83627ehf_data *data = w83627ehf_update_device(dev);
602 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
603 int nr = sensor_attr->index;
604 return sprintf(buf, "%u\n", (data->alarms >> nr) & 0x01);
605}
606
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100607static struct sensor_device_attribute sda_in_input[] = {
608 SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
609 SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
610 SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
611 SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
612 SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
613 SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
614 SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
615 SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
616 SENSOR_ATTR(in8_input, S_IRUGO, show_in, NULL, 8),
617 SENSOR_ATTR(in9_input, S_IRUGO, show_in, NULL, 9),
618};
619
Jean Delvarea4589db2006-03-23 16:30:29 +0100620static struct sensor_device_attribute sda_in_alarm[] = {
621 SENSOR_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0),
622 SENSOR_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1),
623 SENSOR_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2),
624 SENSOR_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3),
625 SENSOR_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8),
626 SENSOR_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 21),
627 SENSOR_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 20),
628 SENSOR_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16),
629 SENSOR_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17),
630 SENSOR_ATTR(in9_alarm, S_IRUGO, show_alarm, NULL, 19),
631};
632
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100633static struct sensor_device_attribute sda_in_min[] = {
634 SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
635 SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
636 SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
637 SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 3),
638 SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 4),
639 SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 5),
640 SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 6),
641 SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 7),
642 SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 8),
643 SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 9),
644};
645
646static struct sensor_device_attribute sda_in_max[] = {
647 SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
648 SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
649 SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
650 SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 3),
651 SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 4),
652 SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 5),
653 SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 6),
654 SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 7),
655 SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 8),
656 SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 9),
657};
658
Jean Delvare08e7e272005-04-25 22:43:25 +0200659#define show_fan_reg(reg) \
660static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +0100661show_##reg(struct device *dev, struct device_attribute *attr, \
662 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200663{ \
664 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Yuan Mu412fec82006-02-05 23:24:16 +0100665 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
666 int nr = sensor_attr->index; \
Jean Delvare08e7e272005-04-25 22:43:25 +0200667 return sprintf(buf, "%d\n", \
668 fan_from_reg(data->reg[nr], \
669 div_from_reg(data->fan_div[nr]))); \
670}
671show_fan_reg(fan);
672show_fan_reg(fan_min);
673
674static ssize_t
Yuan Mu412fec82006-02-05 23:24:16 +0100675show_fan_div(struct device *dev, struct device_attribute *attr,
676 char *buf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200677{
678 struct w83627ehf_data *data = w83627ehf_update_device(dev);
Yuan Mu412fec82006-02-05 23:24:16 +0100679 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
680 int nr = sensor_attr->index;
681 return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
Jean Delvare08e7e272005-04-25 22:43:25 +0200682}
683
684static ssize_t
Yuan Mu412fec82006-02-05 23:24:16 +0100685store_fan_min(struct device *dev, struct device_attribute *attr,
686 const char *buf, size_t count)
Jean Delvare08e7e272005-04-25 22:43:25 +0200687{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200688 struct w83627ehf_data *data = dev_get_drvdata(dev);
Yuan Mu412fec82006-02-05 23:24:16 +0100689 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
690 int nr = sensor_attr->index;
Jean Delvare08e7e272005-04-25 22:43:25 +0200691 unsigned int val = simple_strtoul(buf, NULL, 10);
692 unsigned int reg;
693 u8 new_div;
694
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100695 mutex_lock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200696 if (!val) {
697 /* No min limit, alarm disabled */
698 data->fan_min[nr] = 255;
699 new_div = data->fan_div[nr]; /* No change */
700 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
701 } else if ((reg = 1350000U / val) >= 128 * 255) {
702 /* Speed below this value cannot possibly be represented,
703 even with the highest divider (128) */
704 data->fan_min[nr] = 254;
705 new_div = 7; /* 128 == (1 << 7) */
706 dev_warn(dev, "fan%u low limit %u below minimum %u, set to "
707 "minimum\n", nr + 1, val, fan_from_reg(254, 128));
708 } else if (!reg) {
709 /* Speed above this value cannot possibly be represented,
710 even with the lowest divider (1) */
711 data->fan_min[nr] = 1;
712 new_div = 0; /* 1 == (1 << 0) */
713 dev_warn(dev, "fan%u low limit %u above maximum %u, set to "
Jean Delvareb9110b12005-05-02 23:08:22 +0200714 "maximum\n", nr + 1, val, fan_from_reg(1, 1));
Jean Delvare08e7e272005-04-25 22:43:25 +0200715 } else {
716 /* Automatically pick the best divider, i.e. the one such
717 that the min limit will correspond to a register value
718 in the 96..192 range */
719 new_div = 0;
720 while (reg > 192 && new_div < 7) {
721 reg >>= 1;
722 new_div++;
723 }
724 data->fan_min[nr] = reg;
725 }
726
727 /* Write both the fan clock divider (if it changed) and the new
728 fan min (unconditionally) */
729 if (new_div != data->fan_div[nr]) {
Jean Delvare158ce072007-06-17 16:09:12 +0200730 /* Preserve the fan speed reading */
731 if (data->fan[nr] != 0xff) {
732 if (new_div > data->fan_div[nr])
733 data->fan[nr] >>= new_div - data->fan_div[nr];
734 else if (data->fan[nr] & 0x80)
735 data->fan[nr] = 0xff;
736 else
737 data->fan[nr] <<= data->fan_div[nr] - new_div;
738 }
Jean Delvare08e7e272005-04-25 22:43:25 +0200739
740 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
741 nr + 1, div_from_reg(data->fan_div[nr]),
742 div_from_reg(new_div));
743 data->fan_div[nr] = new_div;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200744 w83627ehf_write_fan_div(data, nr);
Jean Delvare6b3e4642007-06-24 11:19:01 +0200745 /* Give the chip time to sample a new speed value */
746 data->last_updated = jiffies;
Jean Delvare08e7e272005-04-25 22:43:25 +0200747 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200748 w83627ehf_write_value(data, W83627EHF_REG_FAN_MIN[nr],
Jean Delvare08e7e272005-04-25 22:43:25 +0200749 data->fan_min[nr]);
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100750 mutex_unlock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200751
752 return count;
753}
754
Yuan Mu412fec82006-02-05 23:24:16 +0100755static struct sensor_device_attribute sda_fan_input[] = {
756 SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
757 SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
758 SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
759 SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
760 SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
761};
Jean Delvare08e7e272005-04-25 22:43:25 +0200762
Jean Delvarea4589db2006-03-23 16:30:29 +0100763static struct sensor_device_attribute sda_fan_alarm[] = {
764 SENSOR_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6),
765 SENSOR_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7),
766 SENSOR_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11),
767 SENSOR_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 10),
768 SENSOR_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 23),
769};
770
Yuan Mu412fec82006-02-05 23:24:16 +0100771static struct sensor_device_attribute sda_fan_min[] = {
772 SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
773 store_fan_min, 0),
774 SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
775 store_fan_min, 1),
776 SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
777 store_fan_min, 2),
778 SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
779 store_fan_min, 3),
780 SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO, show_fan_min,
781 store_fan_min, 4),
782};
Jean Delvare08e7e272005-04-25 22:43:25 +0200783
Yuan Mu412fec82006-02-05 23:24:16 +0100784static struct sensor_device_attribute sda_fan_div[] = {
785 SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
786 SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
787 SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
788 SENSOR_ATTR(fan4_div, S_IRUGO, show_fan_div, NULL, 3),
789 SENSOR_ATTR(fan5_div, S_IRUGO, show_fan_div, NULL, 4),
790};
Jean Delvare08e7e272005-04-25 22:43:25 +0200791
Jean Delvare08e7e272005-04-25 22:43:25 +0200792#define show_temp1_reg(reg) \
793static ssize_t \
Greg Kroah-Hartman6f637a62005-06-21 21:01:59 -0700794show_##reg(struct device *dev, struct device_attribute *attr, \
795 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200796{ \
797 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
798 return sprintf(buf, "%d\n", temp1_from_reg(data->reg)); \
799}
800show_temp1_reg(temp1);
801show_temp1_reg(temp1_max);
802show_temp1_reg(temp1_max_hyst);
803
804#define store_temp1_reg(REG, reg) \
805static ssize_t \
Greg Kroah-Hartman6f637a62005-06-21 21:01:59 -0700806store_temp1_##reg(struct device *dev, struct device_attribute *attr, \
807 const char *buf, size_t count) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200808{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200809 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200810 u32 val = simple_strtoul(buf, NULL, 10); \
811 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100812 mutex_lock(&data->update_lock); \
Rudolf Marek08c79952006-07-05 18:14:31 +0200813 data->temp1_##reg = temp1_to_reg(val, -128000, 127000); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200814 w83627ehf_write_value(data, W83627EHF_REG_TEMP1_##REG, \
Jean Delvare08e7e272005-04-25 22:43:25 +0200815 data->temp1_##reg); \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100816 mutex_unlock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200817 return count; \
818}
819store_temp1_reg(OVER, max);
820store_temp1_reg(HYST, max_hyst);
821
Jean Delvare08e7e272005-04-25 22:43:25 +0200822#define show_temp_reg(reg) \
823static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +0100824show_##reg(struct device *dev, struct device_attribute *attr, \
825 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200826{ \
827 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Yuan Mu412fec82006-02-05 23:24:16 +0100828 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
829 int nr = sensor_attr->index; \
Jean Delvare08e7e272005-04-25 22:43:25 +0200830 return sprintf(buf, "%d\n", \
831 LM75_TEMP_FROM_REG(data->reg[nr])); \
832}
833show_temp_reg(temp);
834show_temp_reg(temp_max);
835show_temp_reg(temp_max_hyst);
836
837#define store_temp_reg(REG, reg) \
838static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +0100839store_##reg(struct device *dev, struct device_attribute *attr, \
840 const char *buf, size_t count) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200841{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200842 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Yuan Mu412fec82006-02-05 23:24:16 +0100843 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
844 int nr = sensor_attr->index; \
Jean Delvare08e7e272005-04-25 22:43:25 +0200845 u32 val = simple_strtoul(buf, NULL, 10); \
846 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100847 mutex_lock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200848 data->reg[nr] = LM75_TEMP_TO_REG(val); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200849 w83627ehf_write_value(data, W83627EHF_REG_TEMP_##REG[nr], \
Jean Delvare08e7e272005-04-25 22:43:25 +0200850 data->reg[nr]); \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100851 mutex_unlock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200852 return count; \
853}
854store_temp_reg(OVER, temp_max);
855store_temp_reg(HYST, temp_max_hyst);
856
Jean Delvareda667362007-06-24 11:21:02 +0200857static ssize_t
858show_temp_type(struct device *dev, struct device_attribute *attr, char *buf)
859{
860 struct w83627ehf_data *data = w83627ehf_update_device(dev);
861 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
862 int nr = sensor_attr->index;
863 return sprintf(buf, "%d\n", (int)data->temp_type[nr]);
864}
865
Yuan Mu412fec82006-02-05 23:24:16 +0100866static struct sensor_device_attribute sda_temp[] = {
867 SENSOR_ATTR(temp1_input, S_IRUGO, show_temp1, NULL, 0),
868 SENSOR_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 0),
869 SENSOR_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 1),
870 SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp1_max,
871 store_temp1_max, 0),
872 SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
873 store_temp_max, 0),
874 SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
875 store_temp_max, 1),
876 SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp1_max_hyst,
877 store_temp1_max_hyst, 0),
878 SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
879 store_temp_max_hyst, 0),
880 SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
881 store_temp_max_hyst, 1),
Jean Delvarea4589db2006-03-23 16:30:29 +0100882 SENSOR_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4),
883 SENSOR_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5),
884 SENSOR_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13),
Jean Delvareda667362007-06-24 11:21:02 +0200885 SENSOR_ATTR(temp1_type, S_IRUGO, show_temp_type, NULL, 0),
886 SENSOR_ATTR(temp2_type, S_IRUGO, show_temp_type, NULL, 1),
887 SENSOR_ATTR(temp3_type, S_IRUGO, show_temp_type, NULL, 2),
Yuan Mu412fec82006-02-05 23:24:16 +0100888};
Jean Delvare08e7e272005-04-25 22:43:25 +0200889
Rudolf Marek08c79952006-07-05 18:14:31 +0200890#define show_pwm_reg(reg) \
891static ssize_t show_##reg (struct device *dev, struct device_attribute *attr, \
892 char *buf) \
893{ \
894 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
895 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
896 int nr = sensor_attr->index; \
897 return sprintf(buf, "%d\n", data->reg[nr]); \
898}
899
900show_pwm_reg(pwm_mode)
901show_pwm_reg(pwm_enable)
902show_pwm_reg(pwm)
903
904static ssize_t
905store_pwm_mode(struct device *dev, struct device_attribute *attr,
906 const char *buf, size_t count)
907{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200908 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200909 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
910 int nr = sensor_attr->index;
911 u32 val = simple_strtoul(buf, NULL, 10);
912 u16 reg;
913
914 if (val > 1)
915 return -EINVAL;
916 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200917 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +0200918 data->pwm_mode[nr] = val;
919 reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
920 if (!val)
921 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
David Hubbard1ea6dd32007-06-24 11:16:15 +0200922 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +0200923 mutex_unlock(&data->update_lock);
924 return count;
925}
926
927static ssize_t
928store_pwm(struct device *dev, struct device_attribute *attr,
929 const char *buf, size_t count)
930{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200931 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200932 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
933 int nr = sensor_attr->index;
934 u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 0, 255);
935
936 mutex_lock(&data->update_lock);
937 data->pwm[nr] = val;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200938 w83627ehf_write_value(data, W83627EHF_REG_PWM[nr], val);
Rudolf Marek08c79952006-07-05 18:14:31 +0200939 mutex_unlock(&data->update_lock);
940 return count;
941}
942
943static ssize_t
944store_pwm_enable(struct device *dev, struct device_attribute *attr,
945 const char *buf, size_t count)
946{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200947 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200948 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
949 int nr = sensor_attr->index;
950 u32 val = simple_strtoul(buf, NULL, 10);
951 u16 reg;
952
953 if (!val || (val > 2)) /* only modes 1 and 2 are supported */
954 return -EINVAL;
955 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200956 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +0200957 data->pwm_enable[nr] = val;
958 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
959 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
David Hubbard1ea6dd32007-06-24 11:16:15 +0200960 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +0200961 mutex_unlock(&data->update_lock);
962 return count;
963}
964
965
966#define show_tol_temp(reg) \
967static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
968 char *buf) \
969{ \
970 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
971 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
972 int nr = sensor_attr->index; \
973 return sprintf(buf, "%d\n", temp1_from_reg(data->reg[nr])); \
974}
975
976show_tol_temp(tolerance)
977show_tol_temp(target_temp)
978
979static ssize_t
980store_target_temp(struct device *dev, struct device_attribute *attr,
981 const char *buf, size_t count)
982{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200983 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200984 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
985 int nr = sensor_attr->index;
986 u8 val = temp1_to_reg(simple_strtoul(buf, NULL, 10), 0, 127000);
987
988 mutex_lock(&data->update_lock);
989 data->target_temp[nr] = val;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200990 w83627ehf_write_value(data, W83627EHF_REG_TARGET[nr], val);
Rudolf Marek08c79952006-07-05 18:14:31 +0200991 mutex_unlock(&data->update_lock);
992 return count;
993}
994
995static ssize_t
996store_tolerance(struct device *dev, struct device_attribute *attr,
997 const char *buf, size_t count)
998{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200999 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +02001000 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1001 int nr = sensor_attr->index;
1002 u16 reg;
1003 /* Limit the temp to 0C - 15C */
1004 u8 val = temp1_to_reg(simple_strtoul(buf, NULL, 10), 0, 15000);
1005
1006 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001007 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +02001008 data->tolerance[nr] = val;
1009 if (nr == 1)
1010 reg = (reg & 0x0f) | (val << 4);
1011 else
1012 reg = (reg & 0xf0) | val;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001013 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +02001014 mutex_unlock(&data->update_lock);
1015 return count;
1016}
1017
1018static struct sensor_device_attribute sda_pwm[] = {
1019 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
1020 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
1021 SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
1022 SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
1023};
1024
1025static struct sensor_device_attribute sda_pwm_mode[] = {
1026 SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1027 store_pwm_mode, 0),
1028 SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1029 store_pwm_mode, 1),
1030 SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1031 store_pwm_mode, 2),
1032 SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1033 store_pwm_mode, 3),
1034};
1035
1036static struct sensor_device_attribute sda_pwm_enable[] = {
1037 SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1038 store_pwm_enable, 0),
1039 SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1040 store_pwm_enable, 1),
1041 SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1042 store_pwm_enable, 2),
1043 SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1044 store_pwm_enable, 3),
1045};
1046
1047static struct sensor_device_attribute sda_target_temp[] = {
1048 SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1049 store_target_temp, 0),
1050 SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1051 store_target_temp, 1),
1052 SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1053 store_target_temp, 2),
1054 SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1055 store_target_temp, 3),
1056};
1057
1058static struct sensor_device_attribute sda_tolerance[] = {
1059 SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1060 store_tolerance, 0),
1061 SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1062 store_tolerance, 1),
1063 SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1064 store_tolerance, 2),
1065 SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1066 store_tolerance, 3),
1067};
1068
Rudolf Marek08c79952006-07-05 18:14:31 +02001069/* Smart Fan registers */
1070
1071#define fan_functions(reg, REG) \
1072static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1073 char *buf) \
1074{ \
1075 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1076 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1077 int nr = sensor_attr->index; \
1078 return sprintf(buf, "%d\n", data->reg[nr]); \
1079}\
1080static ssize_t \
1081store_##reg(struct device *dev, struct device_attribute *attr, \
1082 const char *buf, size_t count) \
1083{\
David Hubbard1ea6dd32007-06-24 11:16:15 +02001084 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001085 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1086 int nr = sensor_attr->index; \
1087 u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 1, 255); \
1088 mutex_lock(&data->update_lock); \
1089 data->reg[nr] = val; \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001090 w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001091 mutex_unlock(&data->update_lock); \
1092 return count; \
1093}
1094
1095fan_functions(fan_min_output, FAN_MIN_OUTPUT)
1096
1097#define fan_time_functions(reg, REG) \
1098static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1099 char *buf) \
1100{ \
1101 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1102 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1103 int nr = sensor_attr->index; \
1104 return sprintf(buf, "%d\n", \
1105 step_time_from_reg(data->reg[nr], data->pwm_mode[nr])); \
1106} \
1107\
1108static ssize_t \
1109store_##reg(struct device *dev, struct device_attribute *attr, \
1110 const char *buf, size_t count) \
1111{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001112 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001113 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1114 int nr = sensor_attr->index; \
1115 u8 val = step_time_to_reg(simple_strtoul(buf, NULL, 10), \
1116 data->pwm_mode[nr]); \
1117 mutex_lock(&data->update_lock); \
1118 data->reg[nr] = val; \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001119 w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001120 mutex_unlock(&data->update_lock); \
1121 return count; \
1122} \
1123
1124fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1125
David Hubbard1ea6dd32007-06-24 11:16:15 +02001126static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1127 char *buf)
1128{
1129 struct w83627ehf_data *data = dev_get_drvdata(dev);
1130
1131 return sprintf(buf, "%s\n", data->name);
1132}
1133static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
Rudolf Marek08c79952006-07-05 18:14:31 +02001134
1135static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1136 SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1137 store_fan_stop_time, 3),
1138 SENSOR_ATTR(pwm4_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1139 store_fan_min_output, 3),
1140};
1141
1142static struct sensor_device_attribute sda_sf3_arrays[] = {
1143 SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1144 store_fan_stop_time, 0),
1145 SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1146 store_fan_stop_time, 1),
1147 SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1148 store_fan_stop_time, 2),
1149 SENSOR_ATTR(pwm1_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1150 store_fan_min_output, 0),
1151 SENSOR_ATTR(pwm2_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1152 store_fan_min_output, 1),
1153 SENSOR_ATTR(pwm3_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1154 store_fan_min_output, 2),
1155};
1156
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001157static ssize_t
1158show_vid(struct device *dev, struct device_attribute *attr, char *buf)
1159{
1160 struct w83627ehf_data *data = dev_get_drvdata(dev);
1161 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1162}
1163static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
1164
Jean Delvare08e7e272005-04-25 22:43:25 +02001165/*
David Hubbard1ea6dd32007-06-24 11:16:15 +02001166 * Driver and device management
Jean Delvare08e7e272005-04-25 22:43:25 +02001167 */
1168
David Hubbardc18beb52006-09-24 21:04:38 +02001169static void w83627ehf_device_remove_files(struct device *dev)
1170{
1171 /* some entries in the following arrays may not have been used in
1172 * device_create_file(), but device_remove_file() will ignore them */
1173 int i;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001174 struct w83627ehf_data *data = dev_get_drvdata(dev);
David Hubbardc18beb52006-09-24 21:04:38 +02001175
1176 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1177 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
1178 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1179 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001180 for (i = 0; i < data->in_num; i++) {
David Hubbardc18beb52006-09-24 21:04:38 +02001181 device_remove_file(dev, &sda_in_input[i].dev_attr);
1182 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1183 device_remove_file(dev, &sda_in_min[i].dev_attr);
1184 device_remove_file(dev, &sda_in_max[i].dev_attr);
1185 }
1186 for (i = 0; i < 5; i++) {
1187 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1188 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1189 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1190 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1191 }
1192 for (i = 0; i < 4; i++) {
1193 device_remove_file(dev, &sda_pwm[i].dev_attr);
1194 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1195 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1196 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1197 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1198 }
1199 for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
1200 device_remove_file(dev, &sda_temp[i].dev_attr);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001201
1202 device_remove_file(dev, &dev_attr_name);
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001203 if (data->vid != 0x3f)
1204 device_remove_file(dev, &dev_attr_cpu0_vid);
David Hubbardc18beb52006-09-24 21:04:38 +02001205}
1206
David Hubbard1ea6dd32007-06-24 11:16:15 +02001207/* Get the monitoring functions started */
1208static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data)
Jean Delvare08e7e272005-04-25 22:43:25 +02001209{
1210 int i;
Jean Delvareda667362007-06-24 11:21:02 +02001211 u8 tmp, diode;
Jean Delvare08e7e272005-04-25 22:43:25 +02001212
1213 /* Start monitoring is needed */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001214 tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
Jean Delvare08e7e272005-04-25 22:43:25 +02001215 if (!(tmp & 0x01))
David Hubbard1ea6dd32007-06-24 11:16:15 +02001216 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
Jean Delvare08e7e272005-04-25 22:43:25 +02001217 tmp | 0x01);
1218
1219 /* Enable temp2 and temp3 if needed */
1220 for (i = 0; i < 2; i++) {
David Hubbard1ea6dd32007-06-24 11:16:15 +02001221 tmp = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +02001222 W83627EHF_REG_TEMP_CONFIG[i]);
1223 if (tmp & 0x01)
David Hubbard1ea6dd32007-06-24 11:16:15 +02001224 w83627ehf_write_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +02001225 W83627EHF_REG_TEMP_CONFIG[i],
1226 tmp & 0xfe);
1227 }
Jean Delvared3130f02007-06-24 11:20:13 +02001228
1229 /* Enable VBAT monitoring if needed */
1230 tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
1231 if (!(tmp & 0x01))
1232 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01);
Jean Delvareda667362007-06-24 11:21:02 +02001233
1234 /* Get thermal sensor types */
1235 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
1236 for (i = 0; i < 3; i++) {
1237 if ((tmp & (0x02 << i)))
1238 data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 2;
1239 else
1240 data->temp_type[i] = 4; /* thermistor */
1241 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001242}
1243
David Hubbard1ea6dd32007-06-24 11:16:15 +02001244static int __devinit w83627ehf_probe(struct platform_device *pdev)
Jean Delvare08e7e272005-04-25 22:43:25 +02001245{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001246 struct device *dev = &pdev->dev;
1247 struct w83627ehf_sio_data *sio_data = dev->platform_data;
Jean Delvare08e7e272005-04-25 22:43:25 +02001248 struct w83627ehf_data *data;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001249 struct resource *res;
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001250 u8 fan4pin, fan5pin, en_vrm10;
Jean Delvare08e7e272005-04-25 22:43:25 +02001251 int i, err = 0;
1252
David Hubbard1ea6dd32007-06-24 11:16:15 +02001253 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1254 if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001255 err = -EBUSY;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001256 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1257 (unsigned long)res->start,
1258 (unsigned long)res->start + IOREGION_LENGTH - 1);
Jean Delvare08e7e272005-04-25 22:43:25 +02001259 goto exit;
1260 }
1261
Deepak Saxenaba9c2e82005-10-17 23:08:32 +02001262 if (!(data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL))) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001263 err = -ENOMEM;
1264 goto exit_release;
1265 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001266
David Hubbard1ea6dd32007-06-24 11:16:15 +02001267 data->addr = res->start;
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001268 mutex_init(&data->lock);
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001269 mutex_init(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001270 data->name = w83627ehf_device_names[sio_data->kind];
1271 platform_set_drvdata(pdev, data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001272
David Hubbard1ea6dd32007-06-24 11:16:15 +02001273 /* 627EHG and 627EHF have 10 voltage inputs; DHG has 9 */
1274 data->in_num = (sio_data->kind == w83627dhg) ? 9 : 10;
Jean Delvare08e7e272005-04-25 22:43:25 +02001275
1276 /* Initialize the chip */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001277 w83627ehf_init_device(data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001278
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001279 data->vrm = vid_which_vrm();
1280 superio_enter(sio_data->sioreg);
1281 /* Set VID input sensibility if needed. In theory the BIOS should
1282 have set it, but in practice it's not always the case. */
1283 en_vrm10 = superio_inb(sio_data->sioreg, SIO_REG_EN_VRM10);
1284 if ((en_vrm10 & 0x08) && data->vrm != 100) {
1285 dev_warn(dev, "Setting VID input voltage to TTL\n");
1286 superio_outb(sio_data->sioreg, SIO_REG_EN_VRM10,
1287 en_vrm10 & ~0x08);
1288 } else if (!(en_vrm10 & 0x08) && data->vrm == 100) {
1289 dev_warn(dev, "Setting VID input voltage to VRM10\n");
1290 superio_outb(sio_data->sioreg, SIO_REG_EN_VRM10,
1291 en_vrm10 | 0x08);
1292 }
1293 /* Read VID value */
1294 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
1295 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80)
1296 data->vid = superio_inb(sio_data->sioreg, SIO_REG_VID_DATA) & 0x3f;
1297 else {
1298 dev_info(dev, "VID pins in output mode, CPU VID not "
1299 "available\n");
1300 data->vid = 0x3f;
1301 }
1302
Rudolf Marek08c79952006-07-05 18:14:31 +02001303 /* fan4 and fan5 share some pins with the GPIO and serial flash */
1304
David Hubbard1ea6dd32007-06-24 11:16:15 +02001305 fan5pin = superio_inb(sio_data->sioreg, 0x24) & 0x2;
1306 fan4pin = superio_inb(sio_data->sioreg, 0x29) & 0x6;
1307 superio_exit(sio_data->sioreg);
Rudolf Marek08c79952006-07-05 18:14:31 +02001308
Jean Delvare08e7e272005-04-25 22:43:25 +02001309 /* It looks like fan4 and fan5 pins can be alternatively used
Rudolf Marek14992c72006-10-08 22:02:09 +02001310 as fan on/off switches, but fan5 control is write only :/
1311 We assume that if the serial interface is disabled, designers
1312 connected fan5 as input unless they are emitting log 1, which
1313 is not the default. */
Rudolf Marek08c79952006-07-05 18:14:31 +02001314
Jean Delvare08e7e272005-04-25 22:43:25 +02001315 data->has_fan = 0x07; /* fan1, fan2 and fan3 */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001316 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
Rudolf Marek08c79952006-07-05 18:14:31 +02001317 if ((i & (1 << 2)) && (!fan4pin))
Jean Delvare08e7e272005-04-25 22:43:25 +02001318 data->has_fan |= (1 << 3);
Rudolf Marek14992c72006-10-08 22:02:09 +02001319 if (!(i & (1 << 1)) && (!fan5pin))
Jean Delvare08e7e272005-04-25 22:43:25 +02001320 data->has_fan |= (1 << 4);
1321
Mark M. Hoffmanea7be662007-08-05 12:19:01 -04001322 /* Read fan clock dividers immediately */
1323 w83627ehf_update_fan_div(data);
1324
Jean Delvare08e7e272005-04-25 22:43:25 +02001325 /* Register sysfs hooks */
Rudolf Marek08c79952006-07-05 18:14:31 +02001326 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
David Hubbardc18beb52006-09-24 21:04:38 +02001327 if ((err = device_create_file(dev,
1328 &sda_sf3_arrays[i].dev_attr)))
1329 goto exit_remove;
Rudolf Marek08c79952006-07-05 18:14:31 +02001330
1331 /* if fan4 is enabled create the sf3 files for it */
1332 if (data->has_fan & (1 << 3))
David Hubbardc18beb52006-09-24 21:04:38 +02001333 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
1334 if ((err = device_create_file(dev,
1335 &sda_sf3_arrays_fan4[i].dev_attr)))
1336 goto exit_remove;
1337 }
Rudolf Marek08c79952006-07-05 18:14:31 +02001338
David Hubbard1ea6dd32007-06-24 11:16:15 +02001339 for (i = 0; i < data->in_num; i++)
David Hubbardc18beb52006-09-24 21:04:38 +02001340 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
1341 || (err = device_create_file(dev,
1342 &sda_in_alarm[i].dev_attr))
1343 || (err = device_create_file(dev,
1344 &sda_in_min[i].dev_attr))
1345 || (err = device_create_file(dev,
1346 &sda_in_max[i].dev_attr)))
1347 goto exit_remove;
Rudolf Marekcf0676f2006-03-23 16:25:22 +01001348
Yuan Mu412fec82006-02-05 23:24:16 +01001349 for (i = 0; i < 5; i++) {
Rudolf Marek08c79952006-07-05 18:14:31 +02001350 if (data->has_fan & (1 << i)) {
David Hubbardc18beb52006-09-24 21:04:38 +02001351 if ((err = device_create_file(dev,
1352 &sda_fan_input[i].dev_attr))
1353 || (err = device_create_file(dev,
1354 &sda_fan_alarm[i].dev_attr))
1355 || (err = device_create_file(dev,
1356 &sda_fan_div[i].dev_attr))
1357 || (err = device_create_file(dev,
1358 &sda_fan_min[i].dev_attr)))
1359 goto exit_remove;
1360 if (i < 4 && /* w83627ehf only has 4 pwm */
1361 ((err = device_create_file(dev,
1362 &sda_pwm[i].dev_attr))
1363 || (err = device_create_file(dev,
1364 &sda_pwm_mode[i].dev_attr))
1365 || (err = device_create_file(dev,
1366 &sda_pwm_enable[i].dev_attr))
1367 || (err = device_create_file(dev,
1368 &sda_target_temp[i].dev_attr))
1369 || (err = device_create_file(dev,
1370 &sda_tolerance[i].dev_attr))))
1371 goto exit_remove;
Rudolf Marek08c79952006-07-05 18:14:31 +02001372 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001373 }
Rudolf Marek08c79952006-07-05 18:14:31 +02001374
Yuan Mu412fec82006-02-05 23:24:16 +01001375 for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
David Hubbardc18beb52006-09-24 21:04:38 +02001376 if ((err = device_create_file(dev, &sda_temp[i].dev_attr)))
1377 goto exit_remove;
1378
David Hubbard1ea6dd32007-06-24 11:16:15 +02001379 err = device_create_file(dev, &dev_attr_name);
1380 if (err)
1381 goto exit_remove;
1382
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001383 if (data->vid != 0x3f) {
1384 err = device_create_file(dev, &dev_attr_cpu0_vid);
1385 if (err)
1386 goto exit_remove;
1387 }
1388
David Hubbardc18beb52006-09-24 21:04:38 +02001389 data->class_dev = hwmon_device_register(dev);
1390 if (IS_ERR(data->class_dev)) {
1391 err = PTR_ERR(data->class_dev);
1392 goto exit_remove;
1393 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001394
1395 return 0;
1396
David Hubbardc18beb52006-09-24 21:04:38 +02001397exit_remove:
1398 w83627ehf_device_remove_files(dev);
Jean Delvare08e7e272005-04-25 22:43:25 +02001399 kfree(data);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001400 platform_set_drvdata(pdev, NULL);
Jean Delvare08e7e272005-04-25 22:43:25 +02001401exit_release:
David Hubbard1ea6dd32007-06-24 11:16:15 +02001402 release_region(res->start, IOREGION_LENGTH);
Jean Delvare08e7e272005-04-25 22:43:25 +02001403exit:
1404 return err;
1405}
1406
David Hubbard1ea6dd32007-06-24 11:16:15 +02001407static int __devexit w83627ehf_remove(struct platform_device *pdev)
Jean Delvare08e7e272005-04-25 22:43:25 +02001408{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001409 struct w83627ehf_data *data = platform_get_drvdata(pdev);
Jean Delvare08e7e272005-04-25 22:43:25 +02001410
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001411 hwmon_device_unregister(data->class_dev);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001412 w83627ehf_device_remove_files(&pdev->dev);
1413 release_region(data->addr, IOREGION_LENGTH);
1414 platform_set_drvdata(pdev, NULL);
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001415 kfree(data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001416
1417 return 0;
1418}
1419
David Hubbard1ea6dd32007-06-24 11:16:15 +02001420static struct platform_driver w83627ehf_driver = {
Laurent Riffardcdaf7932005-11-26 20:37:41 +01001421 .driver = {
Jean Delvare87218842006-09-03 22:36:14 +02001422 .owner = THIS_MODULE,
David Hubbard1ea6dd32007-06-24 11:16:15 +02001423 .name = DRVNAME,
Laurent Riffardcdaf7932005-11-26 20:37:41 +01001424 },
David Hubbard1ea6dd32007-06-24 11:16:15 +02001425 .probe = w83627ehf_probe,
1426 .remove = __devexit_p(w83627ehf_remove),
Jean Delvare08e7e272005-04-25 22:43:25 +02001427};
1428
David Hubbard1ea6dd32007-06-24 11:16:15 +02001429/* w83627ehf_find() looks for a '627 in the Super-I/O config space */
1430static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
1431 struct w83627ehf_sio_data *sio_data)
Jean Delvare08e7e272005-04-25 22:43:25 +02001432{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001433 static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
1434 static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
1435 static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
1436
Jean Delvare08e7e272005-04-25 22:43:25 +02001437 u16 val;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001438 const char *sio_name;
Jean Delvare08e7e272005-04-25 22:43:25 +02001439
David Hubbard1ea6dd32007-06-24 11:16:15 +02001440 superio_enter(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02001441
David Hubbard1ea6dd32007-06-24 11:16:15 +02001442 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
1443 | superio_inb(sioaddr, SIO_REG_DEVID + 1);
David Hubbard657c93b2007-02-14 21:15:04 +01001444 switch (val & SIO_ID_MASK) {
David Hubbard657c93b2007-02-14 21:15:04 +01001445 case SIO_W83627EHF_ID:
David Hubbard1ea6dd32007-06-24 11:16:15 +02001446 sio_data->kind = w83627ehf;
1447 sio_name = sio_name_W83627EHF;
1448 break;
David Hubbard657c93b2007-02-14 21:15:04 +01001449 case SIO_W83627EHG_ID:
David Hubbard1ea6dd32007-06-24 11:16:15 +02001450 sio_data->kind = w83627ehf;
1451 sio_name = sio_name_W83627EHG;
1452 break;
1453 case SIO_W83627DHG_ID:
1454 sio_data->kind = w83627dhg;
1455 sio_name = sio_name_W83627DHG;
David Hubbard657c93b2007-02-14 21:15:04 +01001456 break;
1457 default:
Jean Delvare9f660362007-06-24 11:23:41 +02001458 if (val != 0xffff)
1459 pr_debug(DRVNAME ": unsupported chip ID: 0x%04x\n",
1460 val);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001461 superio_exit(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02001462 return -ENODEV;
1463 }
1464
David Hubbard1ea6dd32007-06-24 11:16:15 +02001465 /* We have a known chip, find the HWM I/O address */
1466 superio_select(sioaddr, W83627EHF_LD_HWM);
1467 val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
1468 | superio_inb(sioaddr, SIO_REG_ADDR + 1);
Jean Delvare1a641fc2007-04-23 14:41:16 -07001469 *addr = val & IOREGION_ALIGNMENT;
Jean Delvare2d8672c2005-07-19 23:56:35 +02001470 if (*addr == 0) {
David Hubbard475ef852007-06-24 11:17:09 +02001471 printk(KERN_ERR DRVNAME ": Refusing to enable a Super-I/O "
1472 "device with a base I/O port 0.\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02001473 superio_exit(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02001474 return -ENODEV;
1475 }
1476
1477 /* Activate logical device if needed */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001478 val = superio_inb(sioaddr, SIO_REG_ENABLE);
David Hubbard475ef852007-06-24 11:17:09 +02001479 if (!(val & 0x01)) {
1480 printk(KERN_WARNING DRVNAME ": Forcibly enabling Super-I/O. "
1481 "Sensor is probably unusable.\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02001482 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
David Hubbard475ef852007-06-24 11:17:09 +02001483 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001484
David Hubbard1ea6dd32007-06-24 11:16:15 +02001485 superio_exit(sioaddr);
1486 pr_info(DRVNAME ": Found %s chip at %#x\n", sio_name, *addr);
1487 sio_data->sioreg = sioaddr;
1488
Jean Delvare08e7e272005-04-25 22:43:25 +02001489 return 0;
1490}
1491
David Hubbard1ea6dd32007-06-24 11:16:15 +02001492/* when Super-I/O functions move to a separate file, the Super-I/O
1493 * bus will manage the lifetime of the device and this module will only keep
1494 * track of the w83627ehf driver. But since we platform_device_alloc(), we
1495 * must keep track of the device */
1496static struct platform_device *pdev;
1497
Jean Delvare08e7e272005-04-25 22:43:25 +02001498static int __init sensors_w83627ehf_init(void)
1499{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001500 int err;
1501 unsigned short address;
1502 struct resource res;
1503 struct w83627ehf_sio_data sio_data;
1504
1505 /* initialize sio_data->kind and sio_data->sioreg.
1506 *
1507 * when Super-I/O functions move to a separate file, the Super-I/O
1508 * driver will probe 0x2e and 0x4e and auto-detect the presence of a
1509 * w83627ehf hardware monitor, and call probe() */
1510 if (w83627ehf_find(0x2e, &address, &sio_data) &&
1511 w83627ehf_find(0x4e, &address, &sio_data))
Jean Delvare08e7e272005-04-25 22:43:25 +02001512 return -ENODEV;
1513
David Hubbard1ea6dd32007-06-24 11:16:15 +02001514 err = platform_driver_register(&w83627ehf_driver);
1515 if (err)
1516 goto exit;
1517
1518 if (!(pdev = platform_device_alloc(DRVNAME, address))) {
1519 err = -ENOMEM;
1520 printk(KERN_ERR DRVNAME ": Device allocation failed\n");
1521 goto exit_unregister;
1522 }
1523
1524 err = platform_device_add_data(pdev, &sio_data,
1525 sizeof(struct w83627ehf_sio_data));
1526 if (err) {
1527 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1528 goto exit_device_put;
1529 }
1530
1531 memset(&res, 0, sizeof(res));
1532 res.name = DRVNAME;
1533 res.start = address + IOREGION_OFFSET;
1534 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
1535 res.flags = IORESOURCE_IO;
1536 err = platform_device_add_resources(pdev, &res, 1);
1537 if (err) {
1538 printk(KERN_ERR DRVNAME ": Device resource addition failed "
1539 "(%d)\n", err);
1540 goto exit_device_put;
1541 }
1542
1543 /* platform_device_add calls probe() */
1544 err = platform_device_add(pdev);
1545 if (err) {
1546 printk(KERN_ERR DRVNAME ": Device addition failed (%d)\n",
1547 err);
1548 goto exit_device_put;
1549 }
1550
1551 return 0;
1552
1553exit_device_put:
1554 platform_device_put(pdev);
1555exit_unregister:
1556 platform_driver_unregister(&w83627ehf_driver);
1557exit:
1558 return err;
Jean Delvare08e7e272005-04-25 22:43:25 +02001559}
1560
1561static void __exit sensors_w83627ehf_exit(void)
1562{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001563 platform_device_unregister(pdev);
1564 platform_driver_unregister(&w83627ehf_driver);
Jean Delvare08e7e272005-04-25 22:43:25 +02001565}
1566
1567MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
1568MODULE_DESCRIPTION("W83627EHF driver");
1569MODULE_LICENSE("GPL");
1570
1571module_init(sensors_w83627ehf_init);
1572module_exit(sensors_w83627ehf_exit);