blob: d5aa25ce5dbdc8251d05d384391c418070f80d9b [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
Christian Hohnstaedt5bfedac2007-08-16 11:40:10 +0200226temp1_to_reg(long 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
Tony Jones1beeffe2007-08-20 13:46:20 -0700259 struct device *hwmon_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
Jean Delvare09568952007-08-11 13:57:05 +0200312/* Registers 0x50-0x5f are banked */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200313static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200314{
Jean Delvare09568952007-08-11 13:57:05 +0200315 if ((reg & 0x00f0) == 0x50) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200316 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
317 outb_p(reg >> 8, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200318 }
319}
320
Jean Delvare09568952007-08-11 13:57:05 +0200321/* Not strictly necessary, but play it safe for now */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200322static inline void w83627ehf_reset_bank(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200323{
324 if (reg & 0xff00) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200325 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
326 outb_p(0, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200327 }
328}
329
David Hubbard1ea6dd32007-06-24 11:16:15 +0200330static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200331{
Jean Delvare08e7e272005-04-25 22:43:25 +0200332 int res, word_sized = is_word_sized(reg);
333
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100334 mutex_lock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200335
David Hubbard1ea6dd32007-06-24 11:16:15 +0200336 w83627ehf_set_bank(data, reg);
337 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
338 res = inb_p(data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200339 if (word_sized) {
340 outb_p((reg & 0xff) + 1,
David Hubbard1ea6dd32007-06-24 11:16:15 +0200341 data->addr + ADDR_REG_OFFSET);
342 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200343 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200344 w83627ehf_reset_bank(data, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200345
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100346 mutex_unlock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200347
348 return res;
349}
350
David Hubbard1ea6dd32007-06-24 11:16:15 +0200351static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg, u16 value)
Jean Delvare08e7e272005-04-25 22:43:25 +0200352{
Jean Delvare08e7e272005-04-25 22:43:25 +0200353 int word_sized = is_word_sized(reg);
354
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100355 mutex_lock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200356
David Hubbard1ea6dd32007-06-24 11:16:15 +0200357 w83627ehf_set_bank(data, reg);
358 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200359 if (word_sized) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200360 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200361 outb_p((reg & 0xff) + 1,
David Hubbard1ea6dd32007-06-24 11:16:15 +0200362 data->addr + ADDR_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200363 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200364 outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
365 w83627ehf_reset_bank(data, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200366
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100367 mutex_unlock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200368 return 0;
369}
370
371/* This function assumes that the caller holds data->update_lock */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200372static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr)
Jean Delvare08e7e272005-04-25 22:43:25 +0200373{
Jean Delvare08e7e272005-04-25 22:43:25 +0200374 u8 reg;
375
376 switch (nr) {
377 case 0:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200378 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200379 | ((data->fan_div[0] & 0x03) << 4);
Rudolf Marek14992c72006-10-08 22:02:09 +0200380 /* fan5 input control bit is write only, compute the value */
381 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200382 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
383 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200384 | ((data->fan_div[0] & 0x04) << 3);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200385 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200386 break;
387 case 1:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200388 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200389 | ((data->fan_div[1] & 0x03) << 6);
Rudolf Marek14992c72006-10-08 22:02:09 +0200390 /* fan5 input control bit is write only, compute the value */
391 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200392 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
393 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200394 | ((data->fan_div[1] & 0x04) << 4);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200395 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200396 break;
397 case 2:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200398 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200399 | ((data->fan_div[2] & 0x03) << 6);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200400 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg);
401 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200402 | ((data->fan_div[2] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200403 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200404 break;
405 case 3:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200406 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc)
Jean Delvare08e7e272005-04-25 22:43:25 +0200407 | (data->fan_div[3] & 0x03);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200408 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
409 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200410 | ((data->fan_div[3] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200411 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200412 break;
413 case 4:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200414 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73)
Jean Delvare33725ad2007-04-17 00:32:27 -0700415 | ((data->fan_div[4] & 0x03) << 2)
Jean Delvare08e7e272005-04-25 22:43:25 +0200416 | ((data->fan_div[4] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200417 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200418 break;
419 }
420}
421
Mark M. Hoffmanea7be662007-08-05 12:19:01 -0400422static void w83627ehf_update_fan_div(struct w83627ehf_data *data)
423{
424 int i;
425
426 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
427 data->fan_div[0] = (i >> 4) & 0x03;
428 data->fan_div[1] = (i >> 6) & 0x03;
429 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2);
430 data->fan_div[2] = (i >> 6) & 0x03;
431 i = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
432 data->fan_div[0] |= (i >> 3) & 0x04;
433 data->fan_div[1] |= (i >> 4) & 0x04;
434 data->fan_div[2] |= (i >> 5) & 0x04;
435 if (data->has_fan & ((1 << 3) | (1 << 4))) {
436 i = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
437 data->fan_div[3] = i & 0x03;
438 data->fan_div[4] = ((i >> 2) & 0x03)
439 | ((i >> 5) & 0x04);
440 }
441 if (data->has_fan & (1 << 3)) {
442 i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT);
443 data->fan_div[3] |= (i >> 5) & 0x04;
444 }
445}
446
Jean Delvare08e7e272005-04-25 22:43:25 +0200447static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
448{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200449 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200450 int pwmcfg = 0, tolerance = 0; /* shut up the compiler */
Jean Delvare08e7e272005-04-25 22:43:25 +0200451 int i;
452
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100453 mutex_lock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200454
Jean Delvare6b3e4642007-06-24 11:19:01 +0200455 if (time_after(jiffies, data->last_updated + HZ + HZ/2)
Jean Delvare08e7e272005-04-25 22:43:25 +0200456 || !data->valid) {
457 /* Fan clock dividers */
Mark M. Hoffmanea7be662007-08-05 12:19:01 -0400458 w83627ehf_update_fan_div(data);
Jean Delvare08e7e272005-04-25 22:43:25 +0200459
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100460 /* Measured voltages and limits */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200461 for (i = 0; i < data->in_num; i++) {
462 data->in[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100463 W83627EHF_REG_IN(i));
David Hubbard1ea6dd32007-06-24 11:16:15 +0200464 data->in_min[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100465 W83627EHF_REG_IN_MIN(i));
David Hubbard1ea6dd32007-06-24 11:16:15 +0200466 data->in_max[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100467 W83627EHF_REG_IN_MAX(i));
468 }
469
Jean Delvare08e7e272005-04-25 22:43:25 +0200470 /* Measured fan speeds and limits */
471 for (i = 0; i < 5; i++) {
472 if (!(data->has_fan & (1 << i)))
473 continue;
474
David Hubbard1ea6dd32007-06-24 11:16:15 +0200475 data->fan[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200476 W83627EHF_REG_FAN[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200477 data->fan_min[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200478 W83627EHF_REG_FAN_MIN[i]);
479
480 /* If we failed to measure the fan speed and clock
481 divider can be increased, let's try that for next
482 time */
483 if (data->fan[i] == 0xff
484 && data->fan_div[i] < 0x07) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200485 dev_dbg(dev, "Increasing fan%d "
Jean Delvare08e7e272005-04-25 22:43:25 +0200486 "clock divider from %u to %u\n",
Jean Delvare33725ad2007-04-17 00:32:27 -0700487 i + 1, div_from_reg(data->fan_div[i]),
Jean Delvare08e7e272005-04-25 22:43:25 +0200488 div_from_reg(data->fan_div[i] + 1));
489 data->fan_div[i]++;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200490 w83627ehf_write_fan_div(data, i);
Jean Delvare08e7e272005-04-25 22:43:25 +0200491 /* Preserve min limit if possible */
492 if (data->fan_min[i] >= 2
493 && data->fan_min[i] != 255)
David Hubbard1ea6dd32007-06-24 11:16:15 +0200494 w83627ehf_write_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200495 W83627EHF_REG_FAN_MIN[i],
496 (data->fan_min[i] /= 2));
497 }
498 }
499
Rudolf Marek08c79952006-07-05 18:14:31 +0200500 for (i = 0; i < 4; i++) {
501 /* pwmcfg, tolarance mapped for i=0, i=1 to same reg */
502 if (i != 1) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200503 pwmcfg = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200504 W83627EHF_REG_PWM_ENABLE[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200505 tolerance = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200506 W83627EHF_REG_TOLERANCE[i]);
507 }
508 data->pwm_mode[i] =
509 ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1)
510 ? 0 : 1;
511 data->pwm_enable[i] =
512 ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i])
513 & 3) + 1;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200514 data->pwm[i] = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200515 W83627EHF_REG_PWM[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200516 data->fan_min_output[i] = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200517 W83627EHF_REG_FAN_MIN_OUTPUT[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200518 data->fan_stop_time[i] = w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200519 W83627EHF_REG_FAN_STOP_TIME[i]);
520 data->target_temp[i] =
David Hubbard1ea6dd32007-06-24 11:16:15 +0200521 w83627ehf_read_value(data,
Rudolf Marek08c79952006-07-05 18:14:31 +0200522 W83627EHF_REG_TARGET[i]) &
523 (data->pwm_mode[i] == 1 ? 0x7f : 0xff);
524 data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0))
525 & 0x0f;
526 }
527
Jean Delvare08e7e272005-04-25 22:43:25 +0200528 /* Measured temperatures and limits */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200529 data->temp1 = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200530 W83627EHF_REG_TEMP1);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200531 data->temp1_max = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200532 W83627EHF_REG_TEMP1_OVER);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200533 data->temp1_max_hyst = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200534 W83627EHF_REG_TEMP1_HYST);
535 for (i = 0; i < 2; i++) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200536 data->temp[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200537 W83627EHF_REG_TEMP[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200538 data->temp_max[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200539 W83627EHF_REG_TEMP_OVER[i]);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200540 data->temp_max_hyst[i] = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +0200541 W83627EHF_REG_TEMP_HYST[i]);
542 }
543
David Hubbard1ea6dd32007-06-24 11:16:15 +0200544 data->alarms = w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100545 W83627EHF_REG_ALARM1) |
David Hubbard1ea6dd32007-06-24 11:16:15 +0200546 (w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100547 W83627EHF_REG_ALARM2) << 8) |
David Hubbard1ea6dd32007-06-24 11:16:15 +0200548 (w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100549 W83627EHF_REG_ALARM3) << 16);
550
Jean Delvare08e7e272005-04-25 22:43:25 +0200551 data->last_updated = jiffies;
552 data->valid = 1;
553 }
554
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100555 mutex_unlock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200556 return data;
557}
558
559/*
560 * Sysfs callback functions
561 */
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100562#define show_in_reg(reg) \
563static ssize_t \
564show_##reg(struct device *dev, struct device_attribute *attr, \
565 char *buf) \
566{ \
567 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
568 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
569 int nr = sensor_attr->index; \
570 return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr)); \
571}
572show_in_reg(in)
573show_in_reg(in_min)
574show_in_reg(in_max)
575
576#define store_in_reg(REG, reg) \
577static ssize_t \
578store_in_##reg (struct device *dev, struct device_attribute *attr, \
579 const char *buf, size_t count) \
580{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200581 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100582 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
583 int nr = sensor_attr->index; \
584 u32 val = simple_strtoul(buf, NULL, 10); \
585 \
586 mutex_lock(&data->update_lock); \
587 data->in_##reg[nr] = in_to_reg(val, nr); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200588 w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100589 data->in_##reg[nr]); \
590 mutex_unlock(&data->update_lock); \
591 return count; \
592}
593
594store_in_reg(MIN, min)
595store_in_reg(MAX, max)
596
Jean Delvarea4589db2006-03-23 16:30:29 +0100597static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, char *buf)
598{
599 struct w83627ehf_data *data = w83627ehf_update_device(dev);
600 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
601 int nr = sensor_attr->index;
602 return sprintf(buf, "%u\n", (data->alarms >> nr) & 0x01);
603}
604
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100605static struct sensor_device_attribute sda_in_input[] = {
606 SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
607 SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
608 SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
609 SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
610 SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
611 SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
612 SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
613 SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
614 SENSOR_ATTR(in8_input, S_IRUGO, show_in, NULL, 8),
615 SENSOR_ATTR(in9_input, S_IRUGO, show_in, NULL, 9),
616};
617
Jean Delvarea4589db2006-03-23 16:30:29 +0100618static struct sensor_device_attribute sda_in_alarm[] = {
619 SENSOR_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0),
620 SENSOR_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1),
621 SENSOR_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2),
622 SENSOR_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3),
623 SENSOR_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8),
624 SENSOR_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 21),
625 SENSOR_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 20),
626 SENSOR_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16),
627 SENSOR_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17),
628 SENSOR_ATTR(in9_alarm, S_IRUGO, show_alarm, NULL, 19),
629};
630
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100631static struct sensor_device_attribute sda_in_min[] = {
632 SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
633 SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
634 SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
635 SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 3),
636 SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 4),
637 SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 5),
638 SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 6),
639 SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 7),
640 SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 8),
641 SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 9),
642};
643
644static struct sensor_device_attribute sda_in_max[] = {
645 SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
646 SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
647 SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
648 SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 3),
649 SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 4),
650 SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 5),
651 SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 6),
652 SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 7),
653 SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 8),
654 SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 9),
655};
656
Jean Delvare08e7e272005-04-25 22:43:25 +0200657#define show_fan_reg(reg) \
658static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +0100659show_##reg(struct device *dev, struct device_attribute *attr, \
660 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200661{ \
662 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Yuan Mu412fec82006-02-05 23:24:16 +0100663 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
664 int nr = sensor_attr->index; \
Jean Delvare08e7e272005-04-25 22:43:25 +0200665 return sprintf(buf, "%d\n", \
666 fan_from_reg(data->reg[nr], \
667 div_from_reg(data->fan_div[nr]))); \
668}
669show_fan_reg(fan);
670show_fan_reg(fan_min);
671
672static ssize_t
Yuan Mu412fec82006-02-05 23:24:16 +0100673show_fan_div(struct device *dev, struct device_attribute *attr,
674 char *buf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200675{
676 struct w83627ehf_data *data = w83627ehf_update_device(dev);
Yuan Mu412fec82006-02-05 23:24:16 +0100677 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
678 int nr = sensor_attr->index;
679 return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
Jean Delvare08e7e272005-04-25 22:43:25 +0200680}
681
682static ssize_t
Yuan Mu412fec82006-02-05 23:24:16 +0100683store_fan_min(struct device *dev, struct device_attribute *attr,
684 const char *buf, size_t count)
Jean Delvare08e7e272005-04-25 22:43:25 +0200685{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200686 struct w83627ehf_data *data = dev_get_drvdata(dev);
Yuan Mu412fec82006-02-05 23:24:16 +0100687 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
688 int nr = sensor_attr->index;
Jean Delvare08e7e272005-04-25 22:43:25 +0200689 unsigned int val = simple_strtoul(buf, NULL, 10);
690 unsigned int reg;
691 u8 new_div;
692
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100693 mutex_lock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200694 if (!val) {
695 /* No min limit, alarm disabled */
696 data->fan_min[nr] = 255;
697 new_div = data->fan_div[nr]; /* No change */
698 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
699 } else if ((reg = 1350000U / val) >= 128 * 255) {
700 /* Speed below this value cannot possibly be represented,
701 even with the highest divider (128) */
702 data->fan_min[nr] = 254;
703 new_div = 7; /* 128 == (1 << 7) */
704 dev_warn(dev, "fan%u low limit %u below minimum %u, set to "
705 "minimum\n", nr + 1, val, fan_from_reg(254, 128));
706 } else if (!reg) {
707 /* Speed above this value cannot possibly be represented,
708 even with the lowest divider (1) */
709 data->fan_min[nr] = 1;
710 new_div = 0; /* 1 == (1 << 0) */
711 dev_warn(dev, "fan%u low limit %u above maximum %u, set to "
Jean Delvareb9110b12005-05-02 23:08:22 +0200712 "maximum\n", nr + 1, val, fan_from_reg(1, 1));
Jean Delvare08e7e272005-04-25 22:43:25 +0200713 } else {
714 /* Automatically pick the best divider, i.e. the one such
715 that the min limit will correspond to a register value
716 in the 96..192 range */
717 new_div = 0;
718 while (reg > 192 && new_div < 7) {
719 reg >>= 1;
720 new_div++;
721 }
722 data->fan_min[nr] = reg;
723 }
724
725 /* Write both the fan clock divider (if it changed) and the new
726 fan min (unconditionally) */
727 if (new_div != data->fan_div[nr]) {
Jean Delvare158ce072007-06-17 16:09:12 +0200728 /* Preserve the fan speed reading */
729 if (data->fan[nr] != 0xff) {
730 if (new_div > data->fan_div[nr])
731 data->fan[nr] >>= new_div - data->fan_div[nr];
732 else if (data->fan[nr] & 0x80)
733 data->fan[nr] = 0xff;
734 else
735 data->fan[nr] <<= data->fan_div[nr] - new_div;
736 }
Jean Delvare08e7e272005-04-25 22:43:25 +0200737
738 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
739 nr + 1, div_from_reg(data->fan_div[nr]),
740 div_from_reg(new_div));
741 data->fan_div[nr] = new_div;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200742 w83627ehf_write_fan_div(data, nr);
Jean Delvare6b3e4642007-06-24 11:19:01 +0200743 /* Give the chip time to sample a new speed value */
744 data->last_updated = jiffies;
Jean Delvare08e7e272005-04-25 22:43:25 +0200745 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200746 w83627ehf_write_value(data, W83627EHF_REG_FAN_MIN[nr],
Jean Delvare08e7e272005-04-25 22:43:25 +0200747 data->fan_min[nr]);
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100748 mutex_unlock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200749
750 return count;
751}
752
Yuan Mu412fec82006-02-05 23:24:16 +0100753static struct sensor_device_attribute sda_fan_input[] = {
754 SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
755 SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
756 SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
757 SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
758 SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
759};
Jean Delvare08e7e272005-04-25 22:43:25 +0200760
Jean Delvarea4589db2006-03-23 16:30:29 +0100761static struct sensor_device_attribute sda_fan_alarm[] = {
762 SENSOR_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6),
763 SENSOR_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7),
764 SENSOR_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11),
765 SENSOR_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 10),
766 SENSOR_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 23),
767};
768
Yuan Mu412fec82006-02-05 23:24:16 +0100769static struct sensor_device_attribute sda_fan_min[] = {
770 SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
771 store_fan_min, 0),
772 SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
773 store_fan_min, 1),
774 SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
775 store_fan_min, 2),
776 SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
777 store_fan_min, 3),
778 SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO, show_fan_min,
779 store_fan_min, 4),
780};
Jean Delvare08e7e272005-04-25 22:43:25 +0200781
Yuan Mu412fec82006-02-05 23:24:16 +0100782static struct sensor_device_attribute sda_fan_div[] = {
783 SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
784 SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
785 SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
786 SENSOR_ATTR(fan4_div, S_IRUGO, show_fan_div, NULL, 3),
787 SENSOR_ATTR(fan5_div, S_IRUGO, show_fan_div, NULL, 4),
788};
Jean Delvare08e7e272005-04-25 22:43:25 +0200789
Jean Delvare08e7e272005-04-25 22:43:25 +0200790#define show_temp1_reg(reg) \
791static ssize_t \
Greg Kroah-Hartman6f637a62005-06-21 21:01:59 -0700792show_##reg(struct device *dev, struct device_attribute *attr, \
793 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200794{ \
795 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
796 return sprintf(buf, "%d\n", temp1_from_reg(data->reg)); \
797}
798show_temp1_reg(temp1);
799show_temp1_reg(temp1_max);
800show_temp1_reg(temp1_max_hyst);
801
802#define store_temp1_reg(REG, reg) \
803static ssize_t \
Greg Kroah-Hartman6f637a62005-06-21 21:01:59 -0700804store_temp1_##reg(struct device *dev, struct device_attribute *attr, \
805 const char *buf, size_t count) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200806{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200807 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Christian Hohnstaedt5bfedac2007-08-16 11:40:10 +0200808 long val = simple_strtol(buf, NULL, 10); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200809 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100810 mutex_lock(&data->update_lock); \
Rudolf Marek08c79952006-07-05 18:14:31 +0200811 data->temp1_##reg = temp1_to_reg(val, -128000, 127000); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200812 w83627ehf_write_value(data, W83627EHF_REG_TEMP1_##REG, \
Jean Delvare08e7e272005-04-25 22:43:25 +0200813 data->temp1_##reg); \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100814 mutex_unlock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200815 return count; \
816}
817store_temp1_reg(OVER, max);
818store_temp1_reg(HYST, max_hyst);
819
Jean Delvare08e7e272005-04-25 22:43:25 +0200820#define show_temp_reg(reg) \
821static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +0100822show_##reg(struct device *dev, struct device_attribute *attr, \
823 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200824{ \
825 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Yuan Mu412fec82006-02-05 23:24:16 +0100826 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
827 int nr = sensor_attr->index; \
Jean Delvare08e7e272005-04-25 22:43:25 +0200828 return sprintf(buf, "%d\n", \
829 LM75_TEMP_FROM_REG(data->reg[nr])); \
830}
831show_temp_reg(temp);
832show_temp_reg(temp_max);
833show_temp_reg(temp_max_hyst);
834
835#define store_temp_reg(REG, reg) \
836static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +0100837store_##reg(struct device *dev, struct device_attribute *attr, \
838 const char *buf, size_t count) \
Jean Delvare08e7e272005-04-25 22:43:25 +0200839{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200840 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Yuan Mu412fec82006-02-05 23:24:16 +0100841 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
842 int nr = sensor_attr->index; \
Christian Hohnstaedt5bfedac2007-08-16 11:40:10 +0200843 long val = simple_strtol(buf, NULL, 10); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200844 \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100845 mutex_lock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200846 data->reg[nr] = LM75_TEMP_TO_REG(val); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200847 w83627ehf_write_value(data, W83627EHF_REG_TEMP_##REG[nr], \
Jean Delvare08e7e272005-04-25 22:43:25 +0200848 data->reg[nr]); \
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100849 mutex_unlock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +0200850 return count; \
851}
852store_temp_reg(OVER, temp_max);
853store_temp_reg(HYST, temp_max_hyst);
854
Jean Delvareda667362007-06-24 11:21:02 +0200855static ssize_t
856show_temp_type(struct device *dev, struct device_attribute *attr, char *buf)
857{
858 struct w83627ehf_data *data = w83627ehf_update_device(dev);
859 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
860 int nr = sensor_attr->index;
861 return sprintf(buf, "%d\n", (int)data->temp_type[nr]);
862}
863
Yuan Mu412fec82006-02-05 23:24:16 +0100864static struct sensor_device_attribute sda_temp[] = {
865 SENSOR_ATTR(temp1_input, S_IRUGO, show_temp1, NULL, 0),
866 SENSOR_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 0),
867 SENSOR_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 1),
868 SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp1_max,
869 store_temp1_max, 0),
870 SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
871 store_temp_max, 0),
872 SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
873 store_temp_max, 1),
874 SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp1_max_hyst,
875 store_temp1_max_hyst, 0),
876 SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
877 store_temp_max_hyst, 0),
878 SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
879 store_temp_max_hyst, 1),
Jean Delvarea4589db2006-03-23 16:30:29 +0100880 SENSOR_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4),
881 SENSOR_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5),
882 SENSOR_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13),
Jean Delvareda667362007-06-24 11:21:02 +0200883 SENSOR_ATTR(temp1_type, S_IRUGO, show_temp_type, NULL, 0),
884 SENSOR_ATTR(temp2_type, S_IRUGO, show_temp_type, NULL, 1),
885 SENSOR_ATTR(temp3_type, S_IRUGO, show_temp_type, NULL, 2),
Yuan Mu412fec82006-02-05 23:24:16 +0100886};
Jean Delvare08e7e272005-04-25 22:43:25 +0200887
Rudolf Marek08c79952006-07-05 18:14:31 +0200888#define show_pwm_reg(reg) \
889static ssize_t show_##reg (struct device *dev, struct device_attribute *attr, \
890 char *buf) \
891{ \
892 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
893 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
894 int nr = sensor_attr->index; \
895 return sprintf(buf, "%d\n", data->reg[nr]); \
896}
897
898show_pwm_reg(pwm_mode)
899show_pwm_reg(pwm_enable)
900show_pwm_reg(pwm)
901
902static ssize_t
903store_pwm_mode(struct device *dev, struct device_attribute *attr,
904 const char *buf, size_t count)
905{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200906 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200907 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
908 int nr = sensor_attr->index;
909 u32 val = simple_strtoul(buf, NULL, 10);
910 u16 reg;
911
912 if (val > 1)
913 return -EINVAL;
914 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200915 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +0200916 data->pwm_mode[nr] = val;
917 reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
918 if (!val)
919 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
David Hubbard1ea6dd32007-06-24 11:16:15 +0200920 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +0200921 mutex_unlock(&data->update_lock);
922 return count;
923}
924
925static ssize_t
926store_pwm(struct device *dev, struct device_attribute *attr,
927 const char *buf, size_t count)
928{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200929 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200930 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
931 int nr = sensor_attr->index;
932 u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 0, 255);
933
934 mutex_lock(&data->update_lock);
935 data->pwm[nr] = val;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200936 w83627ehf_write_value(data, W83627EHF_REG_PWM[nr], val);
Rudolf Marek08c79952006-07-05 18:14:31 +0200937 mutex_unlock(&data->update_lock);
938 return count;
939}
940
941static ssize_t
942store_pwm_enable(struct device *dev, struct device_attribute *attr,
943 const char *buf, size_t count)
944{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200945 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200946 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
947 int nr = sensor_attr->index;
948 u32 val = simple_strtoul(buf, NULL, 10);
949 u16 reg;
950
951 if (!val || (val > 2)) /* only modes 1 and 2 are supported */
952 return -EINVAL;
953 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200954 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +0200955 data->pwm_enable[nr] = val;
956 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
957 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
David Hubbard1ea6dd32007-06-24 11:16:15 +0200958 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +0200959 mutex_unlock(&data->update_lock);
960 return count;
961}
962
963
964#define show_tol_temp(reg) \
965static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
966 char *buf) \
967{ \
968 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
969 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
970 int nr = sensor_attr->index; \
971 return sprintf(buf, "%d\n", temp1_from_reg(data->reg[nr])); \
972}
973
974show_tol_temp(tolerance)
975show_tol_temp(target_temp)
976
977static ssize_t
978store_target_temp(struct device *dev, struct device_attribute *attr,
979 const char *buf, size_t count)
980{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200981 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200982 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
983 int nr = sensor_attr->index;
984 u8 val = temp1_to_reg(simple_strtoul(buf, NULL, 10), 0, 127000);
985
986 mutex_lock(&data->update_lock);
987 data->target_temp[nr] = val;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200988 w83627ehf_write_value(data, W83627EHF_REG_TARGET[nr], val);
Rudolf Marek08c79952006-07-05 18:14:31 +0200989 mutex_unlock(&data->update_lock);
990 return count;
991}
992
993static ssize_t
994store_tolerance(struct device *dev, struct device_attribute *attr,
995 const char *buf, size_t count)
996{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200997 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +0200998 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
999 int nr = sensor_attr->index;
1000 u16 reg;
1001 /* Limit the temp to 0C - 15C */
1002 u8 val = temp1_to_reg(simple_strtoul(buf, NULL, 10), 0, 15000);
1003
1004 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001005 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +02001006 data->tolerance[nr] = val;
1007 if (nr == 1)
1008 reg = (reg & 0x0f) | (val << 4);
1009 else
1010 reg = (reg & 0xf0) | val;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001011 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +02001012 mutex_unlock(&data->update_lock);
1013 return count;
1014}
1015
1016static struct sensor_device_attribute sda_pwm[] = {
1017 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
1018 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
1019 SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
1020 SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
1021};
1022
1023static struct sensor_device_attribute sda_pwm_mode[] = {
1024 SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1025 store_pwm_mode, 0),
1026 SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1027 store_pwm_mode, 1),
1028 SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1029 store_pwm_mode, 2),
1030 SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1031 store_pwm_mode, 3),
1032};
1033
1034static struct sensor_device_attribute sda_pwm_enable[] = {
1035 SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1036 store_pwm_enable, 0),
1037 SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1038 store_pwm_enable, 1),
1039 SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1040 store_pwm_enable, 2),
1041 SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1042 store_pwm_enable, 3),
1043};
1044
1045static struct sensor_device_attribute sda_target_temp[] = {
1046 SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1047 store_target_temp, 0),
1048 SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1049 store_target_temp, 1),
1050 SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1051 store_target_temp, 2),
1052 SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1053 store_target_temp, 3),
1054};
1055
1056static struct sensor_device_attribute sda_tolerance[] = {
1057 SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1058 store_tolerance, 0),
1059 SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1060 store_tolerance, 1),
1061 SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1062 store_tolerance, 2),
1063 SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1064 store_tolerance, 3),
1065};
1066
Rudolf Marek08c79952006-07-05 18:14:31 +02001067/* Smart Fan registers */
1068
1069#define fan_functions(reg, REG) \
1070static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1071 char *buf) \
1072{ \
1073 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1074 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1075 int nr = sensor_attr->index; \
1076 return sprintf(buf, "%d\n", data->reg[nr]); \
1077}\
1078static ssize_t \
1079store_##reg(struct device *dev, struct device_attribute *attr, \
1080 const char *buf, size_t count) \
1081{\
David Hubbard1ea6dd32007-06-24 11:16:15 +02001082 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001083 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1084 int nr = sensor_attr->index; \
1085 u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 1, 255); \
1086 mutex_lock(&data->update_lock); \
1087 data->reg[nr] = val; \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001088 w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001089 mutex_unlock(&data->update_lock); \
1090 return count; \
1091}
1092
1093fan_functions(fan_min_output, FAN_MIN_OUTPUT)
1094
1095#define fan_time_functions(reg, REG) \
1096static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1097 char *buf) \
1098{ \
1099 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1100 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1101 int nr = sensor_attr->index; \
1102 return sprintf(buf, "%d\n", \
1103 step_time_from_reg(data->reg[nr], data->pwm_mode[nr])); \
1104} \
1105\
1106static ssize_t \
1107store_##reg(struct device *dev, struct device_attribute *attr, \
1108 const char *buf, size_t count) \
1109{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001110 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001111 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); \
1112 int nr = sensor_attr->index; \
1113 u8 val = step_time_to_reg(simple_strtoul(buf, NULL, 10), \
1114 data->pwm_mode[nr]); \
1115 mutex_lock(&data->update_lock); \
1116 data->reg[nr] = val; \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001117 w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001118 mutex_unlock(&data->update_lock); \
1119 return count; \
1120} \
1121
1122fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1123
David Hubbard1ea6dd32007-06-24 11:16:15 +02001124static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1125 char *buf)
1126{
1127 struct w83627ehf_data *data = dev_get_drvdata(dev);
1128
1129 return sprintf(buf, "%s\n", data->name);
1130}
1131static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
Rudolf Marek08c79952006-07-05 18:14:31 +02001132
1133static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1134 SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1135 store_fan_stop_time, 3),
1136 SENSOR_ATTR(pwm4_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1137 store_fan_min_output, 3),
1138};
1139
1140static struct sensor_device_attribute sda_sf3_arrays[] = {
1141 SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1142 store_fan_stop_time, 0),
1143 SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1144 store_fan_stop_time, 1),
1145 SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1146 store_fan_stop_time, 2),
1147 SENSOR_ATTR(pwm1_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1148 store_fan_min_output, 0),
1149 SENSOR_ATTR(pwm2_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1150 store_fan_min_output, 1),
1151 SENSOR_ATTR(pwm3_min_output, S_IWUSR | S_IRUGO, show_fan_min_output,
1152 store_fan_min_output, 2),
1153};
1154
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001155static ssize_t
1156show_vid(struct device *dev, struct device_attribute *attr, char *buf)
1157{
1158 struct w83627ehf_data *data = dev_get_drvdata(dev);
1159 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1160}
1161static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
1162
Jean Delvare08e7e272005-04-25 22:43:25 +02001163/*
David Hubbard1ea6dd32007-06-24 11:16:15 +02001164 * Driver and device management
Jean Delvare08e7e272005-04-25 22:43:25 +02001165 */
1166
David Hubbardc18beb52006-09-24 21:04:38 +02001167static void w83627ehf_device_remove_files(struct device *dev)
1168{
1169 /* some entries in the following arrays may not have been used in
1170 * device_create_file(), but device_remove_file() will ignore them */
1171 int i;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001172 struct w83627ehf_data *data = dev_get_drvdata(dev);
David Hubbardc18beb52006-09-24 21:04:38 +02001173
1174 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1175 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
1176 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1177 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001178 for (i = 0; i < data->in_num; i++) {
David Hubbardc18beb52006-09-24 21:04:38 +02001179 device_remove_file(dev, &sda_in_input[i].dev_attr);
1180 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1181 device_remove_file(dev, &sda_in_min[i].dev_attr);
1182 device_remove_file(dev, &sda_in_max[i].dev_attr);
1183 }
1184 for (i = 0; i < 5; i++) {
1185 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1186 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1187 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1188 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1189 }
1190 for (i = 0; i < 4; i++) {
1191 device_remove_file(dev, &sda_pwm[i].dev_attr);
1192 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1193 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1194 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1195 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1196 }
1197 for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
1198 device_remove_file(dev, &sda_temp[i].dev_attr);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001199
1200 device_remove_file(dev, &dev_attr_name);
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001201 if (data->vid != 0x3f)
1202 device_remove_file(dev, &dev_attr_cpu0_vid);
David Hubbardc18beb52006-09-24 21:04:38 +02001203}
1204
David Hubbard1ea6dd32007-06-24 11:16:15 +02001205/* Get the monitoring functions started */
1206static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data)
Jean Delvare08e7e272005-04-25 22:43:25 +02001207{
1208 int i;
Jean Delvareda667362007-06-24 11:21:02 +02001209 u8 tmp, diode;
Jean Delvare08e7e272005-04-25 22:43:25 +02001210
1211 /* Start monitoring is needed */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001212 tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
Jean Delvare08e7e272005-04-25 22:43:25 +02001213 if (!(tmp & 0x01))
David Hubbard1ea6dd32007-06-24 11:16:15 +02001214 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
Jean Delvare08e7e272005-04-25 22:43:25 +02001215 tmp | 0x01);
1216
1217 /* Enable temp2 and temp3 if needed */
1218 for (i = 0; i < 2; i++) {
David Hubbard1ea6dd32007-06-24 11:16:15 +02001219 tmp = w83627ehf_read_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +02001220 W83627EHF_REG_TEMP_CONFIG[i]);
1221 if (tmp & 0x01)
David Hubbard1ea6dd32007-06-24 11:16:15 +02001222 w83627ehf_write_value(data,
Jean Delvare08e7e272005-04-25 22:43:25 +02001223 W83627EHF_REG_TEMP_CONFIG[i],
1224 tmp & 0xfe);
1225 }
Jean Delvared3130f02007-06-24 11:20:13 +02001226
1227 /* Enable VBAT monitoring if needed */
1228 tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
1229 if (!(tmp & 0x01))
1230 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01);
Jean Delvareda667362007-06-24 11:21:02 +02001231
1232 /* Get thermal sensor types */
1233 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
1234 for (i = 0; i < 3; i++) {
1235 if ((tmp & (0x02 << i)))
1236 data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 2;
1237 else
1238 data->temp_type[i] = 4; /* thermistor */
1239 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001240}
1241
David Hubbard1ea6dd32007-06-24 11:16:15 +02001242static int __devinit w83627ehf_probe(struct platform_device *pdev)
Jean Delvare08e7e272005-04-25 22:43:25 +02001243{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001244 struct device *dev = &pdev->dev;
1245 struct w83627ehf_sio_data *sio_data = dev->platform_data;
Jean Delvare08e7e272005-04-25 22:43:25 +02001246 struct w83627ehf_data *data;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001247 struct resource *res;
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001248 u8 fan4pin, fan5pin, en_vrm10;
Jean Delvare08e7e272005-04-25 22:43:25 +02001249 int i, err = 0;
1250
David Hubbard1ea6dd32007-06-24 11:16:15 +02001251 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1252 if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001253 err = -EBUSY;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001254 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1255 (unsigned long)res->start,
1256 (unsigned long)res->start + IOREGION_LENGTH - 1);
Jean Delvare08e7e272005-04-25 22:43:25 +02001257 goto exit;
1258 }
1259
Deepak Saxenaba9c2e82005-10-17 23:08:32 +02001260 if (!(data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL))) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001261 err = -ENOMEM;
1262 goto exit_release;
1263 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001264
David Hubbard1ea6dd32007-06-24 11:16:15 +02001265 data->addr = res->start;
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001266 mutex_init(&data->lock);
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001267 mutex_init(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001268 data->name = w83627ehf_device_names[sio_data->kind];
1269 platform_set_drvdata(pdev, data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001270
David Hubbard1ea6dd32007-06-24 11:16:15 +02001271 /* 627EHG and 627EHF have 10 voltage inputs; DHG has 9 */
1272 data->in_num = (sio_data->kind == w83627dhg) ? 9 : 10;
Jean Delvare08e7e272005-04-25 22:43:25 +02001273
1274 /* Initialize the chip */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001275 w83627ehf_init_device(data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001276
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001277 data->vrm = vid_which_vrm();
1278 superio_enter(sio_data->sioreg);
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001279 /* Read VID value */
1280 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
Jean Delvare58e6e782008-01-03 07:33:31 -05001281 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) {
1282 /* Set VID input sensibility if needed. In theory the BIOS
1283 should have set it, but in practice it's not always the
1284 case. We only do it for the W83627EHF/EHG because the
1285 W83627DHG is more complex in this respect. */
1286 if (sio_data->kind == w83627ehf) {
1287 en_vrm10 = superio_inb(sio_data->sioreg,
1288 SIO_REG_EN_VRM10);
1289 if ((en_vrm10 & 0x08) && data->vrm == 90) {
1290 dev_warn(dev, "Setting VID input voltage to "
1291 "TTL\n");
1292 superio_outb(sio_data->sioreg, SIO_REG_EN_VRM10,
1293 en_vrm10 & ~0x08);
1294 } else if (!(en_vrm10 & 0x08) && data->vrm == 100) {
1295 dev_warn(dev, "Setting VID input voltage to "
1296 "VRM10\n");
1297 superio_outb(sio_data->sioreg, SIO_REG_EN_VRM10,
1298 en_vrm10 | 0x08);
1299 }
1300 }
1301
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001302 data->vid = superio_inb(sio_data->sioreg, SIO_REG_VID_DATA) & 0x3f;
Jean Delvare58e6e782008-01-03 07:33:31 -05001303 } else {
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001304 dev_info(dev, "VID pins in output mode, CPU VID not "
1305 "available\n");
1306 data->vid = 0x3f;
1307 }
1308
Rudolf Marek08c79952006-07-05 18:14:31 +02001309 /* fan4 and fan5 share some pins with the GPIO and serial flash */
1310
David Hubbard1ea6dd32007-06-24 11:16:15 +02001311 fan5pin = superio_inb(sio_data->sioreg, 0x24) & 0x2;
1312 fan4pin = superio_inb(sio_data->sioreg, 0x29) & 0x6;
1313 superio_exit(sio_data->sioreg);
Rudolf Marek08c79952006-07-05 18:14:31 +02001314
Jean Delvare08e7e272005-04-25 22:43:25 +02001315 /* It looks like fan4 and fan5 pins can be alternatively used
Rudolf Marek14992c72006-10-08 22:02:09 +02001316 as fan on/off switches, but fan5 control is write only :/
1317 We assume that if the serial interface is disabled, designers
1318 connected fan5 as input unless they are emitting log 1, which
1319 is not the default. */
Rudolf Marek08c79952006-07-05 18:14:31 +02001320
Jean Delvare08e7e272005-04-25 22:43:25 +02001321 data->has_fan = 0x07; /* fan1, fan2 and fan3 */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001322 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
Rudolf Marek08c79952006-07-05 18:14:31 +02001323 if ((i & (1 << 2)) && (!fan4pin))
Jean Delvare08e7e272005-04-25 22:43:25 +02001324 data->has_fan |= (1 << 3);
Rudolf Marek14992c72006-10-08 22:02:09 +02001325 if (!(i & (1 << 1)) && (!fan5pin))
Jean Delvare08e7e272005-04-25 22:43:25 +02001326 data->has_fan |= (1 << 4);
1327
Mark M. Hoffmanea7be662007-08-05 12:19:01 -04001328 /* Read fan clock dividers immediately */
1329 w83627ehf_update_fan_div(data);
1330
Jean Delvare08e7e272005-04-25 22:43:25 +02001331 /* Register sysfs hooks */
Rudolf Marek08c79952006-07-05 18:14:31 +02001332 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
David Hubbardc18beb52006-09-24 21:04:38 +02001333 if ((err = device_create_file(dev,
1334 &sda_sf3_arrays[i].dev_attr)))
1335 goto exit_remove;
Rudolf Marek08c79952006-07-05 18:14:31 +02001336
1337 /* if fan4 is enabled create the sf3 files for it */
1338 if (data->has_fan & (1 << 3))
David Hubbardc18beb52006-09-24 21:04:38 +02001339 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
1340 if ((err = device_create_file(dev,
1341 &sda_sf3_arrays_fan4[i].dev_attr)))
1342 goto exit_remove;
1343 }
Rudolf Marek08c79952006-07-05 18:14:31 +02001344
David Hubbard1ea6dd32007-06-24 11:16:15 +02001345 for (i = 0; i < data->in_num; i++)
David Hubbardc18beb52006-09-24 21:04:38 +02001346 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
1347 || (err = device_create_file(dev,
1348 &sda_in_alarm[i].dev_attr))
1349 || (err = device_create_file(dev,
1350 &sda_in_min[i].dev_attr))
1351 || (err = device_create_file(dev,
1352 &sda_in_max[i].dev_attr)))
1353 goto exit_remove;
Rudolf Marekcf0676f2006-03-23 16:25:22 +01001354
Yuan Mu412fec82006-02-05 23:24:16 +01001355 for (i = 0; i < 5; i++) {
Rudolf Marek08c79952006-07-05 18:14:31 +02001356 if (data->has_fan & (1 << i)) {
David Hubbardc18beb52006-09-24 21:04:38 +02001357 if ((err = device_create_file(dev,
1358 &sda_fan_input[i].dev_attr))
1359 || (err = device_create_file(dev,
1360 &sda_fan_alarm[i].dev_attr))
1361 || (err = device_create_file(dev,
1362 &sda_fan_div[i].dev_attr))
1363 || (err = device_create_file(dev,
1364 &sda_fan_min[i].dev_attr)))
1365 goto exit_remove;
1366 if (i < 4 && /* w83627ehf only has 4 pwm */
1367 ((err = device_create_file(dev,
1368 &sda_pwm[i].dev_attr))
1369 || (err = device_create_file(dev,
1370 &sda_pwm_mode[i].dev_attr))
1371 || (err = device_create_file(dev,
1372 &sda_pwm_enable[i].dev_attr))
1373 || (err = device_create_file(dev,
1374 &sda_target_temp[i].dev_attr))
1375 || (err = device_create_file(dev,
1376 &sda_tolerance[i].dev_attr))))
1377 goto exit_remove;
Rudolf Marek08c79952006-07-05 18:14:31 +02001378 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001379 }
Rudolf Marek08c79952006-07-05 18:14:31 +02001380
Yuan Mu412fec82006-02-05 23:24:16 +01001381 for (i = 0; i < ARRAY_SIZE(sda_temp); i++)
David Hubbardc18beb52006-09-24 21:04:38 +02001382 if ((err = device_create_file(dev, &sda_temp[i].dev_attr)))
1383 goto exit_remove;
1384
David Hubbard1ea6dd32007-06-24 11:16:15 +02001385 err = device_create_file(dev, &dev_attr_name);
1386 if (err)
1387 goto exit_remove;
1388
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001389 if (data->vid != 0x3f) {
1390 err = device_create_file(dev, &dev_attr_cpu0_vid);
1391 if (err)
1392 goto exit_remove;
1393 }
1394
Tony Jones1beeffe2007-08-20 13:46:20 -07001395 data->hwmon_dev = hwmon_device_register(dev);
1396 if (IS_ERR(data->hwmon_dev)) {
1397 err = PTR_ERR(data->hwmon_dev);
David Hubbardc18beb52006-09-24 21:04:38 +02001398 goto exit_remove;
1399 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001400
1401 return 0;
1402
David Hubbardc18beb52006-09-24 21:04:38 +02001403exit_remove:
1404 w83627ehf_device_remove_files(dev);
Jean Delvare08e7e272005-04-25 22:43:25 +02001405 kfree(data);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001406 platform_set_drvdata(pdev, NULL);
Jean Delvare08e7e272005-04-25 22:43:25 +02001407exit_release:
David Hubbard1ea6dd32007-06-24 11:16:15 +02001408 release_region(res->start, IOREGION_LENGTH);
Jean Delvare08e7e272005-04-25 22:43:25 +02001409exit:
1410 return err;
1411}
1412
David Hubbard1ea6dd32007-06-24 11:16:15 +02001413static int __devexit w83627ehf_remove(struct platform_device *pdev)
Jean Delvare08e7e272005-04-25 22:43:25 +02001414{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001415 struct w83627ehf_data *data = platform_get_drvdata(pdev);
Jean Delvare08e7e272005-04-25 22:43:25 +02001416
Tony Jones1beeffe2007-08-20 13:46:20 -07001417 hwmon_device_unregister(data->hwmon_dev);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001418 w83627ehf_device_remove_files(&pdev->dev);
1419 release_region(data->addr, IOREGION_LENGTH);
1420 platform_set_drvdata(pdev, NULL);
Mark M. Hoffman943b0832005-07-15 21:39:18 -04001421 kfree(data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001422
1423 return 0;
1424}
1425
David Hubbard1ea6dd32007-06-24 11:16:15 +02001426static struct platform_driver w83627ehf_driver = {
Laurent Riffardcdaf7932005-11-26 20:37:41 +01001427 .driver = {
Jean Delvare87218842006-09-03 22:36:14 +02001428 .owner = THIS_MODULE,
David Hubbard1ea6dd32007-06-24 11:16:15 +02001429 .name = DRVNAME,
Laurent Riffardcdaf7932005-11-26 20:37:41 +01001430 },
David Hubbard1ea6dd32007-06-24 11:16:15 +02001431 .probe = w83627ehf_probe,
1432 .remove = __devexit_p(w83627ehf_remove),
Jean Delvare08e7e272005-04-25 22:43:25 +02001433};
1434
David Hubbard1ea6dd32007-06-24 11:16:15 +02001435/* w83627ehf_find() looks for a '627 in the Super-I/O config space */
1436static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
1437 struct w83627ehf_sio_data *sio_data)
Jean Delvare08e7e272005-04-25 22:43:25 +02001438{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001439 static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
1440 static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
1441 static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
1442
Jean Delvare08e7e272005-04-25 22:43:25 +02001443 u16 val;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001444 const char *sio_name;
Jean Delvare08e7e272005-04-25 22:43:25 +02001445
David Hubbard1ea6dd32007-06-24 11:16:15 +02001446 superio_enter(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02001447
David Hubbard1ea6dd32007-06-24 11:16:15 +02001448 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
1449 | superio_inb(sioaddr, SIO_REG_DEVID + 1);
David Hubbard657c93b2007-02-14 21:15:04 +01001450 switch (val & SIO_ID_MASK) {
David Hubbard657c93b2007-02-14 21:15:04 +01001451 case SIO_W83627EHF_ID:
David Hubbard1ea6dd32007-06-24 11:16:15 +02001452 sio_data->kind = w83627ehf;
1453 sio_name = sio_name_W83627EHF;
1454 break;
David Hubbard657c93b2007-02-14 21:15:04 +01001455 case SIO_W83627EHG_ID:
David Hubbard1ea6dd32007-06-24 11:16:15 +02001456 sio_data->kind = w83627ehf;
1457 sio_name = sio_name_W83627EHG;
1458 break;
1459 case SIO_W83627DHG_ID:
1460 sio_data->kind = w83627dhg;
1461 sio_name = sio_name_W83627DHG;
David Hubbard657c93b2007-02-14 21:15:04 +01001462 break;
1463 default:
Jean Delvare9f660362007-06-24 11:23:41 +02001464 if (val != 0xffff)
1465 pr_debug(DRVNAME ": unsupported chip ID: 0x%04x\n",
1466 val);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001467 superio_exit(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02001468 return -ENODEV;
1469 }
1470
David Hubbard1ea6dd32007-06-24 11:16:15 +02001471 /* We have a known chip, find the HWM I/O address */
1472 superio_select(sioaddr, W83627EHF_LD_HWM);
1473 val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
1474 | superio_inb(sioaddr, SIO_REG_ADDR + 1);
Jean Delvare1a641fc2007-04-23 14:41:16 -07001475 *addr = val & IOREGION_ALIGNMENT;
Jean Delvare2d8672c2005-07-19 23:56:35 +02001476 if (*addr == 0) {
David Hubbard475ef852007-06-24 11:17:09 +02001477 printk(KERN_ERR DRVNAME ": Refusing to enable a Super-I/O "
1478 "device with a base I/O port 0.\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02001479 superio_exit(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02001480 return -ENODEV;
1481 }
1482
1483 /* Activate logical device if needed */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001484 val = superio_inb(sioaddr, SIO_REG_ENABLE);
David Hubbard475ef852007-06-24 11:17:09 +02001485 if (!(val & 0x01)) {
1486 printk(KERN_WARNING DRVNAME ": Forcibly enabling Super-I/O. "
1487 "Sensor is probably unusable.\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02001488 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
David Hubbard475ef852007-06-24 11:17:09 +02001489 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001490
David Hubbard1ea6dd32007-06-24 11:16:15 +02001491 superio_exit(sioaddr);
1492 pr_info(DRVNAME ": Found %s chip at %#x\n", sio_name, *addr);
1493 sio_data->sioreg = sioaddr;
1494
Jean Delvare08e7e272005-04-25 22:43:25 +02001495 return 0;
1496}
1497
David Hubbard1ea6dd32007-06-24 11:16:15 +02001498/* when Super-I/O functions move to a separate file, the Super-I/O
1499 * bus will manage the lifetime of the device and this module will only keep
1500 * track of the w83627ehf driver. But since we platform_device_alloc(), we
1501 * must keep track of the device */
1502static struct platform_device *pdev;
1503
Jean Delvare08e7e272005-04-25 22:43:25 +02001504static int __init sensors_w83627ehf_init(void)
1505{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001506 int err;
1507 unsigned short address;
1508 struct resource res;
1509 struct w83627ehf_sio_data sio_data;
1510
1511 /* initialize sio_data->kind and sio_data->sioreg.
1512 *
1513 * when Super-I/O functions move to a separate file, the Super-I/O
1514 * driver will probe 0x2e and 0x4e and auto-detect the presence of a
1515 * w83627ehf hardware monitor, and call probe() */
1516 if (w83627ehf_find(0x2e, &address, &sio_data) &&
1517 w83627ehf_find(0x4e, &address, &sio_data))
Jean Delvare08e7e272005-04-25 22:43:25 +02001518 return -ENODEV;
1519
David Hubbard1ea6dd32007-06-24 11:16:15 +02001520 err = platform_driver_register(&w83627ehf_driver);
1521 if (err)
1522 goto exit;
1523
1524 if (!(pdev = platform_device_alloc(DRVNAME, address))) {
1525 err = -ENOMEM;
1526 printk(KERN_ERR DRVNAME ": Device allocation failed\n");
1527 goto exit_unregister;
1528 }
1529
1530 err = platform_device_add_data(pdev, &sio_data,
1531 sizeof(struct w83627ehf_sio_data));
1532 if (err) {
1533 printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
1534 goto exit_device_put;
1535 }
1536
1537 memset(&res, 0, sizeof(res));
1538 res.name = DRVNAME;
1539 res.start = address + IOREGION_OFFSET;
1540 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
1541 res.flags = IORESOURCE_IO;
1542 err = platform_device_add_resources(pdev, &res, 1);
1543 if (err) {
1544 printk(KERN_ERR DRVNAME ": Device resource addition failed "
1545 "(%d)\n", err);
1546 goto exit_device_put;
1547 }
1548
1549 /* platform_device_add calls probe() */
1550 err = platform_device_add(pdev);
1551 if (err) {
1552 printk(KERN_ERR DRVNAME ": Device addition failed (%d)\n",
1553 err);
1554 goto exit_device_put;
1555 }
1556
1557 return 0;
1558
1559exit_device_put:
1560 platform_device_put(pdev);
1561exit_unregister:
1562 platform_driver_unregister(&w83627ehf_driver);
1563exit:
1564 return err;
Jean Delvare08e7e272005-04-25 22:43:25 +02001565}
1566
1567static void __exit sensors_w83627ehf_exit(void)
1568{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001569 platform_device_unregister(pdev);
1570 platform_driver_unregister(&w83627ehf_driver);
Jean Delvare08e7e272005-04-25 22:43:25 +02001571}
1572
1573MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
1574MODULE_DESCRIPTION("W83627EHF driver");
1575MODULE_LICENSE("GPL");
1576
1577module_init(sensors_w83627ehf_init);
1578module_exit(sensors_w83627ehf_exit);