blob: 93f5fc7d60596c3ab27c23c5794fccd4a53a40a5 [file] [log] [blame]
Jean Delvare08e7e272005-04-25 22:43:25 +02001/*
2 w83627ehf - Driver for the hardware monitoring functionality of
Guenter Roecke7e1ca62011-02-04 13:24:30 -08003 the Winbond W83627EHF Super-I/O chip
Jean Delvareeff76872011-11-04 12:00:48 +01004 Copyright (C) 2005-2011 Jean Delvare <khali@linux-fr.org>
Jean Delvare3379cee2006-09-24 21:25:52 +02005 Copyright (C) 2006 Yuan Mu (Winbond),
Guenter Roecke7e1ca62011-02-04 13:24:30 -08006 Rudolf Marek <r.marek@assembler.cz>
7 David Hubbard <david.c.hubbard@gmail.com>
Daniel J Blueman41e9a062009-12-14 18:01:37 -08008 Daniel J Blueman <daniel.blueman@gmail.com>
Guenter Roeckec3e5a12011-02-02 08:46:49 -08009 Copyright (C) 2010 Sheng-Yuan Huang (Nuvoton) (PS00)
Jean Delvare08e7e272005-04-25 22:43:25 +020010
11 Shamelessly ripped from the w83627hf driver
12 Copyright (C) 2003 Mark Studebaker
13
14 Thanks to Leon Moonen, Steve Cliffe and Grant Coady for their help
15 in testing and debugging this driver.
16
Jean Delvare8dd2d2c2005-07-27 21:33:15 +020017 This driver also supports the W83627EHG, which is the lead-free
18 version of the W83627EHF.
19
Jean Delvare08e7e272005-04-25 22:43:25 +020020 This program is free software; you can redistribute it and/or modify
21 it under the terms of the GNU General Public License as published by
22 the Free Software Foundation; either version 2 of the License, or
23 (at your option) any later version.
24
25 This program is distributed in the hope that it will be useful,
26 but WITHOUT ANY WARRANTY; without even the implied warranty of
27 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
28 GNU General Public License for more details.
29
30 You should have received a copy of the GNU General Public License
31 along with this program; if not, write to the Free Software
32 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
33
34
35 Supports the following chips:
36
David Hubbard657c93b2007-02-14 21:15:04 +010037 Chip #vin #fan #pwm #temp chip IDs man ID
38 w83627ehf 10 5 4 3 0x8850 0x88 0x5ca3
Guenter Roecke7e1ca62011-02-04 13:24:30 -080039 0x8860 0xa1
David Hubbard657c93b2007-02-14 21:15:04 +010040 w83627dhg 9 5 4 3 0xa020 0xc1 0x5ca3
Jean Delvarec1e48dc2009-06-15 18:39:50 +020041 w83627dhg-p 9 5 4 3 0xb070 0xc1 0x5ca3
Jean Delvareeff76872011-11-04 12:00:48 +010042 w83627uhg 8 2 2 2 0xa230 0xc1 0x5ca3
Gong Jun237c8d22009-03-30 21:46:42 +020043 w83667hg 9 5 3 3 0xa510 0xc1 0x5ca3
Guenter Roeckd36cf322011-02-07 15:08:54 -080044 w83667hg-b 9 5 3 4 0xb350 0xc1 0x5ca3
Guenter Roeckec3e5a12011-02-02 08:46:49 -080045 nct6775f 9 4 3 9 0xb470 0xc1 0x5ca3
46 nct6776f 9 5 3 9 0xC330 0xc1 0x5ca3
Jean Delvare08e7e272005-04-25 22:43:25 +020047*/
48
Joe Perchesabdc6fd2010-10-20 06:51:54 +000049#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
50
Jean Delvare08e7e272005-04-25 22:43:25 +020051#include <linux/module.h>
52#include <linux/init.h>
53#include <linux/slab.h>
David Hubbard1ea6dd32007-06-24 11:16:15 +020054#include <linux/jiffies.h>
55#include <linux/platform_device.h>
Mark M. Hoffman943b0832005-07-15 21:39:18 -040056#include <linux/hwmon.h>
Yuan Mu412fec82006-02-05 23:24:16 +010057#include <linux/hwmon-sysfs.h>
Jean Delvarefc18d6c2007-06-24 11:19:42 +020058#include <linux/hwmon-vid.h>
Mark M. Hoffman943b0832005-07-15 21:39:18 -040059#include <linux/err.h>
Ingo Molnar9a61bf62006-01-18 23:19:26 +010060#include <linux/mutex.h>
Jean Delvareb9acb642009-01-07 16:37:35 +010061#include <linux/acpi.h>
H Hartley Sweeten6055fae2009-09-15 17:18:13 +020062#include <linux/io.h>
Jean Delvare08e7e272005-04-25 22:43:25 +020063#include "lm75.h"
64
Jean Delvareeff76872011-11-04 12:00:48 +010065enum kinds {
66 w83627ehf, w83627dhg, w83627dhg_p, w83627uhg,
67 w83667hg, w83667hg_b, nct6775, nct6776,
68};
David Hubbard1ea6dd32007-06-24 11:16:15 +020069
70/* used to set data->name = w83627ehf_device_names[data->sio_kind] */
Guenter Roecke7e1ca62011-02-04 13:24:30 -080071static const char * const w83627ehf_device_names[] = {
David Hubbard1ea6dd32007-06-24 11:16:15 +020072 "w83627ehf",
73 "w83627dhg",
Jean Delvarec1e48dc2009-06-15 18:39:50 +020074 "w83627dhg",
Jean Delvareeff76872011-11-04 12:00:48 +010075 "w83627uhg",
Gong Jun237c8d22009-03-30 21:46:42 +020076 "w83667hg",
Guenter Roeckc39aeda2010-08-14 21:08:55 +020077 "w83667hg",
Guenter Roeckec3e5a12011-02-02 08:46:49 -080078 "nct6775",
79 "nct6776",
David Hubbard1ea6dd32007-06-24 11:16:15 +020080};
81
Jean Delvare67b671b2007-12-06 23:13:42 +010082static unsigned short force_id;
83module_param(force_id, ushort, 0);
84MODULE_PARM_DESC(force_id, "Override the detected device ID");
85
Ian Dobsond42e8692011-03-07 14:21:12 -080086static unsigned short fan_debounce;
87module_param(fan_debounce, ushort, 0);
88MODULE_PARM_DESC(fan_debounce, "Enable debouncing for fan RPM signal");
89
David Hubbard1ea6dd32007-06-24 11:16:15 +020090#define DRVNAME "w83627ehf"
Jean Delvare08e7e272005-04-25 22:43:25 +020091
92/*
93 * Super-I/O constants and functions
94 */
95
Jean Delvare08e7e272005-04-25 22:43:25 +020096#define W83627EHF_LD_HWM 0x0b
Guenter Roecke7e1ca62011-02-04 13:24:30 -080097#define W83667HG_LD_VID 0x0d
Jean Delvare08e7e272005-04-25 22:43:25 +020098
99#define SIO_REG_LDSEL 0x07 /* Logical device select */
100#define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */
Jean Delvarefc18d6c2007-06-24 11:19:42 +0200101#define SIO_REG_EN_VRM10 0x2C /* GPIO3, GPIO4 selection */
Jean Delvare08e7e272005-04-25 22:43:25 +0200102#define SIO_REG_ENABLE 0x30 /* Logical device enable */
103#define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
Jean Delvarefc18d6c2007-06-24 11:19:42 +0200104#define SIO_REG_VID_CTRL 0xF0 /* VID control */
105#define SIO_REG_VID_DATA 0xF1 /* VID data */
Jean Delvare08e7e272005-04-25 22:43:25 +0200106
David Hubbard657c93b2007-02-14 21:15:04 +0100107#define SIO_W83627EHF_ID 0x8850
108#define SIO_W83627EHG_ID 0x8860
109#define SIO_W83627DHG_ID 0xa020
Jean Delvarec1e48dc2009-06-15 18:39:50 +0200110#define SIO_W83627DHG_P_ID 0xb070
Jean Delvareeff76872011-11-04 12:00:48 +0100111#define SIO_W83627UHG_ID 0xa230
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800112#define SIO_W83667HG_ID 0xa510
Guenter Roeckc39aeda2010-08-14 21:08:55 +0200113#define SIO_W83667HG_B_ID 0xb350
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800114#define SIO_NCT6775_ID 0xb470
115#define SIO_NCT6776_ID 0xc330
David Hubbard657c93b2007-02-14 21:15:04 +0100116#define SIO_ID_MASK 0xFFF0
Jean Delvare08e7e272005-04-25 22:43:25 +0200117
118static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +0200119superio_outb(int ioreg, int reg, int val)
Jean Delvare08e7e272005-04-25 22:43:25 +0200120{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200121 outb(reg, ioreg);
122 outb(val, ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +0200123}
124
125static inline int
David Hubbard1ea6dd32007-06-24 11:16:15 +0200126superio_inb(int ioreg, int reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200127{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200128 outb(reg, ioreg);
129 return inb(ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +0200130}
131
132static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +0200133superio_select(int ioreg, int ld)
Jean Delvare08e7e272005-04-25 22:43:25 +0200134{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200135 outb(SIO_REG_LDSEL, ioreg);
136 outb(ld, ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +0200137}
138
139static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +0200140superio_enter(int ioreg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200141{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200142 outb(0x87, ioreg);
143 outb(0x87, ioreg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200144}
145
146static inline void
David Hubbard1ea6dd32007-06-24 11:16:15 +0200147superio_exit(int ioreg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200148{
Jonas Jonsson022b75a2010-09-17 17:24:13 +0200149 outb(0xaa, ioreg);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200150 outb(0x02, ioreg);
151 outb(0x02, ioreg + 1);
Jean Delvare08e7e272005-04-25 22:43:25 +0200152}
153
154/*
155 * ISA constants
156 */
157
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800158#define IOREGION_ALIGNMENT (~7)
Jean Delvare1a641fc2007-04-23 14:41:16 -0700159#define IOREGION_OFFSET 5
160#define IOREGION_LENGTH 2
David Hubbard1ea6dd32007-06-24 11:16:15 +0200161#define ADDR_REG_OFFSET 0
162#define DATA_REG_OFFSET 1
Jean Delvare08e7e272005-04-25 22:43:25 +0200163
164#define W83627EHF_REG_BANK 0x4E
165#define W83627EHF_REG_CONFIG 0x40
David Hubbard657c93b2007-02-14 21:15:04 +0100166
167/* Not currently used:
168 * REG_MAN_ID has the value 0x5ca3 for all supported chips.
169 * REG_CHIP_ID == 0x88/0xa1/0xc1 depending on chip model.
170 * REG_MAN_ID is at port 0x4f
171 * REG_CHIP_ID is at port 0x58 */
Jean Delvare08e7e272005-04-25 22:43:25 +0200172
173static const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 };
174static const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c };
175
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100176/* The W83627EHF registers for nr=7,8,9 are in bank 5 */
177#define W83627EHF_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
178 (0x554 + (((nr) - 7) * 2)))
179#define W83627EHF_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
180 (0x555 + (((nr) - 7) * 2)))
181#define W83627EHF_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \
182 (0x550 + (nr) - 7))
183
Guenter Roeckd36cf322011-02-07 15:08:54 -0800184static const u16 W83627EHF_REG_TEMP[] = { 0x27, 0x150, 0x250, 0x7e };
185static const u16 W83627EHF_REG_TEMP_HYST[] = { 0x3a, 0x153, 0x253, 0 };
186static const u16 W83627EHF_REG_TEMP_OVER[] = { 0x39, 0x155, 0x255, 0 };
187static const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0, 0x152, 0x252, 0 };
Jean Delvare08e7e272005-04-25 22:43:25 +0200188
189/* Fan clock dividers are spread over the following five registers */
190#define W83627EHF_REG_FANDIV1 0x47
191#define W83627EHF_REG_FANDIV2 0x4B
192#define W83627EHF_REG_VBAT 0x5D
193#define W83627EHF_REG_DIODE 0x59
194#define W83627EHF_REG_SMI_OVT 0x4C
195
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800196/* NCT6775F has its own fan divider registers */
197#define NCT6775_REG_FANDIV1 0x506
198#define NCT6775_REG_FANDIV2 0x507
Ian Dobsond42e8692011-03-07 14:21:12 -0800199#define NCT6775_REG_FAN_DEBOUNCE 0xf0
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800200
Jean Delvarea4589db2006-03-23 16:30:29 +0100201#define W83627EHF_REG_ALARM1 0x459
202#define W83627EHF_REG_ALARM2 0x45A
203#define W83627EHF_REG_ALARM3 0x45B
204
Dmitry Artamonow363a12a2011-08-12 16:41:11 -0400205#define W83627EHF_REG_CASEOPEN_DET 0x42 /* SMI STATUS #2 */
206#define W83627EHF_REG_CASEOPEN_CLR 0x46 /* SMI MASK #3 */
207
Rudolf Marek08c79952006-07-05 18:14:31 +0200208/* SmartFan registers */
Daniel J Blueman41e9a062009-12-14 18:01:37 -0800209#define W83627EHF_REG_FAN_STEPUP_TIME 0x0f
210#define W83627EHF_REG_FAN_STEPDOWN_TIME 0x0e
211
Rudolf Marek08c79952006-07-05 18:14:31 +0200212/* DC or PWM output fan configuration */
213static const u8 W83627EHF_REG_PWM_ENABLE[] = {
214 0x04, /* SYS FAN0 output mode and PWM mode */
215 0x04, /* CPU FAN0 output mode and PWM mode */
216 0x12, /* AUX FAN mode */
Daniel J Blueman41e9a062009-12-14 18:01:37 -0800217 0x62, /* CPU FAN1 mode */
Rudolf Marek08c79952006-07-05 18:14:31 +0200218};
219
220static const u8 W83627EHF_PWM_MODE_SHIFT[] = { 0, 1, 0, 6 };
221static const u8 W83627EHF_PWM_ENABLE_SHIFT[] = { 2, 4, 1, 4 };
222
223/* FAN Duty Cycle, be used to control */
Guenter Roeck279af1a2011-02-13 22:34:47 -0800224static const u16 W83627EHF_REG_PWM[] = { 0x01, 0x03, 0x11, 0x61 };
225static const u16 W83627EHF_REG_TARGET[] = { 0x05, 0x06, 0x13, 0x63 };
Rudolf Marek08c79952006-07-05 18:14:31 +0200226static const u8 W83627EHF_REG_TOLERANCE[] = { 0x07, 0x07, 0x14, 0x62 };
227
Rudolf Marek08c79952006-07-05 18:14:31 +0200228/* Advanced Fan control, some values are common for all fans */
Guenter Roeck279af1a2011-02-13 22:34:47 -0800229static const u16 W83627EHF_REG_FAN_START_OUTPUT[] = { 0x0a, 0x0b, 0x16, 0x65 };
230static const u16 W83627EHF_REG_FAN_STOP_OUTPUT[] = { 0x08, 0x09, 0x15, 0x64 };
231static const u16 W83627EHF_REG_FAN_STOP_TIME[] = { 0x0c, 0x0d, 0x17, 0x66 };
Guenter Roeckc39aeda2010-08-14 21:08:55 +0200232
Guenter Roeck279af1a2011-02-13 22:34:47 -0800233static const u16 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON[]
Guenter Roeckc39aeda2010-08-14 21:08:55 +0200234 = { 0xff, 0x67, 0xff, 0x69 };
Guenter Roeck279af1a2011-02-13 22:34:47 -0800235static const u16 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON[]
Guenter Roeckc39aeda2010-08-14 21:08:55 +0200236 = { 0xff, 0x68, 0xff, 0x6a };
237
Guenter Roeck279af1a2011-02-13 22:34:47 -0800238static const u16 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B[] = { 0x67, 0x69, 0x6b };
239static const u16 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B[]
240 = { 0x68, 0x6a, 0x6c };
Rudolf Marek08c79952006-07-05 18:14:31 +0200241
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800242static const u16 NCT6775_REG_TARGET[] = { 0x101, 0x201, 0x301 };
243static const u16 NCT6775_REG_FAN_MODE[] = { 0x102, 0x202, 0x302 };
244static const u16 NCT6775_REG_FAN_STOP_OUTPUT[] = { 0x105, 0x205, 0x305 };
245static const u16 NCT6775_REG_FAN_START_OUTPUT[] = { 0x106, 0x206, 0x306 };
246static const u16 NCT6775_REG_FAN_STOP_TIME[] = { 0x107, 0x207, 0x307 };
247static const u16 NCT6775_REG_PWM[] = { 0x109, 0x209, 0x309 };
248static const u16 NCT6775_REG_FAN_MAX_OUTPUT[] = { 0x10a, 0x20a, 0x30a };
249static const u16 NCT6775_REG_FAN_STEP_OUTPUT[] = { 0x10b, 0x20b, 0x30b };
Guenter Roeck26bc4402011-02-11 08:00:58 -0800250static const u16 NCT6775_REG_FAN[] = { 0x630, 0x632, 0x634, 0x636, 0x638 };
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800251static const u16 NCT6776_REG_FAN_MIN[] = { 0x63a, 0x63c, 0x63e, 0x640, 0x642};
252
253static const u16 NCT6775_REG_TEMP[]
254 = { 0x27, 0x150, 0x250, 0x73, 0x75, 0x77, 0x62b, 0x62c, 0x62d };
255static const u16 NCT6775_REG_TEMP_CONFIG[]
256 = { 0, 0x152, 0x252, 0, 0, 0, 0x628, 0x629, 0x62A };
257static const u16 NCT6775_REG_TEMP_HYST[]
258 = { 0x3a, 0x153, 0x253, 0, 0, 0, 0x673, 0x678, 0x67D };
259static const u16 NCT6775_REG_TEMP_OVER[]
260 = { 0x39, 0x155, 0x255, 0, 0, 0, 0x672, 0x677, 0x67C };
261static const u16 NCT6775_REG_TEMP_SOURCE[]
262 = { 0x621, 0x622, 0x623, 0x100, 0x200, 0x300, 0x624, 0x625, 0x626 };
263
Guenter Roeckd36cf322011-02-07 15:08:54 -0800264static const char *const w83667hg_b_temp_label[] = {
265 "SYSTIN",
266 "CPUTIN",
267 "AUXTIN",
268 "AMDTSI",
269 "PECI Agent 1",
270 "PECI Agent 2",
271 "PECI Agent 3",
272 "PECI Agent 4"
273};
274
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800275static const char *const nct6775_temp_label[] = {
276 "",
277 "SYSTIN",
278 "CPUTIN",
279 "AUXTIN",
280 "AMD SB-TSI",
281 "PECI Agent 0",
282 "PECI Agent 1",
283 "PECI Agent 2",
284 "PECI Agent 3",
285 "PECI Agent 4",
286 "PECI Agent 5",
287 "PECI Agent 6",
288 "PECI Agent 7",
289 "PCH_CHIP_CPU_MAX_TEMP",
290 "PCH_CHIP_TEMP",
291 "PCH_CPU_TEMP",
292 "PCH_MCH_TEMP",
293 "PCH_DIM0_TEMP",
294 "PCH_DIM1_TEMP",
295 "PCH_DIM2_TEMP",
296 "PCH_DIM3_TEMP"
297};
298
299static const char *const nct6776_temp_label[] = {
300 "",
301 "SYSTIN",
302 "CPUTIN",
303 "AUXTIN",
304 "SMBUSMASTER 0",
305 "SMBUSMASTER 1",
306 "SMBUSMASTER 2",
307 "SMBUSMASTER 3",
308 "SMBUSMASTER 4",
309 "SMBUSMASTER 5",
310 "SMBUSMASTER 6",
311 "SMBUSMASTER 7",
312 "PECI Agent 0",
313 "PECI Agent 1",
314 "PCH_CHIP_CPU_MAX_TEMP",
315 "PCH_CHIP_TEMP",
316 "PCH_CPU_TEMP",
317 "PCH_MCH_TEMP",
318 "PCH_DIM0_TEMP",
319 "PCH_DIM1_TEMP",
320 "PCH_DIM2_TEMP",
321 "PCH_DIM3_TEMP",
322 "BYTE_TEMP"
323};
324
325#define NUM_REG_TEMP ARRAY_SIZE(NCT6775_REG_TEMP)
Guenter Roeckd36cf322011-02-07 15:08:54 -0800326
Jean Delvare17296fe2011-10-20 03:08:27 -0400327static int is_word_sized(u16 reg)
Guenter Roeckbce26c52011-02-04 12:54:14 -0800328{
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800329 return ((((reg & 0xff00) == 0x100
Guenter Roeckbce26c52011-02-04 12:54:14 -0800330 || (reg & 0xff00) == 0x200)
331 && ((reg & 0x00ff) == 0x50
332 || (reg & 0x00ff) == 0x53
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800333 || (reg & 0x00ff) == 0x55))
334 || (reg & 0xfff0) == 0x630
335 || reg == 0x640 || reg == 0x642
336 || ((reg & 0xfff0) == 0x650
337 && (reg & 0x000f) >= 0x06)
338 || reg == 0x73 || reg == 0x75 || reg == 0x77
339 );
Guenter Roeckbce26c52011-02-04 12:54:14 -0800340}
341
Jean Delvare08e7e272005-04-25 22:43:25 +0200342/*
343 * Conversions
344 */
345
Rudolf Marek08c79952006-07-05 18:14:31 +0200346/* 1 is PWM mode, output in ms */
347static inline unsigned int step_time_from_reg(u8 reg, u8 mode)
348{
349 return mode ? 100 * reg : 400 * reg;
350}
351
352static inline u8 step_time_to_reg(unsigned int msec, u8 mode)
353{
354 return SENSORS_LIMIT((mode ? (msec + 50) / 100 :
355 (msec + 200) / 400), 1, 255);
356}
357
Guenter Roeck26bc4402011-02-11 08:00:58 -0800358static unsigned int fan_from_reg8(u16 reg, unsigned int divreg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200359{
Guenter Roeck26bc4402011-02-11 08:00:58 -0800360 if (reg == 0 || reg == 255)
Jean Delvare08e7e272005-04-25 22:43:25 +0200361 return 0;
Guenter Roeck26bc4402011-02-11 08:00:58 -0800362 return 1350000U / (reg << divreg);
363}
364
365static unsigned int fan_from_reg13(u16 reg, unsigned int divreg)
366{
367 if ((reg & 0xff1f) == 0xff1f)
368 return 0;
369
370 reg = (reg & 0x1f) | ((reg & 0xff00) >> 3);
371
372 if (reg == 0)
373 return 0;
374
375 return 1350000U / reg;
376}
377
378static unsigned int fan_from_reg16(u16 reg, unsigned int divreg)
379{
380 if (reg == 0 || reg == 0xffff)
381 return 0;
382
383 /*
384 * Even though the registers are 16 bit wide, the fan divisor
385 * still applies.
386 */
387 return 1350000U / (reg << divreg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200388}
389
390static inline unsigned int
391div_from_reg(u8 reg)
392{
393 return 1 << reg;
394}
395
Jean Delvareeff76872011-11-04 12:00:48 +0100396/* Some of the voltage inputs have internal scaling, the tables below
397 * contain 8 (the ADC LSB in mV) * scaling factor * 100 */
398static const u16 scale_in_common[10] = {
399 800, 800, 1600, 1600, 800, 800, 800, 1600, 1600, 800
400};
401static const u16 scale_in_w83627uhg[9] = {
402 800, 800, 3328, 3424, 800, 800, 0, 3328, 3400
403};
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100404
Jean Delvareeff76872011-11-04 12:00:48 +0100405static inline long in_from_reg(u8 reg, u8 nr, const u16 *scale_in)
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100406{
Jean Delvareeff76872011-11-04 12:00:48 +0100407 return DIV_ROUND_CLOSEST(reg * scale_in[nr], 100);
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100408}
409
Jean Delvareeff76872011-11-04 12:00:48 +0100410static inline u8 in_to_reg(u32 val, u8 nr, const u16 *scale_in)
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100411{
Jean Delvareeff76872011-11-04 12:00:48 +0100412 return SENSORS_LIMIT(DIV_ROUND_CLOSEST(val * 100, scale_in[nr]), 0,
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800413 255);
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100414}
415
Jean Delvare08e7e272005-04-25 22:43:25 +0200416/*
417 * Data structures and manipulation thereof
418 */
419
420struct w83627ehf_data {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200421 int addr; /* IO base of hw monitor block */
422 const char *name;
423
Tony Jones1beeffe2007-08-20 13:46:20 -0700424 struct device *hwmon_dev;
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100425 struct mutex lock;
Jean Delvare08e7e272005-04-25 22:43:25 +0200426
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800427 u16 reg_temp[NUM_REG_TEMP];
428 u16 reg_temp_over[NUM_REG_TEMP];
429 u16 reg_temp_hyst[NUM_REG_TEMP];
430 u16 reg_temp_config[NUM_REG_TEMP];
Guenter Roeckd36cf322011-02-07 15:08:54 -0800431 u8 temp_src[NUM_REG_TEMP];
432 const char * const *temp_label;
433
Guenter Roeck279af1a2011-02-13 22:34:47 -0800434 const u16 *REG_PWM;
435 const u16 *REG_TARGET;
436 const u16 *REG_FAN;
437 const u16 *REG_FAN_MIN;
438 const u16 *REG_FAN_START_OUTPUT;
439 const u16 *REG_FAN_STOP_OUTPUT;
440 const u16 *REG_FAN_STOP_TIME;
441 const u16 *REG_FAN_MAX_OUTPUT;
442 const u16 *REG_FAN_STEP_OUTPUT;
Jean Delvareeff76872011-11-04 12:00:48 +0100443 const u16 *scale_in;
Guenter Roeckda2e0252010-08-14 21:08:55 +0200444
Guenter Roeck26bc4402011-02-11 08:00:58 -0800445 unsigned int (*fan_from_reg)(u16 reg, unsigned int divreg);
446 unsigned int (*fan_from_reg_min)(u16 reg, unsigned int divreg);
447
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100448 struct mutex update_lock;
Jean Delvare08e7e272005-04-25 22:43:25 +0200449 char valid; /* !=0 if following fields are valid */
450 unsigned long last_updated; /* In jiffies */
451
452 /* Register values */
Guenter Roeck83cc8982011-02-06 08:10:15 -0800453 u8 bank; /* current register bank */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200454 u8 in_num; /* number of in inputs we have */
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100455 u8 in[10]; /* Register value */
456 u8 in_max[10]; /* Register value */
457 u8 in_min[10]; /* Register value */
Guenter Roeck3382a912011-02-13 13:08:23 -0800458 unsigned int rpm[5];
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800459 u16 fan_min[5];
Jean Delvare08e7e272005-04-25 22:43:25 +0200460 u8 fan_div[5];
461 u8 has_fan; /* some fan inputs can be disabled */
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800462 u8 has_fan_min; /* some fans don't have min register */
Guenter Roeck26bc4402011-02-11 08:00:58 -0800463 bool has_fan_div;
Jean Delvareda667362007-06-24 11:21:02 +0200464 u8 temp_type[3];
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800465 s16 temp[9];
466 s16 temp_max[9];
467 s16 temp_max_hyst[9];
Jean Delvarea4589db2006-03-23 16:30:29 +0100468 u32 alarms;
Dmitry Artamonow363a12a2011-08-12 16:41:11 -0400469 u8 caseopen;
Rudolf Marek08c79952006-07-05 18:14:31 +0200470
471 u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */
472 u8 pwm_enable[4]; /* 1->manual
Daniel J Blueman41e9a062009-12-14 18:01:37 -0800473 2->thermal cruise mode (also called SmartFan I)
474 3->fan speed cruise mode
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800475 4->variable thermal cruise (also called
Guenter Roeckb84bb512011-02-13 23:01:25 -0800476 SmartFan III)
477 5->enhanced variable thermal cruise (also called
478 SmartFan IV) */
479 u8 pwm_enable_orig[4]; /* original value of pwm_enable */
Gong Jun237c8d22009-03-30 21:46:42 +0200480 u8 pwm_num; /* number of pwm */
Rudolf Marek08c79952006-07-05 18:14:31 +0200481 u8 pwm[4];
482 u8 target_temp[4];
483 u8 tolerance[4];
484
Daniel J Blueman41e9a062009-12-14 18:01:37 -0800485 u8 fan_start_output[4]; /* minimum fan speed when spinning up */
486 u8 fan_stop_output[4]; /* minimum fan speed when spinning down */
487 u8 fan_stop_time[4]; /* time at minimum before disabling fan */
488 u8 fan_max_output[4]; /* maximum fan speed */
489 u8 fan_step_output[4]; /* rate of change output value */
Jean Delvarefc18d6c2007-06-24 11:19:42 +0200490
491 u8 vid;
492 u8 vrm;
Gong Juna157d062009-03-30 21:46:43 +0200493
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800494 u16 have_temp;
Jean Delvareeff76872011-11-04 12:00:48 +0100495 u8 in6_skip:1;
496 u8 temp3_val_only:1;
Jean Delvare08e7e272005-04-25 22:43:25 +0200497};
498
David Hubbard1ea6dd32007-06-24 11:16:15 +0200499struct w83627ehf_sio_data {
500 int sioreg;
501 enum kinds kind;
502};
503
Guenter Roeck83cc8982011-02-06 08:10:15 -0800504/*
505 * On older chips, only registers 0x50-0x5f are banked.
506 * On more recent chips, all registers are banked.
507 * Assume that is the case and set the bank number for each access.
508 * Cache the bank number so it only needs to be set if it changes.
509 */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200510static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200511{
Guenter Roeck83cc8982011-02-06 08:10:15 -0800512 u8 bank = reg >> 8;
513 if (data->bank != bank) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200514 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
Guenter Roeck83cc8982011-02-06 08:10:15 -0800515 outb_p(bank, data->addr + DATA_REG_OFFSET);
516 data->bank = bank;
Jean Delvare08e7e272005-04-25 22:43:25 +0200517 }
518}
519
David Hubbard1ea6dd32007-06-24 11:16:15 +0200520static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg)
Jean Delvare08e7e272005-04-25 22:43:25 +0200521{
Jean Delvare08e7e272005-04-25 22:43:25 +0200522 int res, word_sized = is_word_sized(reg);
523
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100524 mutex_lock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200525
David Hubbard1ea6dd32007-06-24 11:16:15 +0200526 w83627ehf_set_bank(data, reg);
527 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
528 res = inb_p(data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200529 if (word_sized) {
530 outb_p((reg & 0xff) + 1,
David Hubbard1ea6dd32007-06-24 11:16:15 +0200531 data->addr + ADDR_REG_OFFSET);
532 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200533 }
Jean Delvare08e7e272005-04-25 22:43:25 +0200534
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100535 mutex_unlock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200536 return res;
537}
538
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800539static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg,
540 u16 value)
Jean Delvare08e7e272005-04-25 22:43:25 +0200541{
Jean Delvare08e7e272005-04-25 22:43:25 +0200542 int word_sized = is_word_sized(reg);
543
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100544 mutex_lock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200545
David Hubbard1ea6dd32007-06-24 11:16:15 +0200546 w83627ehf_set_bank(data, reg);
547 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200548 if (word_sized) {
David Hubbard1ea6dd32007-06-24 11:16:15 +0200549 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200550 outb_p((reg & 0xff) + 1,
David Hubbard1ea6dd32007-06-24 11:16:15 +0200551 data->addr + ADDR_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200552 }
David Hubbard1ea6dd32007-06-24 11:16:15 +0200553 outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
Jean Delvare08e7e272005-04-25 22:43:25 +0200554
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100555 mutex_unlock(&data->lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200556 return 0;
557}
558
Jean Delvarec5794cf2011-10-20 03:13:31 -0400559/* We left-align 8-bit temperature values to make the code simpler */
560static u16 w83627ehf_read_temp(struct w83627ehf_data *data, u16 reg)
561{
562 u16 res;
563
564 res = w83627ehf_read_value(data, reg);
565 if (!is_word_sized(reg))
566 res <<= 8;
567
568 return res;
569}
570
571static int w83627ehf_write_temp(struct w83627ehf_data *data, u16 reg,
572 u16 value)
573{
574 if (!is_word_sized(reg))
575 value >>= 8;
576 return w83627ehf_write_value(data, reg, value);
577}
578
Jean Delvare08e7e272005-04-25 22:43:25 +0200579/* This function assumes that the caller holds data->update_lock */
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800580static void nct6775_write_fan_div(struct w83627ehf_data *data, int nr)
581{
582 u8 reg;
583
584 switch (nr) {
585 case 0:
586 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV1) & 0x70)
587 | (data->fan_div[0] & 0x7);
588 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, reg);
589 break;
590 case 1:
591 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV1) & 0x7)
592 | ((data->fan_div[1] << 4) & 0x70);
593 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, reg);
594 case 2:
595 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV2) & 0x70)
596 | (data->fan_div[2] & 0x7);
597 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, reg);
598 break;
599 case 3:
600 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV2) & 0x7)
601 | ((data->fan_div[3] << 4) & 0x70);
602 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, reg);
603 break;
604 }
605}
606
607/* This function assumes that the caller holds data->update_lock */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200608static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr)
Jean Delvare08e7e272005-04-25 22:43:25 +0200609{
Jean Delvare08e7e272005-04-25 22:43:25 +0200610 u8 reg;
611
612 switch (nr) {
613 case 0:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200614 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200615 | ((data->fan_div[0] & 0x03) << 4);
Rudolf Marek14992c72006-10-08 22:02:09 +0200616 /* fan5 input control bit is write only, compute the value */
617 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200618 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
619 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200620 | ((data->fan_div[0] & 0x04) << 3);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200621 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200622 break;
623 case 1:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200624 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200625 | ((data->fan_div[1] & 0x03) << 6);
Rudolf Marek14992c72006-10-08 22:02:09 +0200626 /* fan5 input control bit is write only, compute the value */
627 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
David Hubbard1ea6dd32007-06-24 11:16:15 +0200628 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
629 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf)
Jean Delvare08e7e272005-04-25 22:43:25 +0200630 | ((data->fan_div[1] & 0x04) << 4);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200631 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200632 break;
633 case 2:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200634 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200635 | ((data->fan_div[2] & 0x03) << 6);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200636 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg);
637 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200638 | ((data->fan_div[2] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200639 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200640 break;
641 case 3:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200642 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc)
Jean Delvare08e7e272005-04-25 22:43:25 +0200643 | (data->fan_div[3] & 0x03);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200644 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
645 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f)
Jean Delvare08e7e272005-04-25 22:43:25 +0200646 | ((data->fan_div[3] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200647 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200648 break;
649 case 4:
David Hubbard1ea6dd32007-06-24 11:16:15 +0200650 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73)
Jean Delvare33725ad2007-04-17 00:32:27 -0700651 | ((data->fan_div[4] & 0x03) << 2)
Jean Delvare08e7e272005-04-25 22:43:25 +0200652 | ((data->fan_div[4] & 0x04) << 5);
David Hubbard1ea6dd32007-06-24 11:16:15 +0200653 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
Jean Delvare08e7e272005-04-25 22:43:25 +0200654 break;
655 }
656}
657
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800658static void w83627ehf_write_fan_div_common(struct device *dev,
659 struct w83627ehf_data *data, int nr)
660{
661 struct w83627ehf_sio_data *sio_data = dev->platform_data;
662
663 if (sio_data->kind == nct6776)
664 ; /* no dividers, do nothing */
665 else if (sio_data->kind == nct6775)
666 nct6775_write_fan_div(data, nr);
667 else
668 w83627ehf_write_fan_div(data, nr);
669}
670
671static void nct6775_update_fan_div(struct w83627ehf_data *data)
672{
673 u8 i;
674
675 i = w83627ehf_read_value(data, NCT6775_REG_FANDIV1);
676 data->fan_div[0] = i & 0x7;
677 data->fan_div[1] = (i & 0x70) >> 4;
678 i = w83627ehf_read_value(data, NCT6775_REG_FANDIV2);
679 data->fan_div[2] = i & 0x7;
680 if (data->has_fan & (1<<3))
681 data->fan_div[3] = (i & 0x70) >> 4;
682}
683
Mark M. Hoffmanea7be662007-08-05 12:19:01 -0400684static void w83627ehf_update_fan_div(struct w83627ehf_data *data)
685{
686 int i;
687
688 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
689 data->fan_div[0] = (i >> 4) & 0x03;
690 data->fan_div[1] = (i >> 6) & 0x03;
691 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2);
692 data->fan_div[2] = (i >> 6) & 0x03;
693 i = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
694 data->fan_div[0] |= (i >> 3) & 0x04;
695 data->fan_div[1] |= (i >> 4) & 0x04;
696 data->fan_div[2] |= (i >> 5) & 0x04;
697 if (data->has_fan & ((1 << 3) | (1 << 4))) {
698 i = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
699 data->fan_div[3] = i & 0x03;
700 data->fan_div[4] = ((i >> 2) & 0x03)
701 | ((i >> 5) & 0x04);
702 }
703 if (data->has_fan & (1 << 3)) {
704 i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT);
705 data->fan_div[3] |= (i >> 5) & 0x04;
706 }
707}
708
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800709static void w83627ehf_update_fan_div_common(struct device *dev,
710 struct w83627ehf_data *data)
711{
712 struct w83627ehf_sio_data *sio_data = dev->platform_data;
713
714 if (sio_data->kind == nct6776)
715 ; /* no dividers, do nothing */
716 else if (sio_data->kind == nct6775)
717 nct6775_update_fan_div(data);
718 else
719 w83627ehf_update_fan_div(data);
720}
721
722static void nct6775_update_pwm(struct w83627ehf_data *data)
723{
724 int i;
725 int pwmcfg, fanmodecfg;
726
727 for (i = 0; i < data->pwm_num; i++) {
728 pwmcfg = w83627ehf_read_value(data,
729 W83627EHF_REG_PWM_ENABLE[i]);
730 fanmodecfg = w83627ehf_read_value(data,
731 NCT6775_REG_FAN_MODE[i]);
732 data->pwm_mode[i] =
733 ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1) ? 0 : 1;
734 data->pwm_enable[i] = ((fanmodecfg >> 4) & 7) + 1;
735 data->tolerance[i] = fanmodecfg & 0x0f;
736 data->pwm[i] = w83627ehf_read_value(data, data->REG_PWM[i]);
737 }
738}
739
740static void w83627ehf_update_pwm(struct w83627ehf_data *data)
741{
742 int i;
743 int pwmcfg = 0, tolerance = 0; /* shut up the compiler */
744
745 for (i = 0; i < data->pwm_num; i++) {
746 if (!(data->has_fan & (1 << i)))
747 continue;
748
749 /* pwmcfg, tolerance mapped for i=0, i=1 to same reg */
750 if (i != 1) {
751 pwmcfg = w83627ehf_read_value(data,
752 W83627EHF_REG_PWM_ENABLE[i]);
753 tolerance = w83627ehf_read_value(data,
754 W83627EHF_REG_TOLERANCE[i]);
755 }
756 data->pwm_mode[i] =
757 ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1) ? 0 : 1;
758 data->pwm_enable[i] = ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i])
759 & 3) + 1;
760 data->pwm[i] = w83627ehf_read_value(data, data->REG_PWM[i]);
761
762 data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0)) & 0x0f;
763 }
764}
765
766static void w83627ehf_update_pwm_common(struct device *dev,
767 struct w83627ehf_data *data)
768{
769 struct w83627ehf_sio_data *sio_data = dev->platform_data;
770
771 if (sio_data->kind == nct6775 || sio_data->kind == nct6776)
772 nct6775_update_pwm(data);
773 else
774 w83627ehf_update_pwm(data);
775}
776
Jean Delvare08e7e272005-04-25 22:43:25 +0200777static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
778{
David Hubbard1ea6dd32007-06-24 11:16:15 +0200779 struct w83627ehf_data *data = dev_get_drvdata(dev);
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800780 struct w83627ehf_sio_data *sio_data = dev->platform_data;
781
Jean Delvare08e7e272005-04-25 22:43:25 +0200782 int i;
783
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100784 mutex_lock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200785
Jean Delvare6b3e4642007-06-24 11:19:01 +0200786 if (time_after(jiffies, data->last_updated + HZ + HZ/2)
Jean Delvare08e7e272005-04-25 22:43:25 +0200787 || !data->valid) {
788 /* Fan clock dividers */
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800789 w83627ehf_update_fan_div_common(dev, data);
Jean Delvare08e7e272005-04-25 22:43:25 +0200790
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100791 /* Measured voltages and limits */
David Hubbard1ea6dd32007-06-24 11:16:15 +0200792 for (i = 0; i < data->in_num; i++) {
Jean Delvare389ef652011-10-13 10:40:53 -0400793 if ((i == 6) && data->in6_skip)
794 continue;
795
David Hubbard1ea6dd32007-06-24 11:16:15 +0200796 data->in[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100797 W83627EHF_REG_IN(i));
David Hubbard1ea6dd32007-06-24 11:16:15 +0200798 data->in_min[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100799 W83627EHF_REG_IN_MIN(i));
David Hubbard1ea6dd32007-06-24 11:16:15 +0200800 data->in_max[i] = w83627ehf_read_value(data,
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100801 W83627EHF_REG_IN_MAX(i));
802 }
803
Jean Delvare08e7e272005-04-25 22:43:25 +0200804 /* Measured fan speeds and limits */
805 for (i = 0; i < 5; i++) {
Guenter Roeck3382a912011-02-13 13:08:23 -0800806 u16 reg;
807
Jean Delvare08e7e272005-04-25 22:43:25 +0200808 if (!(data->has_fan & (1 << i)))
809 continue;
810
Guenter Roeck3382a912011-02-13 13:08:23 -0800811 reg = w83627ehf_read_value(data, data->REG_FAN[i]);
812 data->rpm[i] = data->fan_from_reg(reg,
813 data->fan_div[i]);
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800814
815 if (data->has_fan_min & (1 << i))
816 data->fan_min[i] = w83627ehf_read_value(data,
Guenter Roeck279af1a2011-02-13 22:34:47 -0800817 data->REG_FAN_MIN[i]);
Jean Delvare08e7e272005-04-25 22:43:25 +0200818
819 /* If we failed to measure the fan speed and clock
820 divider can be increased, let's try that for next
821 time */
Guenter Roeck26bc4402011-02-11 08:00:58 -0800822 if (data->has_fan_div
Guenter Roeck3382a912011-02-13 13:08:23 -0800823 && (reg >= 0xff || (sio_data->kind == nct6775
824 && reg == 0x00))
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800825 && data->fan_div[i] < 0x07) {
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800826 dev_dbg(dev, "Increasing fan%d "
Jean Delvare08e7e272005-04-25 22:43:25 +0200827 "clock divider from %u to %u\n",
Jean Delvare33725ad2007-04-17 00:32:27 -0700828 i + 1, div_from_reg(data->fan_div[i]),
Jean Delvare08e7e272005-04-25 22:43:25 +0200829 div_from_reg(data->fan_div[i] + 1));
830 data->fan_div[i]++;
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800831 w83627ehf_write_fan_div_common(dev, data, i);
Jean Delvare08e7e272005-04-25 22:43:25 +0200832 /* Preserve min limit if possible */
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800833 if ((data->has_fan_min & (1 << i))
834 && data->fan_min[i] >= 2
Jean Delvare08e7e272005-04-25 22:43:25 +0200835 && data->fan_min[i] != 255)
David Hubbard1ea6dd32007-06-24 11:16:15 +0200836 w83627ehf_write_value(data,
Guenter Roeck279af1a2011-02-13 22:34:47 -0800837 data->REG_FAN_MIN[i],
Jean Delvare08e7e272005-04-25 22:43:25 +0200838 (data->fan_min[i] /= 2));
839 }
840 }
841
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800842 w83627ehf_update_pwm_common(dev, data);
843
Guenter Roeckda2e0252010-08-14 21:08:55 +0200844 for (i = 0; i < data->pwm_num; i++) {
845 if (!(data->has_fan & (1 << i)))
846 continue;
847
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800848 data->fan_start_output[i] =
849 w83627ehf_read_value(data,
850 data->REG_FAN_START_OUTPUT[i]);
851 data->fan_stop_output[i] =
852 w83627ehf_read_value(data,
853 data->REG_FAN_STOP_OUTPUT[i]);
854 data->fan_stop_time[i] =
855 w83627ehf_read_value(data,
856 data->REG_FAN_STOP_TIME[i]);
Guenter Roeckda2e0252010-08-14 21:08:55 +0200857
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800858 if (data->REG_FAN_MAX_OUTPUT &&
859 data->REG_FAN_MAX_OUTPUT[i] != 0xff)
Guenter Roeckda2e0252010-08-14 21:08:55 +0200860 data->fan_max_output[i] =
861 w83627ehf_read_value(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800862 data->REG_FAN_MAX_OUTPUT[i]);
Guenter Roeckda2e0252010-08-14 21:08:55 +0200863
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800864 if (data->REG_FAN_STEP_OUTPUT &&
865 data->REG_FAN_STEP_OUTPUT[i] != 0xff)
Guenter Roeckda2e0252010-08-14 21:08:55 +0200866 data->fan_step_output[i] =
867 w83627ehf_read_value(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800868 data->REG_FAN_STEP_OUTPUT[i]);
Guenter Roeckda2e0252010-08-14 21:08:55 +0200869
Rudolf Marek08c79952006-07-05 18:14:31 +0200870 data->target_temp[i] =
David Hubbard1ea6dd32007-06-24 11:16:15 +0200871 w83627ehf_read_value(data,
Guenter Roeck279af1a2011-02-13 22:34:47 -0800872 data->REG_TARGET[i]) &
Rudolf Marek08c79952006-07-05 18:14:31 +0200873 (data->pwm_mode[i] == 1 ? 0x7f : 0xff);
Rudolf Marek08c79952006-07-05 18:14:31 +0200874 }
875
Jean Delvare08e7e272005-04-25 22:43:25 +0200876 /* Measured temperatures and limits */
Guenter Roeckd36cf322011-02-07 15:08:54 -0800877 for (i = 0; i < NUM_REG_TEMP; i++) {
878 if (!(data->have_temp & (1 << i)))
879 continue;
Jean Delvarec5794cf2011-10-20 03:13:31 -0400880 data->temp[i] = w83627ehf_read_temp(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800881 data->reg_temp[i]);
882 if (data->reg_temp_over[i])
883 data->temp_max[i]
Jean Delvarec5794cf2011-10-20 03:13:31 -0400884 = w83627ehf_read_temp(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800885 data->reg_temp_over[i]);
886 if (data->reg_temp_hyst[i])
887 data->temp_max_hyst[i]
Jean Delvarec5794cf2011-10-20 03:13:31 -0400888 = w83627ehf_read_temp(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -0800889 data->reg_temp_hyst[i]);
Jean Delvare08e7e272005-04-25 22:43:25 +0200890 }
891
David Hubbard1ea6dd32007-06-24 11:16:15 +0200892 data->alarms = w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100893 W83627EHF_REG_ALARM1) |
David Hubbard1ea6dd32007-06-24 11:16:15 +0200894 (w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100895 W83627EHF_REG_ALARM2) << 8) |
David Hubbard1ea6dd32007-06-24 11:16:15 +0200896 (w83627ehf_read_value(data,
Jean Delvarea4589db2006-03-23 16:30:29 +0100897 W83627EHF_REG_ALARM3) << 16);
898
Dmitry Artamonow363a12a2011-08-12 16:41:11 -0400899 data->caseopen = w83627ehf_read_value(data,
900 W83627EHF_REG_CASEOPEN_DET);
901
Jean Delvare08e7e272005-04-25 22:43:25 +0200902 data->last_updated = jiffies;
903 data->valid = 1;
904 }
905
Ingo Molnar9a61bf62006-01-18 23:19:26 +0100906 mutex_unlock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +0200907 return data;
908}
909
910/*
911 * Sysfs callback functions
912 */
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100913#define show_in_reg(reg) \
914static ssize_t \
915show_##reg(struct device *dev, struct device_attribute *attr, \
916 char *buf) \
917{ \
918 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800919 struct sensor_device_attribute *sensor_attr = \
920 to_sensor_dev_attr(attr); \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100921 int nr = sensor_attr->index; \
Jean Delvareeff76872011-11-04 12:00:48 +0100922 return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr, \
923 data->scale_in)); \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100924}
925show_in_reg(in)
926show_in_reg(in_min)
927show_in_reg(in_max)
928
929#define store_in_reg(REG, reg) \
930static ssize_t \
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800931store_in_##reg(struct device *dev, struct device_attribute *attr, \
932 const char *buf, size_t count) \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100933{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200934 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800935 struct sensor_device_attribute *sensor_attr = \
936 to_sensor_dev_attr(attr); \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100937 int nr = sensor_attr->index; \
Guenter Roeckbce26c52011-02-04 12:54:14 -0800938 unsigned long val; \
939 int err; \
940 err = strict_strtoul(buf, 10, &val); \
941 if (err < 0) \
942 return err; \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100943 mutex_lock(&data->update_lock); \
Jean Delvareeff76872011-11-04 12:00:48 +0100944 data->in_##reg[nr] = in_to_reg(val, nr, data->scale_in); \
David Hubbard1ea6dd32007-06-24 11:16:15 +0200945 w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100946 data->in_##reg[nr]); \
947 mutex_unlock(&data->update_lock); \
948 return count; \
949}
950
951store_in_reg(MIN, min)
952store_in_reg(MAX, max)
953
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800954static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
955 char *buf)
Jean Delvarea4589db2006-03-23 16:30:29 +0100956{
957 struct w83627ehf_data *data = w83627ehf_update_device(dev);
958 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
959 int nr = sensor_attr->index;
960 return sprintf(buf, "%u\n", (data->alarms >> nr) & 0x01);
961}
962
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100963static struct sensor_device_attribute sda_in_input[] = {
964 SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0),
965 SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1),
966 SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2),
967 SENSOR_ATTR(in3_input, S_IRUGO, show_in, NULL, 3),
968 SENSOR_ATTR(in4_input, S_IRUGO, show_in, NULL, 4),
969 SENSOR_ATTR(in5_input, S_IRUGO, show_in, NULL, 5),
970 SENSOR_ATTR(in6_input, S_IRUGO, show_in, NULL, 6),
971 SENSOR_ATTR(in7_input, S_IRUGO, show_in, NULL, 7),
972 SENSOR_ATTR(in8_input, S_IRUGO, show_in, NULL, 8),
973 SENSOR_ATTR(in9_input, S_IRUGO, show_in, NULL, 9),
974};
975
Jean Delvarea4589db2006-03-23 16:30:29 +0100976static struct sensor_device_attribute sda_in_alarm[] = {
977 SENSOR_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0),
978 SENSOR_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1),
979 SENSOR_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2),
980 SENSOR_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3),
981 SENSOR_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8),
982 SENSOR_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 21),
983 SENSOR_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 20),
984 SENSOR_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16),
985 SENSOR_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17),
986 SENSOR_ATTR(in9_alarm, S_IRUGO, show_alarm, NULL, 19),
987};
988
Rudolf Marekcf0676f2006-03-23 16:25:22 +0100989static struct sensor_device_attribute sda_in_min[] = {
Guenter Roecke7e1ca62011-02-04 13:24:30 -0800990 SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0),
991 SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1),
992 SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2),
993 SENSOR_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 3),
994 SENSOR_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 4),
995 SENSOR_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 5),
996 SENSOR_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 6),
997 SENSOR_ATTR(in7_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 7),
998 SENSOR_ATTR(in8_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 8),
999 SENSOR_ATTR(in9_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 9),
Rudolf Marekcf0676f2006-03-23 16:25:22 +01001000};
1001
1002static struct sensor_device_attribute sda_in_max[] = {
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001003 SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0),
1004 SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1),
1005 SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2),
1006 SENSOR_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 3),
1007 SENSOR_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 4),
1008 SENSOR_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 5),
1009 SENSOR_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 6),
1010 SENSOR_ATTR(in7_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 7),
1011 SENSOR_ATTR(in8_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 8),
1012 SENSOR_ATTR(in9_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 9),
Rudolf Marekcf0676f2006-03-23 16:25:22 +01001013};
1014
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001015static ssize_t
1016show_fan(struct device *dev, struct device_attribute *attr, char *buf)
1017{
1018 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1019 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1020 int nr = sensor_attr->index;
Guenter Roeck3382a912011-02-13 13:08:23 -08001021 return sprintf(buf, "%d\n", data->rpm[nr]);
Jean Delvare08e7e272005-04-25 22:43:25 +02001022}
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001023
1024static ssize_t
1025show_fan_min(struct device *dev, struct device_attribute *attr, char *buf)
1026{
1027 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1028 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1029 int nr = sensor_attr->index;
1030 return sprintf(buf, "%d\n",
Guenter Roeck26bc4402011-02-11 08:00:58 -08001031 data->fan_from_reg_min(data->fan_min[nr],
1032 data->fan_div[nr]));
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001033}
Jean Delvare08e7e272005-04-25 22:43:25 +02001034
1035static ssize_t
Yuan Mu412fec82006-02-05 23:24:16 +01001036show_fan_div(struct device *dev, struct device_attribute *attr,
1037 char *buf)
Jean Delvare08e7e272005-04-25 22:43:25 +02001038{
1039 struct w83627ehf_data *data = w83627ehf_update_device(dev);
Yuan Mu412fec82006-02-05 23:24:16 +01001040 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1041 int nr = sensor_attr->index;
1042 return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
Jean Delvare08e7e272005-04-25 22:43:25 +02001043}
1044
1045static ssize_t
Yuan Mu412fec82006-02-05 23:24:16 +01001046store_fan_min(struct device *dev, struct device_attribute *attr,
1047 const char *buf, size_t count)
Jean Delvare08e7e272005-04-25 22:43:25 +02001048{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001049 struct w83627ehf_data *data = dev_get_drvdata(dev);
Yuan Mu412fec82006-02-05 23:24:16 +01001050 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1051 int nr = sensor_attr->index;
Guenter Roeckbce26c52011-02-04 12:54:14 -08001052 unsigned long val;
1053 int err;
Jean Delvare08e7e272005-04-25 22:43:25 +02001054 unsigned int reg;
1055 u8 new_div;
1056
Guenter Roeckbce26c52011-02-04 12:54:14 -08001057 err = strict_strtoul(buf, 10, &val);
1058 if (err < 0)
1059 return err;
1060
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001061 mutex_lock(&data->update_lock);
Guenter Roeck26bc4402011-02-11 08:00:58 -08001062 if (!data->has_fan_div) {
1063 /*
1064 * Only NCT6776F for now, so we know that this is a 13 bit
1065 * register
1066 */
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001067 if (!val) {
1068 val = 0xff1f;
1069 } else {
1070 if (val > 1350000U)
1071 val = 135000U;
1072 val = 1350000U / val;
1073 val = (val & 0x1f) | ((val << 3) & 0xff00);
1074 }
1075 data->fan_min[nr] = val;
1076 goto done; /* Leave fan divider alone */
1077 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001078 if (!val) {
1079 /* No min limit, alarm disabled */
1080 data->fan_min[nr] = 255;
1081 new_div = data->fan_div[nr]; /* No change */
1082 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
1083 } else if ((reg = 1350000U / val) >= 128 * 255) {
1084 /* Speed below this value cannot possibly be represented,
1085 even with the highest divider (128) */
1086 data->fan_min[nr] = 254;
1087 new_div = 7; /* 128 == (1 << 7) */
Guenter Roeckbce26c52011-02-04 12:54:14 -08001088 dev_warn(dev, "fan%u low limit %lu below minimum %u, set to "
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001089 "minimum\n", nr + 1, val,
Guenter Roeck26bc4402011-02-11 08:00:58 -08001090 data->fan_from_reg_min(254, 7));
Jean Delvare08e7e272005-04-25 22:43:25 +02001091 } else if (!reg) {
1092 /* Speed above this value cannot possibly be represented,
1093 even with the lowest divider (1) */
1094 data->fan_min[nr] = 1;
1095 new_div = 0; /* 1 == (1 << 0) */
Guenter Roeckbce26c52011-02-04 12:54:14 -08001096 dev_warn(dev, "fan%u low limit %lu above maximum %u, set to "
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001097 "maximum\n", nr + 1, val,
Guenter Roeck26bc4402011-02-11 08:00:58 -08001098 data->fan_from_reg_min(1, 0));
Jean Delvare08e7e272005-04-25 22:43:25 +02001099 } else {
1100 /* Automatically pick the best divider, i.e. the one such
1101 that the min limit will correspond to a register value
1102 in the 96..192 range */
1103 new_div = 0;
1104 while (reg > 192 && new_div < 7) {
1105 reg >>= 1;
1106 new_div++;
1107 }
1108 data->fan_min[nr] = reg;
1109 }
1110
1111 /* Write both the fan clock divider (if it changed) and the new
1112 fan min (unconditionally) */
1113 if (new_div != data->fan_div[nr]) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001114 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
1115 nr + 1, div_from_reg(data->fan_div[nr]),
1116 div_from_reg(new_div));
1117 data->fan_div[nr] = new_div;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001118 w83627ehf_write_fan_div_common(dev, data, nr);
Jean Delvare6b3e4642007-06-24 11:19:01 +02001119 /* Give the chip time to sample a new speed value */
1120 data->last_updated = jiffies;
Jean Delvare08e7e272005-04-25 22:43:25 +02001121 }
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001122done:
Guenter Roeck279af1a2011-02-13 22:34:47 -08001123 w83627ehf_write_value(data, data->REG_FAN_MIN[nr],
Jean Delvare08e7e272005-04-25 22:43:25 +02001124 data->fan_min[nr]);
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001125 mutex_unlock(&data->update_lock);
Jean Delvare08e7e272005-04-25 22:43:25 +02001126
1127 return count;
1128}
1129
Yuan Mu412fec82006-02-05 23:24:16 +01001130static struct sensor_device_attribute sda_fan_input[] = {
1131 SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0),
1132 SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1),
1133 SENSOR_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2),
1134 SENSOR_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3),
1135 SENSOR_ATTR(fan5_input, S_IRUGO, show_fan, NULL, 4),
1136};
Jean Delvare08e7e272005-04-25 22:43:25 +02001137
Jean Delvarea4589db2006-03-23 16:30:29 +01001138static struct sensor_device_attribute sda_fan_alarm[] = {
1139 SENSOR_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6),
1140 SENSOR_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7),
1141 SENSOR_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11),
1142 SENSOR_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 10),
1143 SENSOR_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 23),
1144};
1145
Yuan Mu412fec82006-02-05 23:24:16 +01001146static struct sensor_device_attribute sda_fan_min[] = {
1147 SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min,
1148 store_fan_min, 0),
1149 SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min,
1150 store_fan_min, 1),
1151 SENSOR_ATTR(fan3_min, S_IWUSR | S_IRUGO, show_fan_min,
1152 store_fan_min, 2),
1153 SENSOR_ATTR(fan4_min, S_IWUSR | S_IRUGO, show_fan_min,
1154 store_fan_min, 3),
1155 SENSOR_ATTR(fan5_min, S_IWUSR | S_IRUGO, show_fan_min,
1156 store_fan_min, 4),
1157};
Jean Delvare08e7e272005-04-25 22:43:25 +02001158
Yuan Mu412fec82006-02-05 23:24:16 +01001159static struct sensor_device_attribute sda_fan_div[] = {
1160 SENSOR_ATTR(fan1_div, S_IRUGO, show_fan_div, NULL, 0),
1161 SENSOR_ATTR(fan2_div, S_IRUGO, show_fan_div, NULL, 1),
1162 SENSOR_ATTR(fan3_div, S_IRUGO, show_fan_div, NULL, 2),
1163 SENSOR_ATTR(fan4_div, S_IRUGO, show_fan_div, NULL, 3),
1164 SENSOR_ATTR(fan5_div, S_IRUGO, show_fan_div, NULL, 4),
1165};
Jean Delvare08e7e272005-04-25 22:43:25 +02001166
Guenter Roeckd36cf322011-02-07 15:08:54 -08001167static ssize_t
1168show_temp_label(struct device *dev, struct device_attribute *attr, char *buf)
1169{
1170 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1171 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1172 int nr = sensor_attr->index;
1173 return sprintf(buf, "%s\n", data->temp_label[data->temp_src[nr]]);
1174}
1175
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001176#define show_temp_reg(addr, reg) \
Jean Delvare08e7e272005-04-25 22:43:25 +02001177static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +01001178show_##reg(struct device *dev, struct device_attribute *attr, \
1179 char *buf) \
Jean Delvare08e7e272005-04-25 22:43:25 +02001180{ \
1181 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001182 struct sensor_device_attribute *sensor_attr = \
1183 to_sensor_dev_attr(attr); \
Yuan Mu412fec82006-02-05 23:24:16 +01001184 int nr = sensor_attr->index; \
Jean Delvarec5794cf2011-10-20 03:13:31 -04001185 return sprintf(buf, "%d\n", LM75_TEMP_FROM_REG(data->reg[nr])); \
Jean Delvare08e7e272005-04-25 22:43:25 +02001186}
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001187show_temp_reg(reg_temp, temp);
1188show_temp_reg(reg_temp_over, temp_max);
1189show_temp_reg(reg_temp_hyst, temp_max_hyst);
Jean Delvare08e7e272005-04-25 22:43:25 +02001190
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001191#define store_temp_reg(addr, reg) \
Jean Delvare08e7e272005-04-25 22:43:25 +02001192static ssize_t \
Yuan Mu412fec82006-02-05 23:24:16 +01001193store_##reg(struct device *dev, struct device_attribute *attr, \
1194 const char *buf, size_t count) \
Jean Delvare08e7e272005-04-25 22:43:25 +02001195{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001196 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001197 struct sensor_device_attribute *sensor_attr = \
1198 to_sensor_dev_attr(attr); \
Yuan Mu412fec82006-02-05 23:24:16 +01001199 int nr = sensor_attr->index; \
Guenter Roeckbce26c52011-02-04 12:54:14 -08001200 int err; \
1201 long val; \
1202 err = strict_strtol(buf, 10, &val); \
1203 if (err < 0) \
1204 return err; \
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001205 mutex_lock(&data->update_lock); \
Jean Delvarec5794cf2011-10-20 03:13:31 -04001206 data->reg[nr] = LM75_TEMP_TO_REG(val); \
1207 w83627ehf_write_temp(data, data->addr[nr], data->reg[nr]); \
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001208 mutex_unlock(&data->update_lock); \
Jean Delvare08e7e272005-04-25 22:43:25 +02001209 return count; \
1210}
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001211store_temp_reg(reg_temp_over, temp_max);
1212store_temp_reg(reg_temp_hyst, temp_max_hyst);
Jean Delvare08e7e272005-04-25 22:43:25 +02001213
Jean Delvareda667362007-06-24 11:21:02 +02001214static ssize_t
1215show_temp_type(struct device *dev, struct device_attribute *attr, char *buf)
1216{
1217 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1218 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1219 int nr = sensor_attr->index;
1220 return sprintf(buf, "%d\n", (int)data->temp_type[nr]);
1221}
1222
Gong Juna157d062009-03-30 21:46:43 +02001223static struct sensor_device_attribute sda_temp_input[] = {
Guenter Roeckbce26c52011-02-04 12:54:14 -08001224 SENSOR_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0),
1225 SENSOR_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1),
1226 SENSOR_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2),
Guenter Roeckd36cf322011-02-07 15:08:54 -08001227 SENSOR_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3),
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001228 SENSOR_ATTR(temp5_input, S_IRUGO, show_temp, NULL, 4),
1229 SENSOR_ATTR(temp6_input, S_IRUGO, show_temp, NULL, 5),
1230 SENSOR_ATTR(temp7_input, S_IRUGO, show_temp, NULL, 6),
1231 SENSOR_ATTR(temp8_input, S_IRUGO, show_temp, NULL, 7),
1232 SENSOR_ATTR(temp9_input, S_IRUGO, show_temp, NULL, 8),
Guenter Roeckd36cf322011-02-07 15:08:54 -08001233};
1234
1235static struct sensor_device_attribute sda_temp_label[] = {
1236 SENSOR_ATTR(temp1_label, S_IRUGO, show_temp_label, NULL, 0),
1237 SENSOR_ATTR(temp2_label, S_IRUGO, show_temp_label, NULL, 1),
1238 SENSOR_ATTR(temp3_label, S_IRUGO, show_temp_label, NULL, 2),
1239 SENSOR_ATTR(temp4_label, S_IRUGO, show_temp_label, NULL, 3),
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001240 SENSOR_ATTR(temp5_label, S_IRUGO, show_temp_label, NULL, 4),
1241 SENSOR_ATTR(temp6_label, S_IRUGO, show_temp_label, NULL, 5),
1242 SENSOR_ATTR(temp7_label, S_IRUGO, show_temp_label, NULL, 6),
1243 SENSOR_ATTR(temp8_label, S_IRUGO, show_temp_label, NULL, 7),
1244 SENSOR_ATTR(temp9_label, S_IRUGO, show_temp_label, NULL, 8),
Gong Juna157d062009-03-30 21:46:43 +02001245};
1246
1247static struct sensor_device_attribute sda_temp_max[] = {
Guenter Roeckbce26c52011-02-04 12:54:14 -08001248 SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp_max,
Yuan Mu412fec82006-02-05 23:24:16 +01001249 store_temp_max, 0),
Guenter Roeckbce26c52011-02-04 12:54:14 -08001250 SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
Yuan Mu412fec82006-02-05 23:24:16 +01001251 store_temp_max, 1),
Guenter Roeckbce26c52011-02-04 12:54:14 -08001252 SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
1253 store_temp_max, 2),
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001254 SENSOR_ATTR(temp4_max, S_IRUGO | S_IWUSR, show_temp_max,
1255 store_temp_max, 3),
1256 SENSOR_ATTR(temp5_max, S_IRUGO | S_IWUSR, show_temp_max,
1257 store_temp_max, 4),
1258 SENSOR_ATTR(temp6_max, S_IRUGO | S_IWUSR, show_temp_max,
1259 store_temp_max, 5),
1260 SENSOR_ATTR(temp7_max, S_IRUGO | S_IWUSR, show_temp_max,
1261 store_temp_max, 6),
1262 SENSOR_ATTR(temp8_max, S_IRUGO | S_IWUSR, show_temp_max,
1263 store_temp_max, 7),
1264 SENSOR_ATTR(temp9_max, S_IRUGO | S_IWUSR, show_temp_max,
1265 store_temp_max, 8),
Gong Juna157d062009-03-30 21:46:43 +02001266};
1267
1268static struct sensor_device_attribute sda_temp_max_hyst[] = {
Guenter Roeckbce26c52011-02-04 12:54:14 -08001269 SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
Yuan Mu412fec82006-02-05 23:24:16 +01001270 store_temp_max_hyst, 0),
Guenter Roeckbce26c52011-02-04 12:54:14 -08001271 SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
Yuan Mu412fec82006-02-05 23:24:16 +01001272 store_temp_max_hyst, 1),
Guenter Roeckbce26c52011-02-04 12:54:14 -08001273 SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1274 store_temp_max_hyst, 2),
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001275 SENSOR_ATTR(temp4_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1276 store_temp_max_hyst, 3),
1277 SENSOR_ATTR(temp5_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1278 store_temp_max_hyst, 4),
1279 SENSOR_ATTR(temp6_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1280 store_temp_max_hyst, 5),
1281 SENSOR_ATTR(temp7_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1282 store_temp_max_hyst, 6),
1283 SENSOR_ATTR(temp8_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1284 store_temp_max_hyst, 7),
1285 SENSOR_ATTR(temp9_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1286 store_temp_max_hyst, 8),
Gong Juna157d062009-03-30 21:46:43 +02001287};
1288
1289static struct sensor_device_attribute sda_temp_alarm[] = {
Jean Delvarea4589db2006-03-23 16:30:29 +01001290 SENSOR_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4),
1291 SENSOR_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5),
1292 SENSOR_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13),
Gong Juna157d062009-03-30 21:46:43 +02001293};
1294
1295static struct sensor_device_attribute sda_temp_type[] = {
Jean Delvareda667362007-06-24 11:21:02 +02001296 SENSOR_ATTR(temp1_type, S_IRUGO, show_temp_type, NULL, 0),
1297 SENSOR_ATTR(temp2_type, S_IRUGO, show_temp_type, NULL, 1),
1298 SENSOR_ATTR(temp3_type, S_IRUGO, show_temp_type, NULL, 2),
Yuan Mu412fec82006-02-05 23:24:16 +01001299};
Jean Delvare08e7e272005-04-25 22:43:25 +02001300
Rudolf Marek08c79952006-07-05 18:14:31 +02001301#define show_pwm_reg(reg) \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001302static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1303 char *buf) \
Rudolf Marek08c79952006-07-05 18:14:31 +02001304{ \
1305 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001306 struct sensor_device_attribute *sensor_attr = \
1307 to_sensor_dev_attr(attr); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001308 int nr = sensor_attr->index; \
1309 return sprintf(buf, "%d\n", data->reg[nr]); \
1310}
1311
1312show_pwm_reg(pwm_mode)
1313show_pwm_reg(pwm_enable)
1314show_pwm_reg(pwm)
1315
1316static ssize_t
1317store_pwm_mode(struct device *dev, struct device_attribute *attr,
1318 const char *buf, size_t count)
1319{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001320 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +02001321 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1322 int nr = sensor_attr->index;
Guenter Roeckbce26c52011-02-04 12:54:14 -08001323 unsigned long val;
1324 int err;
Rudolf Marek08c79952006-07-05 18:14:31 +02001325 u16 reg;
1326
Guenter Roeckbce26c52011-02-04 12:54:14 -08001327 err = strict_strtoul(buf, 10, &val);
1328 if (err < 0)
1329 return err;
1330
Rudolf Marek08c79952006-07-05 18:14:31 +02001331 if (val > 1)
1332 return -EINVAL;
1333 mutex_lock(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001334 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +02001335 data->pwm_mode[nr] = val;
1336 reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
1337 if (!val)
1338 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
David Hubbard1ea6dd32007-06-24 11:16:15 +02001339 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
Rudolf Marek08c79952006-07-05 18:14:31 +02001340 mutex_unlock(&data->update_lock);
1341 return count;
1342}
1343
1344static ssize_t
1345store_pwm(struct device *dev, struct device_attribute *attr,
1346 const char *buf, size_t count)
1347{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001348 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +02001349 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1350 int nr = sensor_attr->index;
Guenter Roeckbce26c52011-02-04 12:54:14 -08001351 unsigned long val;
1352 int err;
1353
1354 err = strict_strtoul(buf, 10, &val);
1355 if (err < 0)
1356 return err;
1357
1358 val = SENSORS_LIMIT(val, 0, 255);
Rudolf Marek08c79952006-07-05 18:14:31 +02001359
1360 mutex_lock(&data->update_lock);
1361 data->pwm[nr] = val;
Guenter Roeck279af1a2011-02-13 22:34:47 -08001362 w83627ehf_write_value(data, data->REG_PWM[nr], val);
Rudolf Marek08c79952006-07-05 18:14:31 +02001363 mutex_unlock(&data->update_lock);
1364 return count;
1365}
1366
1367static ssize_t
1368store_pwm_enable(struct device *dev, struct device_attribute *attr,
1369 const char *buf, size_t count)
1370{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001371 struct w83627ehf_data *data = dev_get_drvdata(dev);
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001372 struct w83627ehf_sio_data *sio_data = dev->platform_data;
Rudolf Marek08c79952006-07-05 18:14:31 +02001373 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1374 int nr = sensor_attr->index;
Guenter Roeckbce26c52011-02-04 12:54:14 -08001375 unsigned long val;
1376 int err;
Rudolf Marek08c79952006-07-05 18:14:31 +02001377 u16 reg;
1378
Guenter Roeckbce26c52011-02-04 12:54:14 -08001379 err = strict_strtoul(buf, 10, &val);
1380 if (err < 0)
1381 return err;
1382
Guenter Roeckb84bb512011-02-13 23:01:25 -08001383 if (!val || (val > 4 && val != data->pwm_enable_orig[nr]))
Rudolf Marek08c79952006-07-05 18:14:31 +02001384 return -EINVAL;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001385 /* SmartFan III mode is not supported on NCT6776F */
1386 if (sio_data->kind == nct6776 && val == 4)
1387 return -EINVAL;
1388
Rudolf Marek08c79952006-07-05 18:14:31 +02001389 mutex_lock(&data->update_lock);
Rudolf Marek08c79952006-07-05 18:14:31 +02001390 data->pwm_enable[nr] = val;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001391 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1392 reg = w83627ehf_read_value(data,
1393 NCT6775_REG_FAN_MODE[nr]);
1394 reg &= 0x0f;
1395 reg |= (val - 1) << 4;
1396 w83627ehf_write_value(data,
1397 NCT6775_REG_FAN_MODE[nr], reg);
1398 } else {
1399 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1400 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
1401 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
1402 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1403 }
Rudolf Marek08c79952006-07-05 18:14:31 +02001404 mutex_unlock(&data->update_lock);
1405 return count;
1406}
1407
1408
1409#define show_tol_temp(reg) \
1410static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1411 char *buf) \
1412{ \
1413 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001414 struct sensor_device_attribute *sensor_attr = \
1415 to_sensor_dev_attr(attr); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001416 int nr = sensor_attr->index; \
Guenter Roeckbce26c52011-02-04 12:54:14 -08001417 return sprintf(buf, "%d\n", data->reg[nr] * 1000); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001418}
1419
1420show_tol_temp(tolerance)
1421show_tol_temp(target_temp)
1422
1423static ssize_t
1424store_target_temp(struct device *dev, struct device_attribute *attr,
1425 const char *buf, size_t count)
1426{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001427 struct w83627ehf_data *data = dev_get_drvdata(dev);
Rudolf Marek08c79952006-07-05 18:14:31 +02001428 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1429 int nr = sensor_attr->index;
Guenter Roeckbce26c52011-02-04 12:54:14 -08001430 long val;
1431 int err;
1432
1433 err = strict_strtol(buf, 10, &val);
1434 if (err < 0)
1435 return err;
1436
1437 val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 127);
Rudolf Marek08c79952006-07-05 18:14:31 +02001438
1439 mutex_lock(&data->update_lock);
1440 data->target_temp[nr] = val;
Guenter Roeck279af1a2011-02-13 22:34:47 -08001441 w83627ehf_write_value(data, data->REG_TARGET[nr], val);
Rudolf Marek08c79952006-07-05 18:14:31 +02001442 mutex_unlock(&data->update_lock);
1443 return count;
1444}
1445
1446static ssize_t
1447store_tolerance(struct device *dev, struct device_attribute *attr,
1448 const char *buf, size_t count)
1449{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001450 struct w83627ehf_data *data = dev_get_drvdata(dev);
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001451 struct w83627ehf_sio_data *sio_data = dev->platform_data;
Rudolf Marek08c79952006-07-05 18:14:31 +02001452 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1453 int nr = sensor_attr->index;
1454 u16 reg;
Guenter Roeckbce26c52011-02-04 12:54:14 -08001455 long val;
1456 int err;
1457
1458 err = strict_strtol(buf, 10, &val);
1459 if (err < 0)
1460 return err;
1461
Rudolf Marek08c79952006-07-05 18:14:31 +02001462 /* Limit the temp to 0C - 15C */
Guenter Roeckbce26c52011-02-04 12:54:14 -08001463 val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 15);
Rudolf Marek08c79952006-07-05 18:14:31 +02001464
1465 mutex_lock(&data->update_lock);
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001466 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1467 /* Limit tolerance further for NCT6776F */
1468 if (sio_data->kind == nct6776 && val > 7)
1469 val = 7;
1470 reg = w83627ehf_read_value(data, NCT6775_REG_FAN_MODE[nr]);
Rudolf Marek08c79952006-07-05 18:14:31 +02001471 reg = (reg & 0xf0) | val;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001472 w83627ehf_write_value(data, NCT6775_REG_FAN_MODE[nr], reg);
1473 } else {
1474 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
1475 if (nr == 1)
1476 reg = (reg & 0x0f) | (val << 4);
1477 else
1478 reg = (reg & 0xf0) | val;
1479 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
1480 }
1481 data->tolerance[nr] = val;
Rudolf Marek08c79952006-07-05 18:14:31 +02001482 mutex_unlock(&data->update_lock);
1483 return count;
1484}
1485
1486static struct sensor_device_attribute sda_pwm[] = {
1487 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
1488 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
1489 SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
1490 SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
1491};
1492
1493static struct sensor_device_attribute sda_pwm_mode[] = {
1494 SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1495 store_pwm_mode, 0),
1496 SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1497 store_pwm_mode, 1),
1498 SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1499 store_pwm_mode, 2),
1500 SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1501 store_pwm_mode, 3),
1502};
1503
1504static struct sensor_device_attribute sda_pwm_enable[] = {
1505 SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1506 store_pwm_enable, 0),
1507 SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1508 store_pwm_enable, 1),
1509 SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1510 store_pwm_enable, 2),
1511 SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1512 store_pwm_enable, 3),
1513};
1514
1515static struct sensor_device_attribute sda_target_temp[] = {
1516 SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1517 store_target_temp, 0),
1518 SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1519 store_target_temp, 1),
1520 SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1521 store_target_temp, 2),
1522 SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1523 store_target_temp, 3),
1524};
1525
1526static struct sensor_device_attribute sda_tolerance[] = {
1527 SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1528 store_tolerance, 0),
1529 SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1530 store_tolerance, 1),
1531 SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1532 store_tolerance, 2),
1533 SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1534 store_tolerance, 3),
1535};
1536
Rudolf Marek08c79952006-07-05 18:14:31 +02001537/* Smart Fan registers */
1538
1539#define fan_functions(reg, REG) \
1540static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1541 char *buf) \
1542{ \
1543 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001544 struct sensor_device_attribute *sensor_attr = \
1545 to_sensor_dev_attr(attr); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001546 int nr = sensor_attr->index; \
1547 return sprintf(buf, "%d\n", data->reg[nr]); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001548} \
Rudolf Marek08c79952006-07-05 18:14:31 +02001549static ssize_t \
1550store_##reg(struct device *dev, struct device_attribute *attr, \
1551 const char *buf, size_t count) \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001552{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001553 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001554 struct sensor_device_attribute *sensor_attr = \
1555 to_sensor_dev_attr(attr); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001556 int nr = sensor_attr->index; \
Guenter Roeckbce26c52011-02-04 12:54:14 -08001557 unsigned long val; \
1558 int err; \
1559 err = strict_strtoul(buf, 10, &val); \
1560 if (err < 0) \
1561 return err; \
1562 val = SENSORS_LIMIT(val, 1, 255); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001563 mutex_lock(&data->update_lock); \
1564 data->reg[nr] = val; \
Guenter Roeckda2e0252010-08-14 21:08:55 +02001565 w83627ehf_write_value(data, data->REG_##REG[nr], val); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001566 mutex_unlock(&data->update_lock); \
1567 return count; \
1568}
1569
Daniel J Blueman41e9a062009-12-14 18:01:37 -08001570fan_functions(fan_start_output, FAN_START_OUTPUT)
1571fan_functions(fan_stop_output, FAN_STOP_OUTPUT)
1572fan_functions(fan_max_output, FAN_MAX_OUTPUT)
1573fan_functions(fan_step_output, FAN_STEP_OUTPUT)
Rudolf Marek08c79952006-07-05 18:14:31 +02001574
1575#define fan_time_functions(reg, REG) \
1576static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1577 char *buf) \
1578{ \
1579 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001580 struct sensor_device_attribute *sensor_attr = \
1581 to_sensor_dev_attr(attr); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001582 int nr = sensor_attr->index; \
1583 return sprintf(buf, "%d\n", \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001584 step_time_from_reg(data->reg[nr], \
1585 data->pwm_mode[nr])); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001586} \
1587\
1588static ssize_t \
1589store_##reg(struct device *dev, struct device_attribute *attr, \
1590 const char *buf, size_t count) \
1591{ \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001592 struct w83627ehf_data *data = dev_get_drvdata(dev); \
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001593 struct sensor_device_attribute *sensor_attr = \
1594 to_sensor_dev_attr(attr); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001595 int nr = sensor_attr->index; \
Guenter Roeckbce26c52011-02-04 12:54:14 -08001596 unsigned long val; \
1597 int err; \
1598 err = strict_strtoul(buf, 10, &val); \
1599 if (err < 0) \
1600 return err; \
1601 val = step_time_to_reg(val, data->pwm_mode[nr]); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001602 mutex_lock(&data->update_lock); \
1603 data->reg[nr] = val; \
David Hubbard1ea6dd32007-06-24 11:16:15 +02001604 w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
Rudolf Marek08c79952006-07-05 18:14:31 +02001605 mutex_unlock(&data->update_lock); \
1606 return count; \
1607} \
1608
1609fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1610
David Hubbard1ea6dd32007-06-24 11:16:15 +02001611static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1612 char *buf)
1613{
1614 struct w83627ehf_data *data = dev_get_drvdata(dev);
1615
1616 return sprintf(buf, "%s\n", data->name);
1617}
1618static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
Rudolf Marek08c79952006-07-05 18:14:31 +02001619
1620static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1621 SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1622 store_fan_stop_time, 3),
Daniel J Blueman41e9a062009-12-14 18:01:37 -08001623 SENSOR_ATTR(pwm4_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1624 store_fan_start_output, 3),
1625 SENSOR_ATTR(pwm4_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1626 store_fan_stop_output, 3),
1627 SENSOR_ATTR(pwm4_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1628 store_fan_max_output, 3),
1629 SENSOR_ATTR(pwm4_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1630 store_fan_step_output, 3),
Rudolf Marek08c79952006-07-05 18:14:31 +02001631};
1632
Jean Delvareeff76872011-11-04 12:00:48 +01001633static struct sensor_device_attribute sda_sf3_arrays_fan3[] = {
1634 SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1635 store_fan_stop_time, 2),
1636 SENSOR_ATTR(pwm3_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1637 store_fan_start_output, 2),
1638 SENSOR_ATTR(pwm3_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1639 store_fan_stop_output, 2),
1640};
1641
Rudolf Marek08c79952006-07-05 18:14:31 +02001642static struct sensor_device_attribute sda_sf3_arrays[] = {
1643 SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1644 store_fan_stop_time, 0),
1645 SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1646 store_fan_stop_time, 1),
Daniel J Blueman41e9a062009-12-14 18:01:37 -08001647 SENSOR_ATTR(pwm1_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1648 store_fan_start_output, 0),
1649 SENSOR_ATTR(pwm2_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1650 store_fan_start_output, 1),
Daniel J Blueman41e9a062009-12-14 18:01:37 -08001651 SENSOR_ATTR(pwm1_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1652 store_fan_stop_output, 0),
1653 SENSOR_ATTR(pwm2_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1654 store_fan_stop_output, 1),
Guenter Roeckda2e0252010-08-14 21:08:55 +02001655};
Daniel J Blueman41e9a062009-12-14 18:01:37 -08001656
Guenter Roeckda2e0252010-08-14 21:08:55 +02001657
1658/*
1659 * pwm1 and pwm3 don't support max and step settings on all chips.
1660 * Need to check support while generating/removing attribute files.
1661 */
1662static struct sensor_device_attribute sda_sf3_max_step_arrays[] = {
1663 SENSOR_ATTR(pwm1_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1664 store_fan_max_output, 0),
1665 SENSOR_ATTR(pwm1_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1666 store_fan_step_output, 0),
Daniel J Blueman41e9a062009-12-14 18:01:37 -08001667 SENSOR_ATTR(pwm2_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1668 store_fan_max_output, 1),
1669 SENSOR_ATTR(pwm2_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1670 store_fan_step_output, 1),
Guenter Roeckda2e0252010-08-14 21:08:55 +02001671 SENSOR_ATTR(pwm3_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1672 store_fan_max_output, 2),
1673 SENSOR_ATTR(pwm3_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1674 store_fan_step_output, 2),
Rudolf Marek08c79952006-07-05 18:14:31 +02001675};
1676
Jean Delvarefc18d6c2007-06-24 11:19:42 +02001677static ssize_t
1678show_vid(struct device *dev, struct device_attribute *attr, char *buf)
1679{
1680 struct w83627ehf_data *data = dev_get_drvdata(dev);
1681 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1682}
1683static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
1684
Dmitry Artamonow363a12a2011-08-12 16:41:11 -04001685
1686/* Case open detection */
1687
1688static ssize_t
1689show_caseopen(struct device *dev, struct device_attribute *attr, char *buf)
1690{
1691 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1692
1693 return sprintf(buf, "%d\n",
1694 !!(data->caseopen & to_sensor_dev_attr_2(attr)->index));
1695}
1696
1697static ssize_t
1698clear_caseopen(struct device *dev, struct device_attribute *attr,
1699 const char *buf, size_t count)
1700{
1701 struct w83627ehf_data *data = dev_get_drvdata(dev);
1702 unsigned long val;
1703 u16 reg, mask;
1704
1705 if (strict_strtoul(buf, 10, &val) || val != 0)
1706 return -EINVAL;
1707
1708 mask = to_sensor_dev_attr_2(attr)->nr;
1709
1710 mutex_lock(&data->update_lock);
1711 reg = w83627ehf_read_value(data, W83627EHF_REG_CASEOPEN_CLR);
1712 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg | mask);
1713 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg & ~mask);
1714 data->valid = 0; /* Force cache refresh */
1715 mutex_unlock(&data->update_lock);
1716
1717 return count;
1718}
1719
1720static struct sensor_device_attribute_2 sda_caseopen[] = {
1721 SENSOR_ATTR_2(intrusion0_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1722 clear_caseopen, 0x80, 0x10),
1723 SENSOR_ATTR_2(intrusion1_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1724 clear_caseopen, 0x40, 0x40),
1725};
1726
Jean Delvare08e7e272005-04-25 22:43:25 +02001727/*
David Hubbard1ea6dd32007-06-24 11:16:15 +02001728 * Driver and device management
Jean Delvare08e7e272005-04-25 22:43:25 +02001729 */
1730
David Hubbardc18beb52006-09-24 21:04:38 +02001731static void w83627ehf_device_remove_files(struct device *dev)
1732{
1733 /* some entries in the following arrays may not have been used in
1734 * device_create_file(), but device_remove_file() will ignore them */
1735 int i;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001736 struct w83627ehf_data *data = dev_get_drvdata(dev);
David Hubbardc18beb52006-09-24 21:04:38 +02001737
1738 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1739 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
Guenter Roeckda2e0252010-08-14 21:08:55 +02001740 for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
1741 struct sensor_device_attribute *attr =
1742 &sda_sf3_max_step_arrays[i];
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001743 if (data->REG_FAN_STEP_OUTPUT &&
1744 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff)
Guenter Roeckda2e0252010-08-14 21:08:55 +02001745 device_remove_file(dev, &attr->dev_attr);
1746 }
Jean Delvareeff76872011-11-04 12:00:48 +01001747 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan3); i++)
1748 device_remove_file(dev, &sda_sf3_arrays_fan3[i].dev_attr);
David Hubbardc18beb52006-09-24 21:04:38 +02001749 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1750 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001751 for (i = 0; i < data->in_num; i++) {
Gong Juna157d062009-03-30 21:46:43 +02001752 if ((i == 6) && data->in6_skip)
1753 continue;
David Hubbardc18beb52006-09-24 21:04:38 +02001754 device_remove_file(dev, &sda_in_input[i].dev_attr);
1755 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1756 device_remove_file(dev, &sda_in_min[i].dev_attr);
1757 device_remove_file(dev, &sda_in_max[i].dev_attr);
1758 }
1759 for (i = 0; i < 5; i++) {
1760 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1761 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1762 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1763 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1764 }
Gong Jun237c8d22009-03-30 21:46:42 +02001765 for (i = 0; i < data->pwm_num; i++) {
David Hubbardc18beb52006-09-24 21:04:38 +02001766 device_remove_file(dev, &sda_pwm[i].dev_attr);
1767 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1768 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1769 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1770 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1771 }
Guenter Roeckd36cf322011-02-07 15:08:54 -08001772 for (i = 0; i < NUM_REG_TEMP; i++) {
1773 if (!(data->have_temp & (1 << i)))
Gong Juna157d062009-03-30 21:46:43 +02001774 continue;
1775 device_remove_file(dev, &sda_temp_input[i].dev_attr);
Guenter Roeckd36cf322011-02-07 15:08:54 -08001776 device_remove_file(dev, &sda_temp_label[i].dev_attr);
Jean Delvareeff76872011-11-04 12:00:48 +01001777 if (i == 2 && data->temp3_val_only)
1778 continue;
Gong Juna157d062009-03-30 21:46:43 +02001779 device_remove_file(dev, &sda_temp_max[i].dev_attr);
1780 device_remove_file(dev, &sda_temp_max_hyst[i].dev_attr);
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001781 if (i > 2)
1782 continue;
Gong Juna157d062009-03-30 21:46:43 +02001783 device_remove_file(dev, &sda_temp_alarm[i].dev_attr);
1784 device_remove_file(dev, &sda_temp_type[i].dev_attr);
1785 }
David Hubbard1ea6dd32007-06-24 11:16:15 +02001786
Dmitry Artamonow363a12a2011-08-12 16:41:11 -04001787 device_remove_file(dev, &sda_caseopen[0].dev_attr);
1788 device_remove_file(dev, &sda_caseopen[1].dev_attr);
1789
David Hubbard1ea6dd32007-06-24 11:16:15 +02001790 device_remove_file(dev, &dev_attr_name);
Jean Delvarecbe311f2008-01-03 21:22:44 +01001791 device_remove_file(dev, &dev_attr_cpu0_vid);
David Hubbardc18beb52006-09-24 21:04:38 +02001792}
1793
David Hubbard1ea6dd32007-06-24 11:16:15 +02001794/* Get the monitoring functions started */
Jean Delvarebf164c52011-10-13 15:49:08 -04001795static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data,
1796 enum kinds kind)
Jean Delvare08e7e272005-04-25 22:43:25 +02001797{
1798 int i;
Jean Delvareda667362007-06-24 11:21:02 +02001799 u8 tmp, diode;
Jean Delvare08e7e272005-04-25 22:43:25 +02001800
1801 /* Start monitoring is needed */
David Hubbard1ea6dd32007-06-24 11:16:15 +02001802 tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
Jean Delvare08e7e272005-04-25 22:43:25 +02001803 if (!(tmp & 0x01))
David Hubbard1ea6dd32007-06-24 11:16:15 +02001804 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
Jean Delvare08e7e272005-04-25 22:43:25 +02001805 tmp | 0x01);
1806
Guenter Roeckd36cf322011-02-07 15:08:54 -08001807 /* Enable temperature sensors if needed */
1808 for (i = 0; i < NUM_REG_TEMP; i++) {
1809 if (!(data->have_temp & (1 << i)))
1810 continue;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001811 if (!data->reg_temp_config[i])
Guenter Roeckd36cf322011-02-07 15:08:54 -08001812 continue;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001813 tmp = w83627ehf_read_value(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001814 data->reg_temp_config[i]);
Jean Delvare08e7e272005-04-25 22:43:25 +02001815 if (tmp & 0x01)
David Hubbard1ea6dd32007-06-24 11:16:15 +02001816 w83627ehf_write_value(data,
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001817 data->reg_temp_config[i],
Jean Delvare08e7e272005-04-25 22:43:25 +02001818 tmp & 0xfe);
1819 }
Jean Delvared3130f02007-06-24 11:20:13 +02001820
1821 /* Enable VBAT monitoring if needed */
1822 tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
1823 if (!(tmp & 0x01))
1824 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01);
Jean Delvareda667362007-06-24 11:21:02 +02001825
1826 /* Get thermal sensor types */
Jean Delvarebf164c52011-10-13 15:49:08 -04001827 switch (kind) {
1828 case w83627ehf:
1829 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
1830 break;
Jean Delvareeff76872011-11-04 12:00:48 +01001831 case w83627uhg:
1832 diode = 0x00;
1833 break;
Jean Delvarebf164c52011-10-13 15:49:08 -04001834 default:
1835 diode = 0x70;
1836 }
Jean Delvareda667362007-06-24 11:21:02 +02001837 for (i = 0; i < 3; i++) {
Guenter Roeckbfa02b02011-11-06 20:25:18 +01001838 const char *label = NULL;
1839
1840 if (data->temp_label)
1841 label = data->temp_label[data->temp_src[i]];
Jean Delvare2265cef2011-11-04 12:00:47 +01001842
1843 /* Digital source overrides analog type */
Guenter Roeckbfa02b02011-11-06 20:25:18 +01001844 if (label && strncmp(label, "PECI", 4) == 0)
Jean Delvare2265cef2011-11-04 12:00:47 +01001845 data->temp_type[i] = 6;
Guenter Roeckbfa02b02011-11-06 20:25:18 +01001846 else if (label && strncmp(label, "AMD", 3) == 0)
Jean Delvare2265cef2011-11-04 12:00:47 +01001847 data->temp_type[i] = 5;
1848 else if ((tmp & (0x02 << i)))
Jean Delvarebf164c52011-10-13 15:49:08 -04001849 data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 3;
Jean Delvareda667362007-06-24 11:21:02 +02001850 else
1851 data->temp_type[i] = 4; /* thermistor */
1852 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001853}
1854
Guenter Roeckec3e5a12011-02-02 08:46:49 -08001855static void w82627ehf_swap_tempreg(struct w83627ehf_data *data,
1856 int r1, int r2)
1857{
1858 u16 tmp;
1859
1860 tmp = data->temp_src[r1];
1861 data->temp_src[r1] = data->temp_src[r2];
1862 data->temp_src[r2] = tmp;
1863
1864 tmp = data->reg_temp[r1];
1865 data->reg_temp[r1] = data->reg_temp[r2];
1866 data->reg_temp[r2] = tmp;
1867
1868 tmp = data->reg_temp_over[r1];
1869 data->reg_temp_over[r1] = data->reg_temp_over[r2];
1870 data->reg_temp_over[r2] = tmp;
1871
1872 tmp = data->reg_temp_hyst[r1];
1873 data->reg_temp_hyst[r1] = data->reg_temp_hyst[r2];
1874 data->reg_temp_hyst[r2] = tmp;
1875
1876 tmp = data->reg_temp_config[r1];
1877 data->reg_temp_config[r1] = data->reg_temp_config[r2];
1878 data->reg_temp_config[r2] = tmp;
1879}
1880
Jean Delvare03f5de22011-10-13 10:43:14 -04001881static void __devinit
Jean Delvare6ba71de2011-11-04 12:00:47 +01001882w83627ehf_set_temp_reg_ehf(struct w83627ehf_data *data, int n_temp)
1883{
1884 int i;
1885
1886 for (i = 0; i < n_temp; i++) {
1887 data->reg_temp[i] = W83627EHF_REG_TEMP[i];
1888 data->reg_temp_over[i] = W83627EHF_REG_TEMP_OVER[i];
1889 data->reg_temp_hyst[i] = W83627EHF_REG_TEMP_HYST[i];
1890 data->reg_temp_config[i] = W83627EHF_REG_TEMP_CONFIG[i];
1891 }
1892}
1893
1894static void __devinit
Jean Delvare03f5de22011-10-13 10:43:14 -04001895w83627ehf_check_fan_inputs(const struct w83627ehf_sio_data *sio_data,
1896 struct w83627ehf_data *data)
1897{
1898 int fan3pin, fan4pin, fan4min, fan5pin, regval;
1899
Jean Delvareeff76872011-11-04 12:00:48 +01001900 /* The W83627UHG is simple, only two fan inputs, no config */
1901 if (sio_data->kind == w83627uhg) {
1902 data->has_fan = 0x03; /* fan1 and fan2 */
1903 data->has_fan_min = 0x03;
1904 return;
1905 }
1906
Jean Delvare03f5de22011-10-13 10:43:14 -04001907 superio_enter(sio_data->sioreg);
1908
1909 /* fan4 and fan5 share some pins with the GPIO and serial flash */
1910 if (sio_data->kind == nct6775) {
1911 /* On NCT6775, fan4 shares pins with the fdc interface */
1912 fan3pin = 1;
1913 fan4pin = !(superio_inb(sio_data->sioreg, 0x2A) & 0x80);
1914 fan4min = 0;
1915 fan5pin = 0;
1916 } else if (sio_data->kind == nct6776) {
1917 fan3pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x40);
1918 fan4pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x01);
1919 fan5pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x02);
1920 fan4min = fan4pin;
1921 } else if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) {
1922 fan3pin = 1;
1923 fan4pin = superio_inb(sio_data->sioreg, 0x27) & 0x40;
1924 fan5pin = superio_inb(sio_data->sioreg, 0x27) & 0x20;
1925 fan4min = fan4pin;
1926 } else {
1927 fan3pin = 1;
1928 fan4pin = !(superio_inb(sio_data->sioreg, 0x29) & 0x06);
1929 fan5pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x02);
1930 fan4min = fan4pin;
1931 }
1932
1933 superio_exit(sio_data->sioreg);
1934
1935 data->has_fan = data->has_fan_min = 0x03; /* fan1 and fan2 */
1936 data->has_fan |= (fan3pin << 2);
1937 data->has_fan_min |= (fan3pin << 2);
1938
1939 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1940 /*
1941 * NCT6775F and NCT6776F don't have the W83627EHF_REG_FANDIV1
1942 * register
1943 */
1944 data->has_fan |= (fan4pin << 3) | (fan5pin << 4);
1945 data->has_fan_min |= (fan4min << 3) | (fan5pin << 4);
1946 } else {
1947 /*
1948 * It looks like fan4 and fan5 pins can be alternatively used
1949 * as fan on/off switches, but fan5 control is write only :/
1950 * We assume that if the serial interface is disabled, designers
1951 * connected fan5 as input unless they are emitting log 1, which
1952 * is not the default.
1953 */
1954 regval = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
1955 if ((regval & (1 << 2)) && fan4pin) {
1956 data->has_fan |= (1 << 3);
1957 data->has_fan_min |= (1 << 3);
1958 }
1959 if (!(regval & (1 << 1)) && fan5pin) {
1960 data->has_fan |= (1 << 4);
1961 data->has_fan_min |= (1 << 4);
1962 }
1963 }
1964}
1965
David Hubbard1ea6dd32007-06-24 11:16:15 +02001966static int __devinit w83627ehf_probe(struct platform_device *pdev)
Jean Delvare08e7e272005-04-25 22:43:25 +02001967{
David Hubbard1ea6dd32007-06-24 11:16:15 +02001968 struct device *dev = &pdev->dev;
1969 struct w83627ehf_sio_data *sio_data = dev->platform_data;
Jean Delvare08e7e272005-04-25 22:43:25 +02001970 struct w83627ehf_data *data;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001971 struct resource *res;
Jean Delvare03f5de22011-10-13 10:43:14 -04001972 u8 en_vrm10;
Jean Delvare08e7e272005-04-25 22:43:25 +02001973 int i, err = 0;
1974
David Hubbard1ea6dd32007-06-24 11:16:15 +02001975 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1976 if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001977 err = -EBUSY;
David Hubbard1ea6dd32007-06-24 11:16:15 +02001978 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1979 (unsigned long)res->start,
1980 (unsigned long)res->start + IOREGION_LENGTH - 1);
Jean Delvare08e7e272005-04-25 22:43:25 +02001981 goto exit;
1982 }
1983
Guenter Roecke7e1ca62011-02-04 13:24:30 -08001984 data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL);
1985 if (!data) {
Jean Delvare08e7e272005-04-25 22:43:25 +02001986 err = -ENOMEM;
1987 goto exit_release;
1988 }
Jean Delvare08e7e272005-04-25 22:43:25 +02001989
David Hubbard1ea6dd32007-06-24 11:16:15 +02001990 data->addr = res->start;
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001991 mutex_init(&data->lock);
Ingo Molnar9a61bf62006-01-18 23:19:26 +01001992 mutex_init(&data->update_lock);
David Hubbard1ea6dd32007-06-24 11:16:15 +02001993 data->name = w83627ehf_device_names[sio_data->kind];
1994 platform_set_drvdata(pdev, data);
Jean Delvare08e7e272005-04-25 22:43:25 +02001995
Gong Jun237c8d22009-03-30 21:46:42 +02001996 /* 627EHG and 627EHF have 10 voltage inputs; 627DHG and 667HG have 9 */
1997 data->in_num = (sio_data->kind == w83627ehf) ? 10 : 9;
Jean Delvareeff76872011-11-04 12:00:48 +01001998 /* 667HG, NCT6775F, and NCT6776F have 3 pwms, and 627UHG has only 2 */
1999 switch (sio_data->kind) {
2000 default:
2001 data->pwm_num = 4;
2002 break;
2003 case w83667hg:
2004 case w83667hg_b:
2005 case nct6775:
2006 case nct6776:
2007 data->pwm_num = 3;
2008 break;
2009 case w83627uhg:
2010 data->pwm_num = 2;
2011 break;
2012 }
Jean Delvare08e7e272005-04-25 22:43:25 +02002013
Jean Delvare6ba71de2011-11-04 12:00:47 +01002014 /* Default to 3 temperature inputs, code below will adjust as needed */
Guenter Roeckd36cf322011-02-07 15:08:54 -08002015 data->have_temp = 0x07;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002016
2017 /* Deal with temperature register setup first. */
2018 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
2019 int mask = 0;
2020
2021 /*
2022 * Display temperature sensor output only if it monitors
2023 * a source other than one already reported. Always display
2024 * first three temperature registers, though.
2025 */
2026 for (i = 0; i < NUM_REG_TEMP; i++) {
2027 u8 src;
2028
2029 data->reg_temp[i] = NCT6775_REG_TEMP[i];
2030 data->reg_temp_over[i] = NCT6775_REG_TEMP_OVER[i];
2031 data->reg_temp_hyst[i] = NCT6775_REG_TEMP_HYST[i];
2032 data->reg_temp_config[i] = NCT6775_REG_TEMP_CONFIG[i];
2033
2034 src = w83627ehf_read_value(data,
2035 NCT6775_REG_TEMP_SOURCE[i]);
2036 src &= 0x1f;
2037 if (src && !(mask & (1 << src))) {
2038 data->have_temp |= 1 << i;
2039 mask |= 1 << src;
2040 }
2041
2042 data->temp_src[i] = src;
2043
2044 /*
2045 * Now do some register swapping if index 0..2 don't
2046 * point to SYSTIN(1), CPUIN(2), and AUXIN(3).
2047 * Idea is to have the first three attributes
2048 * report SYSTIN, CPUIN, and AUXIN if possible
2049 * without overriding the basic system configuration.
2050 */
2051 if (i > 0 && data->temp_src[0] != 1
2052 && data->temp_src[i] == 1)
2053 w82627ehf_swap_tempreg(data, 0, i);
2054 if (i > 1 && data->temp_src[1] != 2
2055 && data->temp_src[i] == 2)
2056 w82627ehf_swap_tempreg(data, 1, i);
2057 if (i > 2 && data->temp_src[2] != 3
2058 && data->temp_src[i] == 3)
2059 w82627ehf_swap_tempreg(data, 2, i);
2060 }
2061 if (sio_data->kind == nct6776) {
2062 /*
2063 * On NCT6776, AUXTIN and VIN3 pins are shared.
2064 * Only way to detect it is to check if AUXTIN is used
2065 * as a temperature source, and if that source is
2066 * enabled.
2067 *
2068 * If that is the case, disable in6, which reports VIN3.
2069 * Otherwise disable temp3.
2070 */
2071 if (data->temp_src[2] == 3) {
2072 u8 reg;
2073
2074 if (data->reg_temp_config[2])
2075 reg = w83627ehf_read_value(data,
2076 data->reg_temp_config[2]);
2077 else
2078 reg = 0; /* Assume AUXTIN is used */
2079
2080 if (reg & 0x01)
2081 data->have_temp &= ~(1 << 2);
2082 else
2083 data->in6_skip = 1;
2084 }
Guenter Roeck02309ad2011-03-10 15:47:14 -08002085 data->temp_label = nct6776_temp_label;
2086 } else {
2087 data->temp_label = nct6775_temp_label;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002088 }
Guenter Roeckd36cf322011-02-07 15:08:54 -08002089 } else if (sio_data->kind == w83667hg_b) {
2090 u8 reg;
2091
Jean Delvare6ba71de2011-11-04 12:00:47 +01002092 w83627ehf_set_temp_reg_ehf(data, 4);
2093
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002094 /*
2095 * Temperature sources are selected with bank 0, registers 0x49
2096 * and 0x4a.
2097 */
Guenter Roeckd36cf322011-02-07 15:08:54 -08002098 reg = w83627ehf_read_value(data, 0x4a);
2099 data->temp_src[0] = reg >> 5;
2100 reg = w83627ehf_read_value(data, 0x49);
2101 data->temp_src[1] = reg & 0x07;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002102 data->temp_src[2] = (reg >> 4) & 0x07;
Guenter Roeckd36cf322011-02-07 15:08:54 -08002103
2104 /*
2105 * W83667HG-B has another temperature register at 0x7e.
2106 * The temperature source is selected with register 0x7d.
2107 * Support it if the source differs from already reported
2108 * sources.
2109 */
2110 reg = w83627ehf_read_value(data, 0x7d);
2111 reg &= 0x07;
2112 if (reg != data->temp_src[0] && reg != data->temp_src[1]
2113 && reg != data->temp_src[2]) {
2114 data->temp_src[3] = reg;
2115 data->have_temp |= 1 << 3;
2116 }
2117
2118 /*
2119 * Chip supports either AUXTIN or VIN3. Try to find out which
2120 * one.
2121 */
2122 reg = w83627ehf_read_value(data, W83627EHF_REG_TEMP_CONFIG[2]);
2123 if (data->temp_src[2] == 2 && (reg & 0x01))
2124 data->have_temp &= ~(1 << 2);
2125
2126 if ((data->temp_src[2] == 2 && (data->have_temp & (1 << 2)))
2127 || (data->temp_src[3] == 2 && (data->have_temp & (1 << 3))))
2128 data->in6_skip = 1;
2129
2130 data->temp_label = w83667hg_b_temp_label;
Jean Delvareeff76872011-11-04 12:00:48 +01002131 } else if (sio_data->kind == w83627uhg) {
2132 u8 reg;
2133
2134 w83627ehf_set_temp_reg_ehf(data, 3);
2135
2136 /*
2137 * Temperature sources for temp1 and temp2 are selected with
2138 * bank 0, registers 0x49 and 0x4a.
2139 */
2140 data->temp_src[0] = 0; /* SYSTIN */
2141 reg = w83627ehf_read_value(data, 0x49) & 0x07;
2142 /* Adjust to have the same mapping as other source registers */
2143 if (reg == 0)
2144 data->temp_src[1]++;
2145 else if (reg >= 2 && reg <= 5)
2146 data->temp_src[1] += 2;
2147 else /* should never happen */
2148 data->have_temp &= ~(1 << 1);
2149 reg = w83627ehf_read_value(data, 0x4a);
2150 data->temp_src[2] = reg >> 5;
2151
2152 /*
2153 * Skip temp3 if source is invalid or the same as temp1
2154 * or temp2.
2155 */
2156 if (data->temp_src[2] == 2 || data->temp_src[2] == 3 ||
2157 data->temp_src[2] == data->temp_src[0] ||
2158 ((data->have_temp & (1 << 1)) &&
2159 data->temp_src[2] == data->temp_src[1]))
2160 data->have_temp &= ~(1 << 2);
2161 else
2162 data->temp3_val_only = 1; /* No limit regs */
2163
2164 data->in6_skip = 1; /* No VIN3 */
2165
2166 data->temp_label = w83667hg_b_temp_label;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002167 } else {
Jean Delvare6ba71de2011-11-04 12:00:47 +01002168 w83627ehf_set_temp_reg_ehf(data, 3);
2169
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002170 /* Temperature sources are fixed */
Jean Delvare6ba71de2011-11-04 12:00:47 +01002171
2172 if (sio_data->kind == w83667hg) {
2173 u8 reg;
2174
2175 /*
2176 * Chip supports either AUXTIN or VIN3. Try to find
2177 * out which one.
2178 */
2179 reg = w83627ehf_read_value(data,
2180 W83627EHF_REG_TEMP_CONFIG[2]);
2181 if (reg & 0x01)
2182 data->have_temp &= ~(1 << 2);
2183 else
2184 data->in6_skip = 1;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002185 }
Gong Juna157d062009-03-30 21:46:43 +02002186 }
2187
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002188 if (sio_data->kind == nct6775) {
Guenter Roeck26bc4402011-02-11 08:00:58 -08002189 data->has_fan_div = true;
2190 data->fan_from_reg = fan_from_reg16;
2191 data->fan_from_reg_min = fan_from_reg8;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002192 data->REG_PWM = NCT6775_REG_PWM;
2193 data->REG_TARGET = NCT6775_REG_TARGET;
Guenter Roeck26bc4402011-02-11 08:00:58 -08002194 data->REG_FAN = NCT6775_REG_FAN;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002195 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2196 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2197 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2198 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2199 data->REG_FAN_MAX_OUTPUT = NCT6775_REG_FAN_MAX_OUTPUT;
2200 data->REG_FAN_STEP_OUTPUT = NCT6775_REG_FAN_STEP_OUTPUT;
2201 } else if (sio_data->kind == nct6776) {
Guenter Roeck26bc4402011-02-11 08:00:58 -08002202 data->has_fan_div = false;
2203 data->fan_from_reg = fan_from_reg13;
2204 data->fan_from_reg_min = fan_from_reg13;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002205 data->REG_PWM = NCT6775_REG_PWM;
2206 data->REG_TARGET = NCT6775_REG_TARGET;
Guenter Roeck26bc4402011-02-11 08:00:58 -08002207 data->REG_FAN = NCT6775_REG_FAN;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002208 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
2209 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2210 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2211 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2212 } else if (sio_data->kind == w83667hg_b) {
Guenter Roeck26bc4402011-02-11 08:00:58 -08002213 data->has_fan_div = true;
2214 data->fan_from_reg = fan_from_reg8;
2215 data->fan_from_reg_min = fan_from_reg8;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002216 data->REG_PWM = W83627EHF_REG_PWM;
2217 data->REG_TARGET = W83627EHF_REG_TARGET;
2218 data->REG_FAN = W83627EHF_REG_FAN;
2219 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2220 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2221 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2222 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
Guenter Roeckc39aeda2010-08-14 21:08:55 +02002223 data->REG_FAN_MAX_OUTPUT =
2224 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B;
2225 data->REG_FAN_STEP_OUTPUT =
2226 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B;
2227 } else {
Guenter Roeck26bc4402011-02-11 08:00:58 -08002228 data->has_fan_div = true;
2229 data->fan_from_reg = fan_from_reg8;
2230 data->fan_from_reg_min = fan_from_reg8;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002231 data->REG_PWM = W83627EHF_REG_PWM;
2232 data->REG_TARGET = W83627EHF_REG_TARGET;
2233 data->REG_FAN = W83627EHF_REG_FAN;
2234 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2235 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2236 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2237 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
Guenter Roeckc39aeda2010-08-14 21:08:55 +02002238 data->REG_FAN_MAX_OUTPUT =
2239 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON;
2240 data->REG_FAN_STEP_OUTPUT =
2241 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON;
2242 }
Guenter Roeckda2e0252010-08-14 21:08:55 +02002243
Jean Delvareeff76872011-11-04 12:00:48 +01002244 /* Setup input voltage scaling factors */
2245 if (sio_data->kind == w83627uhg)
2246 data->scale_in = scale_in_w83627uhg;
2247 else
2248 data->scale_in = scale_in_common;
2249
Jean Delvare08e7e272005-04-25 22:43:25 +02002250 /* Initialize the chip */
Jean Delvarebf164c52011-10-13 15:49:08 -04002251 w83627ehf_init_device(data, sio_data->kind);
Jean Delvare08e7e272005-04-25 22:43:25 +02002252
Jean Delvarefc18d6c2007-06-24 11:19:42 +02002253 data->vrm = vid_which_vrm();
2254 superio_enter(sio_data->sioreg);
Jean Delvarefc18d6c2007-06-24 11:19:42 +02002255 /* Read VID value */
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002256 if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b ||
2257 sio_data->kind == nct6775 || sio_data->kind == nct6776) {
Gong Jun237c8d22009-03-30 21:46:42 +02002258 /* W83667HG has different pins for VID input and output, so
2259 we can get the VID input values directly at logical device D
2260 0xe3. */
2261 superio_select(sio_data->sioreg, W83667HG_LD_VID);
2262 data->vid = superio_inb(sio_data->sioreg, 0xe3);
Jean Delvarecbe311f2008-01-03 21:22:44 +01002263 err = device_create_file(dev, &dev_attr_cpu0_vid);
2264 if (err)
2265 goto exit_release;
Jean Delvareeff76872011-11-04 12:00:48 +01002266 } else if (sio_data->kind != w83627uhg) {
Gong Jun237c8d22009-03-30 21:46:42 +02002267 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2268 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) {
2269 /* Set VID input sensibility if needed. In theory the
2270 BIOS should have set it, but in practice it's not
2271 always the case. We only do it for the W83627EHF/EHG
2272 because the W83627DHG is more complex in this
2273 respect. */
2274 if (sio_data->kind == w83627ehf) {
2275 en_vrm10 = superio_inb(sio_data->sioreg,
2276 SIO_REG_EN_VRM10);
2277 if ((en_vrm10 & 0x08) && data->vrm == 90) {
2278 dev_warn(dev, "Setting VID input "
2279 "voltage to TTL\n");
2280 superio_outb(sio_data->sioreg,
2281 SIO_REG_EN_VRM10,
2282 en_vrm10 & ~0x08);
2283 } else if (!(en_vrm10 & 0x08)
2284 && data->vrm == 100) {
2285 dev_warn(dev, "Setting VID input "
2286 "voltage to VRM10\n");
2287 superio_outb(sio_data->sioreg,
2288 SIO_REG_EN_VRM10,
2289 en_vrm10 | 0x08);
2290 }
2291 }
2292
2293 data->vid = superio_inb(sio_data->sioreg,
2294 SIO_REG_VID_DATA);
2295 if (sio_data->kind == w83627ehf) /* 6 VID pins only */
2296 data->vid &= 0x3f;
2297
2298 err = device_create_file(dev, &dev_attr_cpu0_vid);
2299 if (err)
2300 goto exit_release;
2301 } else {
2302 dev_info(dev, "VID pins in output mode, CPU VID not "
2303 "available\n");
2304 }
Jean Delvarefc18d6c2007-06-24 11:19:42 +02002305 }
2306
Ian Dobsond42e8692011-03-07 14:21:12 -08002307 if (fan_debounce &&
2308 (sio_data->kind == nct6775 || sio_data->kind == nct6776)) {
2309 u8 tmp;
2310
2311 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2312 tmp = superio_inb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE);
2313 if (sio_data->kind == nct6776)
2314 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2315 0x3e | tmp);
2316 else
2317 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2318 0x1e | tmp);
2319 pr_info("Enabled fan debounce for chip %s\n", data->name);
2320 }
2321
David Hubbard1ea6dd32007-06-24 11:16:15 +02002322 superio_exit(sio_data->sioreg);
Rudolf Marek08c79952006-07-05 18:14:31 +02002323
Jean Delvare03f5de22011-10-13 10:43:14 -04002324 w83627ehf_check_fan_inputs(sio_data, data);
Jean Delvare08e7e272005-04-25 22:43:25 +02002325
Mark M. Hoffmanea7be662007-08-05 12:19:01 -04002326 /* Read fan clock dividers immediately */
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002327 w83627ehf_update_fan_div_common(dev, data);
2328
2329 /* Read pwm data to save original values */
2330 w83627ehf_update_pwm_common(dev, data);
2331 for (i = 0; i < data->pwm_num; i++)
2332 data->pwm_enable_orig[i] = data->pwm_enable[i];
Mark M. Hoffmanea7be662007-08-05 12:19:01 -04002333
Guenter Roeckb84bb512011-02-13 23:01:25 -08002334 /* Read pwm data to save original values */
2335 w83627ehf_update_pwm_common(dev, data);
2336 for (i = 0; i < data->pwm_num; i++)
2337 data->pwm_enable_orig[i] = data->pwm_enable[i];
2338
Jean Delvare08e7e272005-04-25 22:43:25 +02002339 /* Register sysfs hooks */
Guenter Roecke7e1ca62011-02-04 13:24:30 -08002340 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++) {
2341 err = device_create_file(dev, &sda_sf3_arrays[i].dev_attr);
2342 if (err)
David Hubbardc18beb52006-09-24 21:04:38 +02002343 goto exit_remove;
Guenter Roecke7e1ca62011-02-04 13:24:30 -08002344 }
Rudolf Marek08c79952006-07-05 18:14:31 +02002345
Guenter Roeckda2e0252010-08-14 21:08:55 +02002346 for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
2347 struct sensor_device_attribute *attr =
2348 &sda_sf3_max_step_arrays[i];
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002349 if (data->REG_FAN_STEP_OUTPUT &&
2350 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff) {
Guenter Roeckda2e0252010-08-14 21:08:55 +02002351 err = device_create_file(dev, &attr->dev_attr);
2352 if (err)
2353 goto exit_remove;
2354 }
2355 }
Jean Delvareeff76872011-11-04 12:00:48 +01002356 /* if fan3 and fan4 are enabled create the sf3 files for them */
2357 if ((data->has_fan & (1 << 2)) && data->pwm_num >= 3)
2358 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan3); i++) {
2359 err = device_create_file(dev,
2360 &sda_sf3_arrays_fan3[i].dev_attr);
2361 if (err)
2362 goto exit_remove;
2363 }
Gong Jun237c8d22009-03-30 21:46:42 +02002364 if ((data->has_fan & (1 << 3)) && data->pwm_num >= 4)
David Hubbardc18beb52006-09-24 21:04:38 +02002365 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
Guenter Roecke7e1ca62011-02-04 13:24:30 -08002366 err = device_create_file(dev,
2367 &sda_sf3_arrays_fan4[i].dev_attr);
2368 if (err)
David Hubbardc18beb52006-09-24 21:04:38 +02002369 goto exit_remove;
2370 }
Rudolf Marek08c79952006-07-05 18:14:31 +02002371
Gong Juna157d062009-03-30 21:46:43 +02002372 for (i = 0; i < data->in_num; i++) {
2373 if ((i == 6) && data->in6_skip)
2374 continue;
David Hubbardc18beb52006-09-24 21:04:38 +02002375 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
2376 || (err = device_create_file(dev,
2377 &sda_in_alarm[i].dev_attr))
2378 || (err = device_create_file(dev,
2379 &sda_in_min[i].dev_attr))
2380 || (err = device_create_file(dev,
2381 &sda_in_max[i].dev_attr)))
2382 goto exit_remove;
Gong Juna157d062009-03-30 21:46:43 +02002383 }
Rudolf Marekcf0676f2006-03-23 16:25:22 +01002384
Yuan Mu412fec82006-02-05 23:24:16 +01002385 for (i = 0; i < 5; i++) {
Rudolf Marek08c79952006-07-05 18:14:31 +02002386 if (data->has_fan & (1 << i)) {
David Hubbardc18beb52006-09-24 21:04:38 +02002387 if ((err = device_create_file(dev,
2388 &sda_fan_input[i].dev_attr))
2389 || (err = device_create_file(dev,
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002390 &sda_fan_alarm[i].dev_attr)))
David Hubbardc18beb52006-09-24 21:04:38 +02002391 goto exit_remove;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002392 if (sio_data->kind != nct6776) {
2393 err = device_create_file(dev,
2394 &sda_fan_div[i].dev_attr);
2395 if (err)
2396 goto exit_remove;
2397 }
2398 if (data->has_fan_min & (1 << i)) {
2399 err = device_create_file(dev,
2400 &sda_fan_min[i].dev_attr);
2401 if (err)
2402 goto exit_remove;
2403 }
Gong Jun237c8d22009-03-30 21:46:42 +02002404 if (i < data->pwm_num &&
David Hubbardc18beb52006-09-24 21:04:38 +02002405 ((err = device_create_file(dev,
2406 &sda_pwm[i].dev_attr))
2407 || (err = device_create_file(dev,
2408 &sda_pwm_mode[i].dev_attr))
2409 || (err = device_create_file(dev,
2410 &sda_pwm_enable[i].dev_attr))
2411 || (err = device_create_file(dev,
2412 &sda_target_temp[i].dev_attr))
2413 || (err = device_create_file(dev,
2414 &sda_tolerance[i].dev_attr))))
2415 goto exit_remove;
Rudolf Marek08c79952006-07-05 18:14:31 +02002416 }
Jean Delvare08e7e272005-04-25 22:43:25 +02002417 }
Rudolf Marek08c79952006-07-05 18:14:31 +02002418
Guenter Roeckd36cf322011-02-07 15:08:54 -08002419 for (i = 0; i < NUM_REG_TEMP; i++) {
2420 if (!(data->have_temp & (1 << i)))
Gong Juna157d062009-03-30 21:46:43 +02002421 continue;
Guenter Roeckd36cf322011-02-07 15:08:54 -08002422 err = device_create_file(dev, &sda_temp_input[i].dev_attr);
2423 if (err)
2424 goto exit_remove;
2425 if (data->temp_label) {
2426 err = device_create_file(dev,
2427 &sda_temp_label[i].dev_attr);
2428 if (err)
2429 goto exit_remove;
2430 }
Jean Delvareeff76872011-11-04 12:00:48 +01002431 if (i == 2 && data->temp3_val_only)
2432 continue;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002433 if (data->reg_temp_over[i]) {
2434 err = device_create_file(dev,
2435 &sda_temp_max[i].dev_attr);
2436 if (err)
2437 goto exit_remove;
2438 }
2439 if (data->reg_temp_hyst[i]) {
2440 err = device_create_file(dev,
2441 &sda_temp_max_hyst[i].dev_attr);
2442 if (err)
2443 goto exit_remove;
2444 }
Guenter Roeckd36cf322011-02-07 15:08:54 -08002445 if (i > 2)
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002446 continue;
2447 if ((err = device_create_file(dev,
Gong Juna157d062009-03-30 21:46:43 +02002448 &sda_temp_alarm[i].dev_attr))
2449 || (err = device_create_file(dev,
2450 &sda_temp_type[i].dev_attr)))
David Hubbardc18beb52006-09-24 21:04:38 +02002451 goto exit_remove;
Gong Juna157d062009-03-30 21:46:43 +02002452 }
David Hubbardc18beb52006-09-24 21:04:38 +02002453
Dmitry Artamonow363a12a2011-08-12 16:41:11 -04002454 err = device_create_file(dev, &sda_caseopen[0].dev_attr);
2455 if (err)
2456 goto exit_remove;
2457
2458 if (sio_data->kind == nct6776) {
2459 err = device_create_file(dev, &sda_caseopen[1].dev_attr);
2460 if (err)
2461 goto exit_remove;
2462 }
2463
David Hubbard1ea6dd32007-06-24 11:16:15 +02002464 err = device_create_file(dev, &dev_attr_name);
2465 if (err)
2466 goto exit_remove;
2467
Tony Jones1beeffe2007-08-20 13:46:20 -07002468 data->hwmon_dev = hwmon_device_register(dev);
2469 if (IS_ERR(data->hwmon_dev)) {
2470 err = PTR_ERR(data->hwmon_dev);
David Hubbardc18beb52006-09-24 21:04:38 +02002471 goto exit_remove;
2472 }
Jean Delvare08e7e272005-04-25 22:43:25 +02002473
2474 return 0;
2475
David Hubbardc18beb52006-09-24 21:04:38 +02002476exit_remove:
2477 w83627ehf_device_remove_files(dev);
Jean Delvare08e7e272005-04-25 22:43:25 +02002478 kfree(data);
David Hubbard1ea6dd32007-06-24 11:16:15 +02002479 platform_set_drvdata(pdev, NULL);
Jean Delvare08e7e272005-04-25 22:43:25 +02002480exit_release:
David Hubbard1ea6dd32007-06-24 11:16:15 +02002481 release_region(res->start, IOREGION_LENGTH);
Jean Delvare08e7e272005-04-25 22:43:25 +02002482exit:
2483 return err;
2484}
2485
David Hubbard1ea6dd32007-06-24 11:16:15 +02002486static int __devexit w83627ehf_remove(struct platform_device *pdev)
Jean Delvare08e7e272005-04-25 22:43:25 +02002487{
David Hubbard1ea6dd32007-06-24 11:16:15 +02002488 struct w83627ehf_data *data = platform_get_drvdata(pdev);
Jean Delvare08e7e272005-04-25 22:43:25 +02002489
Tony Jones1beeffe2007-08-20 13:46:20 -07002490 hwmon_device_unregister(data->hwmon_dev);
David Hubbard1ea6dd32007-06-24 11:16:15 +02002491 w83627ehf_device_remove_files(&pdev->dev);
2492 release_region(data->addr, IOREGION_LENGTH);
2493 platform_set_drvdata(pdev, NULL);
Mark M. Hoffman943b0832005-07-15 21:39:18 -04002494 kfree(data);
Jean Delvare08e7e272005-04-25 22:43:25 +02002495
2496 return 0;
2497}
2498
David Hubbard1ea6dd32007-06-24 11:16:15 +02002499static struct platform_driver w83627ehf_driver = {
Laurent Riffardcdaf7932005-11-26 20:37:41 +01002500 .driver = {
Jean Delvare87218842006-09-03 22:36:14 +02002501 .owner = THIS_MODULE,
David Hubbard1ea6dd32007-06-24 11:16:15 +02002502 .name = DRVNAME,
Laurent Riffardcdaf7932005-11-26 20:37:41 +01002503 },
David Hubbard1ea6dd32007-06-24 11:16:15 +02002504 .probe = w83627ehf_probe,
2505 .remove = __devexit_p(w83627ehf_remove),
Jean Delvare08e7e272005-04-25 22:43:25 +02002506};
2507
David Hubbard1ea6dd32007-06-24 11:16:15 +02002508/* w83627ehf_find() looks for a '627 in the Super-I/O config space */
2509static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
2510 struct w83627ehf_sio_data *sio_data)
Jean Delvare08e7e272005-04-25 22:43:25 +02002511{
David Hubbard1ea6dd32007-06-24 11:16:15 +02002512 static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
2513 static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
2514 static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
Jean Delvarec1e48dc2009-06-15 18:39:50 +02002515 static const char __initdata sio_name_W83627DHG_P[] = "W83627DHG-P";
Jean Delvareeff76872011-11-04 12:00:48 +01002516 static const char __initdata sio_name_W83627UHG[] = "W83627UHG";
Gong Jun237c8d22009-03-30 21:46:42 +02002517 static const char __initdata sio_name_W83667HG[] = "W83667HG";
Guenter Roeckc39aeda2010-08-14 21:08:55 +02002518 static const char __initdata sio_name_W83667HG_B[] = "W83667HG-B";
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002519 static const char __initdata sio_name_NCT6775[] = "NCT6775F";
2520 static const char __initdata sio_name_NCT6776[] = "NCT6776F";
David Hubbard1ea6dd32007-06-24 11:16:15 +02002521
Jean Delvare08e7e272005-04-25 22:43:25 +02002522 u16 val;
David Hubbard1ea6dd32007-06-24 11:16:15 +02002523 const char *sio_name;
Jean Delvare08e7e272005-04-25 22:43:25 +02002524
David Hubbard1ea6dd32007-06-24 11:16:15 +02002525 superio_enter(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02002526
Jean Delvare67b671b2007-12-06 23:13:42 +01002527 if (force_id)
2528 val = force_id;
2529 else
2530 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
2531 | superio_inb(sioaddr, SIO_REG_DEVID + 1);
David Hubbard657c93b2007-02-14 21:15:04 +01002532 switch (val & SIO_ID_MASK) {
David Hubbard657c93b2007-02-14 21:15:04 +01002533 case SIO_W83627EHF_ID:
David Hubbard1ea6dd32007-06-24 11:16:15 +02002534 sio_data->kind = w83627ehf;
2535 sio_name = sio_name_W83627EHF;
2536 break;
David Hubbard657c93b2007-02-14 21:15:04 +01002537 case SIO_W83627EHG_ID:
David Hubbard1ea6dd32007-06-24 11:16:15 +02002538 sio_data->kind = w83627ehf;
2539 sio_name = sio_name_W83627EHG;
2540 break;
2541 case SIO_W83627DHG_ID:
2542 sio_data->kind = w83627dhg;
2543 sio_name = sio_name_W83627DHG;
David Hubbard657c93b2007-02-14 21:15:04 +01002544 break;
Jean Delvarec1e48dc2009-06-15 18:39:50 +02002545 case SIO_W83627DHG_P_ID:
2546 sio_data->kind = w83627dhg_p;
2547 sio_name = sio_name_W83627DHG_P;
2548 break;
Jean Delvareeff76872011-11-04 12:00:48 +01002549 case SIO_W83627UHG_ID:
2550 sio_data->kind = w83627uhg;
2551 sio_name = sio_name_W83627UHG;
2552 break;
Gong Jun237c8d22009-03-30 21:46:42 +02002553 case SIO_W83667HG_ID:
2554 sio_data->kind = w83667hg;
2555 sio_name = sio_name_W83667HG;
2556 break;
Guenter Roeckc39aeda2010-08-14 21:08:55 +02002557 case SIO_W83667HG_B_ID:
2558 sio_data->kind = w83667hg_b;
2559 sio_name = sio_name_W83667HG_B;
2560 break;
Guenter Roeckec3e5a12011-02-02 08:46:49 -08002561 case SIO_NCT6775_ID:
2562 sio_data->kind = nct6775;
2563 sio_name = sio_name_NCT6775;
2564 break;
2565 case SIO_NCT6776_ID:
2566 sio_data->kind = nct6776;
2567 sio_name = sio_name_NCT6776;
2568 break;
David Hubbard657c93b2007-02-14 21:15:04 +01002569 default:
Jean Delvare9f660362007-06-24 11:23:41 +02002570 if (val != 0xffff)
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002571 pr_debug("unsupported chip ID: 0x%04x\n", val);
David Hubbard1ea6dd32007-06-24 11:16:15 +02002572 superio_exit(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02002573 return -ENODEV;
2574 }
2575
David Hubbard1ea6dd32007-06-24 11:16:15 +02002576 /* We have a known chip, find the HWM I/O address */
2577 superio_select(sioaddr, W83627EHF_LD_HWM);
2578 val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
2579 | superio_inb(sioaddr, SIO_REG_ADDR + 1);
Jean Delvare1a641fc2007-04-23 14:41:16 -07002580 *addr = val & IOREGION_ALIGNMENT;
Jean Delvare2d8672c2005-07-19 23:56:35 +02002581 if (*addr == 0) {
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002582 pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02002583 superio_exit(sioaddr);
Jean Delvare08e7e272005-04-25 22:43:25 +02002584 return -ENODEV;
2585 }
2586
2587 /* Activate logical device if needed */
David Hubbard1ea6dd32007-06-24 11:16:15 +02002588 val = superio_inb(sioaddr, SIO_REG_ENABLE);
David Hubbard475ef852007-06-24 11:17:09 +02002589 if (!(val & 0x01)) {
Guenter Roecke7e1ca62011-02-04 13:24:30 -08002590 pr_warn("Forcibly enabling Super-I/O. "
2591 "Sensor is probably unusable.\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02002592 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
David Hubbard475ef852007-06-24 11:17:09 +02002593 }
Jean Delvare08e7e272005-04-25 22:43:25 +02002594
David Hubbard1ea6dd32007-06-24 11:16:15 +02002595 superio_exit(sioaddr);
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002596 pr_info("Found %s chip at %#x\n", sio_name, *addr);
David Hubbard1ea6dd32007-06-24 11:16:15 +02002597 sio_data->sioreg = sioaddr;
2598
Jean Delvare08e7e272005-04-25 22:43:25 +02002599 return 0;
2600}
2601
David Hubbard1ea6dd32007-06-24 11:16:15 +02002602/* when Super-I/O functions move to a separate file, the Super-I/O
2603 * bus will manage the lifetime of the device and this module will only keep
2604 * track of the w83627ehf driver. But since we platform_device_alloc(), we
2605 * must keep track of the device */
2606static struct platform_device *pdev;
2607
Jean Delvare08e7e272005-04-25 22:43:25 +02002608static int __init sensors_w83627ehf_init(void)
2609{
David Hubbard1ea6dd32007-06-24 11:16:15 +02002610 int err;
2611 unsigned short address;
2612 struct resource res;
2613 struct w83627ehf_sio_data sio_data;
2614
2615 /* initialize sio_data->kind and sio_data->sioreg.
2616 *
2617 * when Super-I/O functions move to a separate file, the Super-I/O
2618 * driver will probe 0x2e and 0x4e and auto-detect the presence of a
2619 * w83627ehf hardware monitor, and call probe() */
2620 if (w83627ehf_find(0x2e, &address, &sio_data) &&
2621 w83627ehf_find(0x4e, &address, &sio_data))
Jean Delvare08e7e272005-04-25 22:43:25 +02002622 return -ENODEV;
2623
David Hubbard1ea6dd32007-06-24 11:16:15 +02002624 err = platform_driver_register(&w83627ehf_driver);
2625 if (err)
2626 goto exit;
2627
Guenter Roecke7e1ca62011-02-04 13:24:30 -08002628 pdev = platform_device_alloc(DRVNAME, address);
2629 if (!pdev) {
David Hubbard1ea6dd32007-06-24 11:16:15 +02002630 err = -ENOMEM;
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002631 pr_err("Device allocation failed\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02002632 goto exit_unregister;
2633 }
2634
2635 err = platform_device_add_data(pdev, &sio_data,
2636 sizeof(struct w83627ehf_sio_data));
2637 if (err) {
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002638 pr_err("Platform data allocation failed\n");
David Hubbard1ea6dd32007-06-24 11:16:15 +02002639 goto exit_device_put;
2640 }
2641
2642 memset(&res, 0, sizeof(res));
2643 res.name = DRVNAME;
2644 res.start = address + IOREGION_OFFSET;
2645 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
2646 res.flags = IORESOURCE_IO;
Jean Delvareb9acb642009-01-07 16:37:35 +01002647
2648 err = acpi_check_resource_conflict(&res);
2649 if (err)
Hans de Goede18632f82009-02-17 19:59:54 +01002650 goto exit_device_put;
Jean Delvareb9acb642009-01-07 16:37:35 +01002651
David Hubbard1ea6dd32007-06-24 11:16:15 +02002652 err = platform_device_add_resources(pdev, &res, 1);
2653 if (err) {
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002654 pr_err("Device resource addition failed (%d)\n", err);
David Hubbard1ea6dd32007-06-24 11:16:15 +02002655 goto exit_device_put;
2656 }
2657
2658 /* platform_device_add calls probe() */
2659 err = platform_device_add(pdev);
2660 if (err) {
Joe Perchesabdc6fd2010-10-20 06:51:54 +00002661 pr_err("Device addition failed (%d)\n", err);
David Hubbard1ea6dd32007-06-24 11:16:15 +02002662 goto exit_device_put;
2663 }
2664
2665 return 0;
2666
2667exit_device_put:
2668 platform_device_put(pdev);
2669exit_unregister:
2670 platform_driver_unregister(&w83627ehf_driver);
2671exit:
2672 return err;
Jean Delvare08e7e272005-04-25 22:43:25 +02002673}
2674
2675static void __exit sensors_w83627ehf_exit(void)
2676{
David Hubbard1ea6dd32007-06-24 11:16:15 +02002677 platform_device_unregister(pdev);
2678 platform_driver_unregister(&w83627ehf_driver);
Jean Delvare08e7e272005-04-25 22:43:25 +02002679}
2680
2681MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
2682MODULE_DESCRIPTION("W83627EHF driver");
2683MODULE_LICENSE("GPL");
2684
2685module_init(sensors_w83627ehf_init);
2686module_exit(sensors_w83627ehf_exit);