1 /*
2 w83627ehf - Driver for the hardware monitoring functionality of
3 the Winbond W83627EHF Super-I/O chip
4 Copyright (C) 2005-2011 Jean Delvare <khali@linux-fr.org>
5 Copyright (C) 2006 Yuan Mu (Winbond),
6 Rudolf Marek <r.marek@assembler.cz>
7 David Hubbard <david.c.hubbard@gmail.com>
8 Daniel J Blueman <daniel.blueman@gmail.com>
9 Copyright (C) 2010 Sheng-Yuan Huang (Nuvoton) (PS00)
10
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
17 This driver also supports the W83627EHG, which is the lead-free
18 version of the W83627EHF.
19
20 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
37 Chip #vin #fan #pwm #temp chip IDs man ID
38 w83627ehf 10 5 4 3 0x8850 0x88 0x5ca3
39 0x8860 0xa1
40 w83627dhg 9 5 4 3 0xa020 0xc1 0x5ca3
41 w83627dhg-p 9 5 4 3 0xb070 0xc1 0x5ca3
42 w83627uhg 8 2 2 3 0xa230 0xc1 0x5ca3
43 w83667hg 9 5 3 3 0xa510 0xc1 0x5ca3
44 w83667hg-b 9 5 3 4 0xb350 0xc1 0x5ca3
45 nct6775f 9 4 3 9 0xb470 0xc1 0x5ca3
46 nct6776f 9 5 3 9 0xC330 0xc1 0x5ca3
47 */
48
49 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
50
51 #include <linux/module.h>
52 #include <linux/init.h>
53 #include <linux/slab.h>
54 #include <linux/jiffies.h>
55 #include <linux/platform_device.h>
56 #include <linux/hwmon.h>
57 #include <linux/hwmon-sysfs.h>
58 #include <linux/hwmon-vid.h>
59 #include <linux/err.h>
60 #include <linux/mutex.h>
61 #include <linux/acpi.h>
62 #include <linux/io.h>
63 #include "lm75.h"
64
65 enum kinds {
66 w83627ehf, w83627dhg, w83627dhg_p, w83627uhg,
67 w83667hg, w83667hg_b, nct6775, nct6776,
68 };
69
70 /* used to set data->name = w83627ehf_device_names[data->sio_kind] */
71 static const char * const w83627ehf_device_names[] = {
72 "w83627ehf",
73 "w83627dhg",
74 "w83627dhg",
75 "w83627uhg",
76 "w83667hg",
77 "w83667hg",
78 "nct6775",
79 "nct6776",
80 };
81
82 static unsigned short force_id;
83 module_param(force_id, ushort, 0);
84 MODULE_PARM_DESC(force_id, "Override the detected device ID");
85
86 static unsigned short fan_debounce;
87 module_param(fan_debounce, ushort, 0);
88 MODULE_PARM_DESC(fan_debounce, "Enable debouncing for fan RPM signal");
89
90 #define DRVNAME "w83627ehf"
91
92 /*
93 * Super-I/O constants and functions
94 */
95
96 #define W83627EHF_LD_HWM 0x0b
97 #define W83667HG_LD_VID 0x0d
98
99 #define SIO_REG_LDSEL 0x07 /* Logical device select */
100 #define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */
101 #define SIO_REG_EN_VRM10 0x2C /* GPIO3, GPIO4 selection */
102 #define SIO_REG_ENABLE 0x30 /* Logical device enable */
103 #define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
104 #define SIO_REG_VID_CTRL 0xF0 /* VID control */
105 #define SIO_REG_VID_DATA 0xF1 /* VID data */
106
107 #define SIO_W83627EHF_ID 0x8850
108 #define SIO_W83627EHG_ID 0x8860
109 #define SIO_W83627DHG_ID 0xa020
110 #define SIO_W83627DHG_P_ID 0xb070
111 #define SIO_W83627UHG_ID 0xa230
112 #define SIO_W83667HG_ID 0xa510
113 #define SIO_W83667HG_B_ID 0xb350
114 #define SIO_NCT6775_ID 0xb470
115 #define SIO_NCT6776_ID 0xc330
116 #define SIO_ID_MASK 0xFFF0
117
118 static inline void
superio_outb(int ioreg,int reg,int val)119 superio_outb(int ioreg, int reg, int val)
120 {
121 outb(reg, ioreg);
122 outb(val, ioreg + 1);
123 }
124
125 static inline int
superio_inb(int ioreg,int reg)126 superio_inb(int ioreg, int reg)
127 {
128 outb(reg, ioreg);
129 return inb(ioreg + 1);
130 }
131
132 static inline void
superio_select(int ioreg,int ld)133 superio_select(int ioreg, int ld)
134 {
135 outb(SIO_REG_LDSEL, ioreg);
136 outb(ld, ioreg + 1);
137 }
138
139 static inline void
superio_enter(int ioreg)140 superio_enter(int ioreg)
141 {
142 outb(0x87, ioreg);
143 outb(0x87, ioreg);
144 }
145
146 static inline void
superio_exit(int ioreg)147 superio_exit(int ioreg)
148 {
149 outb(0xaa, ioreg);
150 outb(0x02, ioreg);
151 outb(0x02, ioreg + 1);
152 }
153
154 /*
155 * ISA constants
156 */
157
158 #define IOREGION_ALIGNMENT (~7)
159 #define IOREGION_OFFSET 5
160 #define IOREGION_LENGTH 2
161 #define ADDR_REG_OFFSET 0
162 #define DATA_REG_OFFSET 1
163
164 #define W83627EHF_REG_BANK 0x4E
165 #define W83627EHF_REG_CONFIG 0x40
166
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 */
172
173 static const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 };
174 static const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c };
175
176 /* 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
184 static const u16 W83627EHF_REG_TEMP[] = { 0x27, 0x150, 0x250, 0x7e };
185 static const u16 W83627EHF_REG_TEMP_HYST[] = { 0x3a, 0x153, 0x253, 0 };
186 static const u16 W83627EHF_REG_TEMP_OVER[] = { 0x39, 0x155, 0x255, 0 };
187 static const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0, 0x152, 0x252, 0 };
188
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
196 /* NCT6775F has its own fan divider registers */
197 #define NCT6775_REG_FANDIV1 0x506
198 #define NCT6775_REG_FANDIV2 0x507
199 #define NCT6775_REG_FAN_DEBOUNCE 0xf0
200
201 #define W83627EHF_REG_ALARM1 0x459
202 #define W83627EHF_REG_ALARM2 0x45A
203 #define W83627EHF_REG_ALARM3 0x45B
204
205 #define W83627EHF_REG_CASEOPEN_DET 0x42 /* SMI STATUS #2 */
206 #define W83627EHF_REG_CASEOPEN_CLR 0x46 /* SMI MASK #3 */
207
208 /* SmartFan registers */
209 #define W83627EHF_REG_FAN_STEPUP_TIME 0x0f
210 #define W83627EHF_REG_FAN_STEPDOWN_TIME 0x0e
211
212 /* DC or PWM output fan configuration */
213 static 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 */
217 0x62, /* CPU FAN1 mode */
218 };
219
220 static const u8 W83627EHF_PWM_MODE_SHIFT[] = { 0, 1, 0, 6 };
221 static const u8 W83627EHF_PWM_ENABLE_SHIFT[] = { 2, 4, 1, 4 };
222
223 /* FAN Duty Cycle, be used to control */
224 static const u16 W83627EHF_REG_PWM[] = { 0x01, 0x03, 0x11, 0x61 };
225 static const u16 W83627EHF_REG_TARGET[] = { 0x05, 0x06, 0x13, 0x63 };
226 static const u8 W83627EHF_REG_TOLERANCE[] = { 0x07, 0x07, 0x14, 0x62 };
227
228 /* Advanced Fan control, some values are common for all fans */
229 static const u16 W83627EHF_REG_FAN_START_OUTPUT[] = { 0x0a, 0x0b, 0x16, 0x65 };
230 static const u16 W83627EHF_REG_FAN_STOP_OUTPUT[] = { 0x08, 0x09, 0x15, 0x64 };
231 static const u16 W83627EHF_REG_FAN_STOP_TIME[] = { 0x0c, 0x0d, 0x17, 0x66 };
232
233 static const u16 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON[]
234 = { 0xff, 0x67, 0xff, 0x69 };
235 static const u16 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON[]
236 = { 0xff, 0x68, 0xff, 0x6a };
237
238 static const u16 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B[] = { 0x67, 0x69, 0x6b };
239 static const u16 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B[]
240 = { 0x68, 0x6a, 0x6c };
241
242 static const u16 NCT6775_REG_TARGET[] = { 0x101, 0x201, 0x301 };
243 static const u16 NCT6775_REG_FAN_MODE[] = { 0x102, 0x202, 0x302 };
244 static const u16 NCT6775_REG_FAN_STOP_OUTPUT[] = { 0x105, 0x205, 0x305 };
245 static const u16 NCT6775_REG_FAN_START_OUTPUT[] = { 0x106, 0x206, 0x306 };
246 static const u16 NCT6775_REG_FAN_STOP_TIME[] = { 0x107, 0x207, 0x307 };
247 static const u16 NCT6775_REG_PWM[] = { 0x109, 0x209, 0x309 };
248 static const u16 NCT6775_REG_FAN_MAX_OUTPUT[] = { 0x10a, 0x20a, 0x30a };
249 static const u16 NCT6775_REG_FAN_STEP_OUTPUT[] = { 0x10b, 0x20b, 0x30b };
250 static const u16 NCT6775_REG_FAN[] = { 0x630, 0x632, 0x634, 0x636, 0x638 };
251 static const u16 NCT6776_REG_FAN_MIN[] = { 0x63a, 0x63c, 0x63e, 0x640, 0x642};
252
253 static const u16 NCT6775_REG_TEMP[]
254 = { 0x27, 0x150, 0x250, 0x73, 0x75, 0x77, 0x62b, 0x62c, 0x62d };
255 static const u16 NCT6775_REG_TEMP_CONFIG[]
256 = { 0, 0x152, 0x252, 0, 0, 0, 0x628, 0x629, 0x62A };
257 static const u16 NCT6775_REG_TEMP_HYST[]
258 = { 0x3a, 0x153, 0x253, 0, 0, 0, 0x673, 0x678, 0x67D };
259 static const u16 NCT6775_REG_TEMP_OVER[]
260 = { 0x39, 0x155, 0x255, 0, 0, 0, 0x672, 0x677, 0x67C };
261 static const u16 NCT6775_REG_TEMP_SOURCE[]
262 = { 0x621, 0x622, 0x623, 0x100, 0x200, 0x300, 0x624, 0x625, 0x626 };
263
264 static 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
275 static 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
299 static 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)
326
is_word_sized(u16 reg)327 static int is_word_sized(u16 reg)
328 {
329 return ((((reg & 0xff00) == 0x100
330 || (reg & 0xff00) == 0x200)
331 && ((reg & 0x00ff) == 0x50
332 || (reg & 0x00ff) == 0x53
333 || (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 );
340 }
341
342 /*
343 * Conversions
344 */
345
346 /* 1 is PWM mode, output in ms */
step_time_from_reg(u8 reg,u8 mode)347 static inline unsigned int step_time_from_reg(u8 reg, u8 mode)
348 {
349 return mode ? 100 * reg : 400 * reg;
350 }
351
step_time_to_reg(unsigned int msec,u8 mode)352 static 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
fan_from_reg8(u16 reg,unsigned int divreg)358 static unsigned int fan_from_reg8(u16 reg, unsigned int divreg)
359 {
360 if (reg == 0 || reg == 255)
361 return 0;
362 return 1350000U / (reg << divreg);
363 }
364
fan_from_reg13(u16 reg,unsigned int divreg)365 static 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
fan_from_reg16(u16 reg,unsigned int divreg)378 static 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);
388 }
389
390 static inline unsigned int
div_from_reg(u8 reg)391 div_from_reg(u8 reg)
392 {
393 return 1 << reg;
394 }
395
396 /* Some of the voltage inputs have internal scaling, the tables below
397 * contain 8 (the ADC LSB in mV) * scaling factor * 100 */
398 static const u16 scale_in_common[10] = {
399 800, 800, 1600, 1600, 800, 800, 800, 1600, 1600, 800
400 };
401 static const u16 scale_in_w83627uhg[9] = {
402 800, 800, 3328, 3424, 800, 800, 0, 3328, 3400
403 };
404
in_from_reg(u8 reg,u8 nr,const u16 * scale_in)405 static inline long in_from_reg(u8 reg, u8 nr, const u16 *scale_in)
406 {
407 return DIV_ROUND_CLOSEST(reg * scale_in[nr], 100);
408 }
409
in_to_reg(u32 val,u8 nr,const u16 * scale_in)410 static inline u8 in_to_reg(u32 val, u8 nr, const u16 *scale_in)
411 {
412 return SENSORS_LIMIT(DIV_ROUND_CLOSEST(val * 100, scale_in[nr]), 0,
413 255);
414 }
415
416 /*
417 * Data structures and manipulation thereof
418 */
419
420 struct w83627ehf_data {
421 int addr; /* IO base of hw monitor block */
422 const char *name;
423
424 struct device *hwmon_dev;
425 struct mutex lock;
426
427 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];
431 u8 temp_src[NUM_REG_TEMP];
432 const char * const *temp_label;
433
434 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;
443 const u16 *scale_in;
444
445 unsigned int (*fan_from_reg)(u16 reg, unsigned int divreg);
446 unsigned int (*fan_from_reg_min)(u16 reg, unsigned int divreg);
447
448 struct mutex update_lock;
449 char valid; /* !=0 if following fields are valid */
450 unsigned long last_updated; /* In jiffies */
451
452 /* Register values */
453 u8 bank; /* current register bank */
454 u8 in_num; /* number of in inputs we have */
455 u8 in[10]; /* Register value */
456 u8 in_max[10]; /* Register value */
457 u8 in_min[10]; /* Register value */
458 unsigned int rpm[5];
459 u16 fan_min[5];
460 u8 fan_div[5];
461 u8 has_fan; /* some fan inputs can be disabled */
462 u8 has_fan_min; /* some fans don't have min register */
463 bool has_fan_div;
464 u8 temp_type[3];
465 s16 temp[9];
466 s16 temp_max[9];
467 s16 temp_max_hyst[9];
468 u32 alarms;
469 u8 caseopen;
470
471 u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */
472 u8 pwm_enable[4]; /* 1->manual
473 2->thermal cruise mode (also called SmartFan I)
474 3->fan speed cruise mode
475 4->variable thermal cruise (also called
476 SmartFan III)
477 5->enhanced variable thermal cruise (also called
478 SmartFan IV) */
479 u8 pwm_enable_orig[4]; /* original value of pwm_enable */
480 u8 pwm_num; /* number of pwm */
481 u8 pwm[4];
482 u8 target_temp[4];
483 u8 tolerance[4];
484
485 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 */
490
491 u8 vid;
492 u8 vrm;
493
494 u16 have_temp;
495 u8 in6_skip:1;
496 u8 temp3_val_only:1;
497 };
498
499 struct w83627ehf_sio_data {
500 int sioreg;
501 enum kinds kind;
502 };
503
504 /*
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 */
w83627ehf_set_bank(struct w83627ehf_data * data,u16 reg)510 static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg)
511 {
512 u8 bank = reg >> 8;
513 if (data->bank != bank) {
514 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET);
515 outb_p(bank, data->addr + DATA_REG_OFFSET);
516 data->bank = bank;
517 }
518 }
519
w83627ehf_read_value(struct w83627ehf_data * data,u16 reg)520 static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg)
521 {
522 int res, word_sized = is_word_sized(reg);
523
524 mutex_lock(&data->lock);
525
526 w83627ehf_set_bank(data, reg);
527 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
528 res = inb_p(data->addr + DATA_REG_OFFSET);
529 if (word_sized) {
530 outb_p((reg & 0xff) + 1,
531 data->addr + ADDR_REG_OFFSET);
532 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
533 }
534
535 mutex_unlock(&data->lock);
536 return res;
537 }
538
w83627ehf_write_value(struct w83627ehf_data * data,u16 reg,u16 value)539 static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg,
540 u16 value)
541 {
542 int word_sized = is_word_sized(reg);
543
544 mutex_lock(&data->lock);
545
546 w83627ehf_set_bank(data, reg);
547 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
548 if (word_sized) {
549 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
550 outb_p((reg & 0xff) + 1,
551 data->addr + ADDR_REG_OFFSET);
552 }
553 outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
554
555 mutex_unlock(&data->lock);
556 return 0;
557 }
558
559 /* We left-align 8-bit temperature values to make the code simpler */
w83627ehf_read_temp(struct w83627ehf_data * data,u16 reg)560 static 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
w83627ehf_write_temp(struct w83627ehf_data * data,u16 reg,u16 value)571 static 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
579 /* This function assumes that the caller holds data->update_lock */
nct6775_write_fan_div(struct w83627ehf_data * data,int nr)580 static 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 */
w83627ehf_write_fan_div(struct w83627ehf_data * data,int nr)608 static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr)
609 {
610 u8 reg;
611
612 switch (nr) {
613 case 0:
614 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf)
615 | ((data->fan_div[0] & 0x03) << 4);
616 /* fan5 input control bit is write only, compute the value */
617 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
618 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
619 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf)
620 | ((data->fan_div[0] & 0x04) << 3);
621 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
622 break;
623 case 1:
624 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f)
625 | ((data->fan_div[1] & 0x03) << 6);
626 /* fan5 input control bit is write only, compute the value */
627 reg |= (data->has_fan & (1 << 4)) ? 1 : 0;
628 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg);
629 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf)
630 | ((data->fan_div[1] & 0x04) << 4);
631 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
632 break;
633 case 2:
634 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f)
635 | ((data->fan_div[2] & 0x03) << 6);
636 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg);
637 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f)
638 | ((data->fan_div[2] & 0x04) << 5);
639 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg);
640 break;
641 case 3:
642 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc)
643 | (data->fan_div[3] & 0x03);
644 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
645 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f)
646 | ((data->fan_div[3] & 0x04) << 5);
647 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg);
648 break;
649 case 4:
650 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73)
651 | ((data->fan_div[4] & 0x03) << 2)
652 | ((data->fan_div[4] & 0x04) << 5);
653 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg);
654 break;
655 }
656 }
657
w83627ehf_write_fan_div_common(struct device * dev,struct w83627ehf_data * data,int nr)658 static 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
nct6775_update_fan_div(struct w83627ehf_data * data)671 static 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
w83627ehf_update_fan_div(struct w83627ehf_data * data)684 static 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
w83627ehf_update_fan_div_common(struct device * dev,struct w83627ehf_data * data)709 static 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
nct6775_update_pwm(struct w83627ehf_data * data)722 static 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
w83627ehf_update_pwm(struct w83627ehf_data * data)740 static 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
w83627ehf_update_pwm_common(struct device * dev,struct w83627ehf_data * data)766 static 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
w83627ehf_update_device(struct device * dev)777 static struct w83627ehf_data *w83627ehf_update_device(struct device *dev)
778 {
779 struct w83627ehf_data *data = dev_get_drvdata(dev);
780 struct w83627ehf_sio_data *sio_data = dev->platform_data;
781
782 int i;
783
784 mutex_lock(&data->update_lock);
785
786 if (time_after(jiffies, data->last_updated + HZ + HZ/2)
787 || !data->valid) {
788 /* Fan clock dividers */
789 w83627ehf_update_fan_div_common(dev, data);
790
791 /* Measured voltages and limits */
792 for (i = 0; i < data->in_num; i++) {
793 if ((i == 6) && data->in6_skip)
794 continue;
795
796 data->in[i] = w83627ehf_read_value(data,
797 W83627EHF_REG_IN(i));
798 data->in_min[i] = w83627ehf_read_value(data,
799 W83627EHF_REG_IN_MIN(i));
800 data->in_max[i] = w83627ehf_read_value(data,
801 W83627EHF_REG_IN_MAX(i));
802 }
803
804 /* Measured fan speeds and limits */
805 for (i = 0; i < 5; i++) {
806 u16 reg;
807
808 if (!(data->has_fan & (1 << i)))
809 continue;
810
811 reg = w83627ehf_read_value(data, data->REG_FAN[i]);
812 data->rpm[i] = data->fan_from_reg(reg,
813 data->fan_div[i]);
814
815 if (data->has_fan_min & (1 << i))
816 data->fan_min[i] = w83627ehf_read_value(data,
817 data->REG_FAN_MIN[i]);
818
819 /* If we failed to measure the fan speed and clock
820 divider can be increased, let's try that for next
821 time */
822 if (data->has_fan_div
823 && (reg >= 0xff || (sio_data->kind == nct6775
824 && reg == 0x00))
825 && data->fan_div[i] < 0x07) {
826 dev_dbg(dev, "Increasing fan%d "
827 "clock divider from %u to %u\n",
828 i + 1, div_from_reg(data->fan_div[i]),
829 div_from_reg(data->fan_div[i] + 1));
830 data->fan_div[i]++;
831 w83627ehf_write_fan_div_common(dev, data, i);
832 /* Preserve min limit if possible */
833 if ((data->has_fan_min & (1 << i))
834 && data->fan_min[i] >= 2
835 && data->fan_min[i] != 255)
836 w83627ehf_write_value(data,
837 data->REG_FAN_MIN[i],
838 (data->fan_min[i] /= 2));
839 }
840 }
841
842 w83627ehf_update_pwm_common(dev, data);
843
844 for (i = 0; i < data->pwm_num; i++) {
845 if (!(data->has_fan & (1 << i)))
846 continue;
847
848 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]);
857
858 if (data->REG_FAN_MAX_OUTPUT &&
859 data->REG_FAN_MAX_OUTPUT[i] != 0xff)
860 data->fan_max_output[i] =
861 w83627ehf_read_value(data,
862 data->REG_FAN_MAX_OUTPUT[i]);
863
864 if (data->REG_FAN_STEP_OUTPUT &&
865 data->REG_FAN_STEP_OUTPUT[i] != 0xff)
866 data->fan_step_output[i] =
867 w83627ehf_read_value(data,
868 data->REG_FAN_STEP_OUTPUT[i]);
869
870 data->target_temp[i] =
871 w83627ehf_read_value(data,
872 data->REG_TARGET[i]) &
873 (data->pwm_mode[i] == 1 ? 0x7f : 0xff);
874 }
875
876 /* Measured temperatures and limits */
877 for (i = 0; i < NUM_REG_TEMP; i++) {
878 if (!(data->have_temp & (1 << i)))
879 continue;
880 data->temp[i] = w83627ehf_read_temp(data,
881 data->reg_temp[i]);
882 if (data->reg_temp_over[i])
883 data->temp_max[i]
884 = w83627ehf_read_temp(data,
885 data->reg_temp_over[i]);
886 if (data->reg_temp_hyst[i])
887 data->temp_max_hyst[i]
888 = w83627ehf_read_temp(data,
889 data->reg_temp_hyst[i]);
890 }
891
892 data->alarms = w83627ehf_read_value(data,
893 W83627EHF_REG_ALARM1) |
894 (w83627ehf_read_value(data,
895 W83627EHF_REG_ALARM2) << 8) |
896 (w83627ehf_read_value(data,
897 W83627EHF_REG_ALARM3) << 16);
898
899 data->caseopen = w83627ehf_read_value(data,
900 W83627EHF_REG_CASEOPEN_DET);
901
902 data->last_updated = jiffies;
903 data->valid = 1;
904 }
905
906 mutex_unlock(&data->update_lock);
907 return data;
908 }
909
910 /*
911 * Sysfs callback functions
912 */
913 #define show_in_reg(reg) \
914 static ssize_t \
915 show_##reg(struct device *dev, struct device_attribute *attr, \
916 char *buf) \
917 { \
918 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
919 struct sensor_device_attribute *sensor_attr = \
920 to_sensor_dev_attr(attr); \
921 int nr = sensor_attr->index; \
922 return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr, \
923 data->scale_in)); \
924 }
925 show_in_reg(in)
show_in_reg(in_min)926 show_in_reg(in_min)
927 show_in_reg(in_max)
928
929 #define store_in_reg(REG, reg) \
930 static ssize_t \
931 store_in_##reg(struct device *dev, struct device_attribute *attr, \
932 const char *buf, size_t count) \
933 { \
934 struct w83627ehf_data *data = dev_get_drvdata(dev); \
935 struct sensor_device_attribute *sensor_attr = \
936 to_sensor_dev_attr(attr); \
937 int nr = sensor_attr->index; \
938 unsigned long val; \
939 int err; \
940 err = kstrtoul(buf, 10, &val); \
941 if (err < 0) \
942 return err; \
943 mutex_lock(&data->update_lock); \
944 data->in_##reg[nr] = in_to_reg(val, nr, data->scale_in); \
945 w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \
946 data->in_##reg[nr]); \
947 mutex_unlock(&data->update_lock); \
948 return count; \
949 }
950
951 store_in_reg(MIN, min)
952 store_in_reg(MAX, max)
953
954 static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
955 char *buf)
956 {
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
963 static 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
976 static 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
989 static struct sensor_device_attribute sda_in_min[] = {
990 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),
1000 };
1001
1002 static struct sensor_device_attribute sda_in_max[] = {
1003 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),
1013 };
1014
1015 static ssize_t
show_fan(struct device * dev,struct device_attribute * attr,char * buf)1016 show_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;
1021 return sprintf(buf, "%d\n", data->rpm[nr]);
1022 }
1023
1024 static ssize_t
show_fan_min(struct device * dev,struct device_attribute * attr,char * buf)1025 show_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",
1031 data->fan_from_reg_min(data->fan_min[nr],
1032 data->fan_div[nr]));
1033 }
1034
1035 static ssize_t
show_fan_div(struct device * dev,struct device_attribute * attr,char * buf)1036 show_fan_div(struct device *dev, struct device_attribute *attr,
1037 char *buf)
1038 {
1039 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1040 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]));
1043 }
1044
1045 static ssize_t
store_fan_min(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1046 store_fan_min(struct device *dev, struct device_attribute *attr,
1047 const char *buf, size_t count)
1048 {
1049 struct w83627ehf_data *data = dev_get_drvdata(dev);
1050 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1051 int nr = sensor_attr->index;
1052 unsigned long val;
1053 int err;
1054 unsigned int reg;
1055 u8 new_div;
1056
1057 err = kstrtoul(buf, 10, &val);
1058 if (err < 0)
1059 return err;
1060
1061 mutex_lock(&data->update_lock);
1062 if (!data->has_fan_div) {
1063 /*
1064 * Only NCT6776F for now, so we know that this is a 13 bit
1065 * register
1066 */
1067 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 }
1078 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) */
1088 dev_warn(dev, "fan%u low limit %lu below minimum %u, set to "
1089 "minimum\n", nr + 1, val,
1090 data->fan_from_reg_min(254, 7));
1091 } 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) */
1096 dev_warn(dev, "fan%u low limit %lu above maximum %u, set to "
1097 "maximum\n", nr + 1, val,
1098 data->fan_from_reg_min(1, 0));
1099 } 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]) {
1114 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;
1118 w83627ehf_write_fan_div_common(dev, data, nr);
1119 /* Give the chip time to sample a new speed value */
1120 data->last_updated = jiffies;
1121 }
1122 done:
1123 w83627ehf_write_value(data, data->REG_FAN_MIN[nr],
1124 data->fan_min[nr]);
1125 mutex_unlock(&data->update_lock);
1126
1127 return count;
1128 }
1129
1130 static 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 };
1137
1138 static 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
1146 static 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 };
1158
1159 static 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 };
1166
1167 static ssize_t
show_temp_label(struct device * dev,struct device_attribute * attr,char * buf)1168 show_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
1176 #define show_temp_reg(addr, reg) \
1177 static ssize_t \
1178 show_##reg(struct device *dev, struct device_attribute *attr, \
1179 char *buf) \
1180 { \
1181 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1182 struct sensor_device_attribute *sensor_attr = \
1183 to_sensor_dev_attr(attr); \
1184 int nr = sensor_attr->index; \
1185 return sprintf(buf, "%d\n", LM75_TEMP_FROM_REG(data->reg[nr])); \
1186 }
1187 show_temp_reg(reg_temp, temp);
1188 show_temp_reg(reg_temp_over, temp_max);
1189 show_temp_reg(reg_temp_hyst, temp_max_hyst);
1190
1191 #define store_temp_reg(addr, reg) \
1192 static ssize_t \
1193 store_##reg(struct device *dev, struct device_attribute *attr, \
1194 const char *buf, size_t count) \
1195 { \
1196 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1197 struct sensor_device_attribute *sensor_attr = \
1198 to_sensor_dev_attr(attr); \
1199 int nr = sensor_attr->index; \
1200 int err; \
1201 long val; \
1202 err = kstrtol(buf, 10, &val); \
1203 if (err < 0) \
1204 return err; \
1205 mutex_lock(&data->update_lock); \
1206 data->reg[nr] = LM75_TEMP_TO_REG(val); \
1207 w83627ehf_write_temp(data, data->addr[nr], data->reg[nr]); \
1208 mutex_unlock(&data->update_lock); \
1209 return count; \
1210 }
1211 store_temp_reg(reg_temp_over, temp_max);
1212 store_temp_reg(reg_temp_hyst, temp_max_hyst);
1213
1214 static ssize_t
show_temp_type(struct device * dev,struct device_attribute * attr,char * buf)1215 show_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
1223 static struct sensor_device_attribute sda_temp_input[] = {
1224 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),
1227 SENSOR_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3),
1228 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),
1233 };
1234
1235 static 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),
1240 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),
1245 };
1246
1247 static struct sensor_device_attribute sda_temp_max[] = {
1248 SENSOR_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp_max,
1249 store_temp_max, 0),
1250 SENSOR_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max,
1251 store_temp_max, 1),
1252 SENSOR_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max,
1253 store_temp_max, 2),
1254 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),
1266 };
1267
1268 static struct sensor_device_attribute sda_temp_max_hyst[] = {
1269 SENSOR_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1270 store_temp_max_hyst, 0),
1271 SENSOR_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1272 store_temp_max_hyst, 1),
1273 SENSOR_ATTR(temp3_max_hyst, S_IRUGO | S_IWUSR, show_temp_max_hyst,
1274 store_temp_max_hyst, 2),
1275 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),
1287 };
1288
1289 static struct sensor_device_attribute sda_temp_alarm[] = {
1290 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),
1293 };
1294
1295 static struct sensor_device_attribute sda_temp_type[] = {
1296 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),
1299 };
1300
1301 #define show_pwm_reg(reg) \
1302 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1303 char *buf) \
1304 { \
1305 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1306 struct sensor_device_attribute *sensor_attr = \
1307 to_sensor_dev_attr(attr); \
1308 int nr = sensor_attr->index; \
1309 return sprintf(buf, "%d\n", data->reg[nr]); \
1310 }
1311
1312 show_pwm_reg(pwm_mode)
show_pwm_reg(pwm_enable)1313 show_pwm_reg(pwm_enable)
1314 show_pwm_reg(pwm)
1315
1316 static ssize_t
1317 store_pwm_mode(struct device *dev, struct device_attribute *attr,
1318 const char *buf, size_t count)
1319 {
1320 struct w83627ehf_data *data = dev_get_drvdata(dev);
1321 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1322 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1323 int nr = sensor_attr->index;
1324 unsigned long val;
1325 int err;
1326 u16 reg;
1327
1328 err = kstrtoul(buf, 10, &val);
1329 if (err < 0)
1330 return err;
1331
1332 if (val > 1)
1333 return -EINVAL;
1334
1335 /* On NCT67766F, DC mode is only supported for pwm1 */
1336 if (sio_data->kind == nct6776 && nr && val != 1)
1337 return -EINVAL;
1338
1339 mutex_lock(&data->update_lock);
1340 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1341 data->pwm_mode[nr] = val;
1342 reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
1343 if (!val)
1344 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
1345 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1346 mutex_unlock(&data->update_lock);
1347 return count;
1348 }
1349
1350 static ssize_t
store_pwm(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1351 store_pwm(struct device *dev, struct device_attribute *attr,
1352 const char *buf, size_t count)
1353 {
1354 struct w83627ehf_data *data = dev_get_drvdata(dev);
1355 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1356 int nr = sensor_attr->index;
1357 unsigned long val;
1358 int err;
1359
1360 err = kstrtoul(buf, 10, &val);
1361 if (err < 0)
1362 return err;
1363
1364 val = SENSORS_LIMIT(val, 0, 255);
1365
1366 mutex_lock(&data->update_lock);
1367 data->pwm[nr] = val;
1368 w83627ehf_write_value(data, data->REG_PWM[nr], val);
1369 mutex_unlock(&data->update_lock);
1370 return count;
1371 }
1372
1373 static ssize_t
store_pwm_enable(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1374 store_pwm_enable(struct device *dev, struct device_attribute *attr,
1375 const char *buf, size_t count)
1376 {
1377 struct w83627ehf_data *data = dev_get_drvdata(dev);
1378 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1379 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1380 int nr = sensor_attr->index;
1381 unsigned long val;
1382 int err;
1383 u16 reg;
1384
1385 err = kstrtoul(buf, 10, &val);
1386 if (err < 0)
1387 return err;
1388
1389 if (!val || (val > 4 && val != data->pwm_enable_orig[nr]))
1390 return -EINVAL;
1391 /* SmartFan III mode is not supported on NCT6776F */
1392 if (sio_data->kind == nct6776 && val == 4)
1393 return -EINVAL;
1394
1395 mutex_lock(&data->update_lock);
1396 data->pwm_enable[nr] = val;
1397 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1398 reg = w83627ehf_read_value(data,
1399 NCT6775_REG_FAN_MODE[nr]);
1400 reg &= 0x0f;
1401 reg |= (val - 1) << 4;
1402 w83627ehf_write_value(data,
1403 NCT6775_REG_FAN_MODE[nr], reg);
1404 } else {
1405 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1406 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
1407 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
1408 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1409 }
1410 mutex_unlock(&data->update_lock);
1411 return count;
1412 }
1413
1414
1415 #define show_tol_temp(reg) \
1416 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1417 char *buf) \
1418 { \
1419 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1420 struct sensor_device_attribute *sensor_attr = \
1421 to_sensor_dev_attr(attr); \
1422 int nr = sensor_attr->index; \
1423 return sprintf(buf, "%d\n", data->reg[nr] * 1000); \
1424 }
1425
1426 show_tol_temp(tolerance)
show_tol_temp(target_temp)1427 show_tol_temp(target_temp)
1428
1429 static ssize_t
1430 store_target_temp(struct device *dev, struct device_attribute *attr,
1431 const char *buf, size_t count)
1432 {
1433 struct w83627ehf_data *data = dev_get_drvdata(dev);
1434 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1435 int nr = sensor_attr->index;
1436 long val;
1437 int err;
1438
1439 err = kstrtol(buf, 10, &val);
1440 if (err < 0)
1441 return err;
1442
1443 val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 127);
1444
1445 mutex_lock(&data->update_lock);
1446 data->target_temp[nr] = val;
1447 w83627ehf_write_value(data, data->REG_TARGET[nr], val);
1448 mutex_unlock(&data->update_lock);
1449 return count;
1450 }
1451
1452 static ssize_t
store_tolerance(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1453 store_tolerance(struct device *dev, struct device_attribute *attr,
1454 const char *buf, size_t count)
1455 {
1456 struct w83627ehf_data *data = dev_get_drvdata(dev);
1457 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1458 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1459 int nr = sensor_attr->index;
1460 u16 reg;
1461 long val;
1462 int err;
1463
1464 err = kstrtol(buf, 10, &val);
1465 if (err < 0)
1466 return err;
1467
1468 /* Limit the temp to 0C - 15C */
1469 val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 15);
1470
1471 mutex_lock(&data->update_lock);
1472 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1473 /* Limit tolerance further for NCT6776F */
1474 if (sio_data->kind == nct6776 && val > 7)
1475 val = 7;
1476 reg = w83627ehf_read_value(data, NCT6775_REG_FAN_MODE[nr]);
1477 reg = (reg & 0xf0) | val;
1478 w83627ehf_write_value(data, NCT6775_REG_FAN_MODE[nr], reg);
1479 } else {
1480 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
1481 if (nr == 1)
1482 reg = (reg & 0x0f) | (val << 4);
1483 else
1484 reg = (reg & 0xf0) | val;
1485 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
1486 }
1487 data->tolerance[nr] = val;
1488 mutex_unlock(&data->update_lock);
1489 return count;
1490 }
1491
1492 static struct sensor_device_attribute sda_pwm[] = {
1493 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
1494 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
1495 SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
1496 SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
1497 };
1498
1499 static struct sensor_device_attribute sda_pwm_mode[] = {
1500 SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1501 store_pwm_mode, 0),
1502 SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1503 store_pwm_mode, 1),
1504 SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1505 store_pwm_mode, 2),
1506 SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1507 store_pwm_mode, 3),
1508 };
1509
1510 static struct sensor_device_attribute sda_pwm_enable[] = {
1511 SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1512 store_pwm_enable, 0),
1513 SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1514 store_pwm_enable, 1),
1515 SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1516 store_pwm_enable, 2),
1517 SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1518 store_pwm_enable, 3),
1519 };
1520
1521 static struct sensor_device_attribute sda_target_temp[] = {
1522 SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1523 store_target_temp, 0),
1524 SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1525 store_target_temp, 1),
1526 SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1527 store_target_temp, 2),
1528 SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1529 store_target_temp, 3),
1530 };
1531
1532 static struct sensor_device_attribute sda_tolerance[] = {
1533 SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1534 store_tolerance, 0),
1535 SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1536 store_tolerance, 1),
1537 SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1538 store_tolerance, 2),
1539 SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1540 store_tolerance, 3),
1541 };
1542
1543 /* Smart Fan registers */
1544
1545 #define fan_functions(reg, REG) \
1546 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1547 char *buf) \
1548 { \
1549 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1550 struct sensor_device_attribute *sensor_attr = \
1551 to_sensor_dev_attr(attr); \
1552 int nr = sensor_attr->index; \
1553 return sprintf(buf, "%d\n", data->reg[nr]); \
1554 } \
1555 static ssize_t \
1556 store_##reg(struct device *dev, struct device_attribute *attr, \
1557 const char *buf, size_t count) \
1558 { \
1559 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1560 struct sensor_device_attribute *sensor_attr = \
1561 to_sensor_dev_attr(attr); \
1562 int nr = sensor_attr->index; \
1563 unsigned long val; \
1564 int err; \
1565 err = kstrtoul(buf, 10, &val); \
1566 if (err < 0) \
1567 return err; \
1568 val = SENSORS_LIMIT(val, 1, 255); \
1569 mutex_lock(&data->update_lock); \
1570 data->reg[nr] = val; \
1571 w83627ehf_write_value(data, data->REG_##REG[nr], val); \
1572 mutex_unlock(&data->update_lock); \
1573 return count; \
1574 }
1575
fan_functions(fan_start_output,FAN_START_OUTPUT)1576 fan_functions(fan_start_output, FAN_START_OUTPUT)
1577 fan_functions(fan_stop_output, FAN_STOP_OUTPUT)
1578 fan_functions(fan_max_output, FAN_MAX_OUTPUT)
1579 fan_functions(fan_step_output, FAN_STEP_OUTPUT)
1580
1581 #define fan_time_functions(reg, REG) \
1582 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1583 char *buf) \
1584 { \
1585 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1586 struct sensor_device_attribute *sensor_attr = \
1587 to_sensor_dev_attr(attr); \
1588 int nr = sensor_attr->index; \
1589 return sprintf(buf, "%d\n", \
1590 step_time_from_reg(data->reg[nr], \
1591 data->pwm_mode[nr])); \
1592 } \
1593 \
1594 static ssize_t \
1595 store_##reg(struct device *dev, struct device_attribute *attr, \
1596 const char *buf, size_t count) \
1597 { \
1598 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1599 struct sensor_device_attribute *sensor_attr = \
1600 to_sensor_dev_attr(attr); \
1601 int nr = sensor_attr->index; \
1602 unsigned long val; \
1603 int err; \
1604 err = kstrtoul(buf, 10, &val); \
1605 if (err < 0) \
1606 return err; \
1607 val = step_time_to_reg(val, data->pwm_mode[nr]); \
1608 mutex_lock(&data->update_lock); \
1609 data->reg[nr] = val; \
1610 w83627ehf_write_value(data, data->REG_##REG[nr], val); \
1611 mutex_unlock(&data->update_lock); \
1612 return count; \
1613 } \
1614
1615 fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1616
1617 static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1618 char *buf)
1619 {
1620 struct w83627ehf_data *data = dev_get_drvdata(dev);
1621
1622 return sprintf(buf, "%s\n", data->name);
1623 }
1624 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1625
1626 static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1627 SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1628 store_fan_stop_time, 3),
1629 SENSOR_ATTR(pwm4_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1630 store_fan_start_output, 3),
1631 SENSOR_ATTR(pwm4_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1632 store_fan_stop_output, 3),
1633 SENSOR_ATTR(pwm4_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1634 store_fan_max_output, 3),
1635 SENSOR_ATTR(pwm4_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1636 store_fan_step_output, 3),
1637 };
1638
1639 static struct sensor_device_attribute sda_sf3_arrays_fan3[] = {
1640 SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1641 store_fan_stop_time, 2),
1642 SENSOR_ATTR(pwm3_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1643 store_fan_start_output, 2),
1644 SENSOR_ATTR(pwm3_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1645 store_fan_stop_output, 2),
1646 };
1647
1648 static struct sensor_device_attribute sda_sf3_arrays[] = {
1649 SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1650 store_fan_stop_time, 0),
1651 SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1652 store_fan_stop_time, 1),
1653 SENSOR_ATTR(pwm1_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1654 store_fan_start_output, 0),
1655 SENSOR_ATTR(pwm2_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1656 store_fan_start_output, 1),
1657 SENSOR_ATTR(pwm1_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1658 store_fan_stop_output, 0),
1659 SENSOR_ATTR(pwm2_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1660 store_fan_stop_output, 1),
1661 };
1662
1663
1664 /*
1665 * pwm1 and pwm3 don't support max and step settings on all chips.
1666 * Need to check support while generating/removing attribute files.
1667 */
1668 static struct sensor_device_attribute sda_sf3_max_step_arrays[] = {
1669 SENSOR_ATTR(pwm1_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1670 store_fan_max_output, 0),
1671 SENSOR_ATTR(pwm1_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1672 store_fan_step_output, 0),
1673 SENSOR_ATTR(pwm2_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1674 store_fan_max_output, 1),
1675 SENSOR_ATTR(pwm2_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1676 store_fan_step_output, 1),
1677 SENSOR_ATTR(pwm3_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1678 store_fan_max_output, 2),
1679 SENSOR_ATTR(pwm3_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1680 store_fan_step_output, 2),
1681 };
1682
1683 static ssize_t
show_vid(struct device * dev,struct device_attribute * attr,char * buf)1684 show_vid(struct device *dev, struct device_attribute *attr, char *buf)
1685 {
1686 struct w83627ehf_data *data = dev_get_drvdata(dev);
1687 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1688 }
1689 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
1690
1691
1692 /* Case open detection */
1693
1694 static ssize_t
show_caseopen(struct device * dev,struct device_attribute * attr,char * buf)1695 show_caseopen(struct device *dev, struct device_attribute *attr, char *buf)
1696 {
1697 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1698
1699 return sprintf(buf, "%d\n",
1700 !!(data->caseopen & to_sensor_dev_attr_2(attr)->index));
1701 }
1702
1703 static ssize_t
clear_caseopen(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1704 clear_caseopen(struct device *dev, struct device_attribute *attr,
1705 const char *buf, size_t count)
1706 {
1707 struct w83627ehf_data *data = dev_get_drvdata(dev);
1708 unsigned long val;
1709 u16 reg, mask;
1710
1711 if (kstrtoul(buf, 10, &val) || val != 0)
1712 return -EINVAL;
1713
1714 mask = to_sensor_dev_attr_2(attr)->nr;
1715
1716 mutex_lock(&data->update_lock);
1717 reg = w83627ehf_read_value(data, W83627EHF_REG_CASEOPEN_CLR);
1718 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg | mask);
1719 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg & ~mask);
1720 data->valid = 0; /* Force cache refresh */
1721 mutex_unlock(&data->update_lock);
1722
1723 return count;
1724 }
1725
1726 static struct sensor_device_attribute_2 sda_caseopen[] = {
1727 SENSOR_ATTR_2(intrusion0_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1728 clear_caseopen, 0x80, 0x10),
1729 SENSOR_ATTR_2(intrusion1_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1730 clear_caseopen, 0x40, 0x40),
1731 };
1732
1733 /*
1734 * Driver and device management
1735 */
1736
w83627ehf_device_remove_files(struct device * dev)1737 static void w83627ehf_device_remove_files(struct device *dev)
1738 {
1739 /* some entries in the following arrays may not have been used in
1740 * device_create_file(), but device_remove_file() will ignore them */
1741 int i;
1742 struct w83627ehf_data *data = dev_get_drvdata(dev);
1743
1744 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1745 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
1746 for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
1747 struct sensor_device_attribute *attr =
1748 &sda_sf3_max_step_arrays[i];
1749 if (data->REG_FAN_STEP_OUTPUT &&
1750 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff)
1751 device_remove_file(dev, &attr->dev_attr);
1752 }
1753 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan3); i++)
1754 device_remove_file(dev, &sda_sf3_arrays_fan3[i].dev_attr);
1755 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1756 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
1757 for (i = 0; i < data->in_num; i++) {
1758 if ((i == 6) && data->in6_skip)
1759 continue;
1760 device_remove_file(dev, &sda_in_input[i].dev_attr);
1761 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1762 device_remove_file(dev, &sda_in_min[i].dev_attr);
1763 device_remove_file(dev, &sda_in_max[i].dev_attr);
1764 }
1765 for (i = 0; i < 5; i++) {
1766 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1767 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1768 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1769 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1770 }
1771 for (i = 0; i < data->pwm_num; i++) {
1772 device_remove_file(dev, &sda_pwm[i].dev_attr);
1773 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1774 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1775 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1776 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1777 }
1778 for (i = 0; i < NUM_REG_TEMP; i++) {
1779 if (!(data->have_temp & (1 << i)))
1780 continue;
1781 device_remove_file(dev, &sda_temp_input[i].dev_attr);
1782 device_remove_file(dev, &sda_temp_label[i].dev_attr);
1783 if (i == 2 && data->temp3_val_only)
1784 continue;
1785 device_remove_file(dev, &sda_temp_max[i].dev_attr);
1786 device_remove_file(dev, &sda_temp_max_hyst[i].dev_attr);
1787 if (i > 2)
1788 continue;
1789 device_remove_file(dev, &sda_temp_alarm[i].dev_attr);
1790 device_remove_file(dev, &sda_temp_type[i].dev_attr);
1791 }
1792
1793 device_remove_file(dev, &sda_caseopen[0].dev_attr);
1794 device_remove_file(dev, &sda_caseopen[1].dev_attr);
1795
1796 device_remove_file(dev, &dev_attr_name);
1797 device_remove_file(dev, &dev_attr_cpu0_vid);
1798 }
1799
1800 /* Get the monitoring functions started */
w83627ehf_init_device(struct w83627ehf_data * data,enum kinds kind)1801 static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data,
1802 enum kinds kind)
1803 {
1804 int i;
1805 u8 tmp, diode;
1806
1807 /* Start monitoring is needed */
1808 tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
1809 if (!(tmp & 0x01))
1810 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
1811 tmp | 0x01);
1812
1813 /* Enable temperature sensors if needed */
1814 for (i = 0; i < NUM_REG_TEMP; i++) {
1815 if (!(data->have_temp & (1 << i)))
1816 continue;
1817 if (!data->reg_temp_config[i])
1818 continue;
1819 tmp = w83627ehf_read_value(data,
1820 data->reg_temp_config[i]);
1821 if (tmp & 0x01)
1822 w83627ehf_write_value(data,
1823 data->reg_temp_config[i],
1824 tmp & 0xfe);
1825 }
1826
1827 /* Enable VBAT monitoring if needed */
1828 tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
1829 if (!(tmp & 0x01))
1830 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01);
1831
1832 /* Get thermal sensor types */
1833 switch (kind) {
1834 case w83627ehf:
1835 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
1836 break;
1837 case w83627uhg:
1838 diode = 0x00;
1839 break;
1840 default:
1841 diode = 0x70;
1842 }
1843 for (i = 0; i < 3; i++) {
1844 const char *label = NULL;
1845
1846 if (data->temp_label)
1847 label = data->temp_label[data->temp_src[i]];
1848
1849 /* Digital source overrides analog type */
1850 if (label && strncmp(label, "PECI", 4) == 0)
1851 data->temp_type[i] = 6;
1852 else if (label && strncmp(label, "AMD", 3) == 0)
1853 data->temp_type[i] = 5;
1854 else if ((tmp & (0x02 << i)))
1855 data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 3;
1856 else
1857 data->temp_type[i] = 4; /* thermistor */
1858 }
1859 }
1860
w82627ehf_swap_tempreg(struct w83627ehf_data * data,int r1,int r2)1861 static void w82627ehf_swap_tempreg(struct w83627ehf_data *data,
1862 int r1, int r2)
1863 {
1864 u16 tmp;
1865
1866 tmp = data->temp_src[r1];
1867 data->temp_src[r1] = data->temp_src[r2];
1868 data->temp_src[r2] = tmp;
1869
1870 tmp = data->reg_temp[r1];
1871 data->reg_temp[r1] = data->reg_temp[r2];
1872 data->reg_temp[r2] = tmp;
1873
1874 tmp = data->reg_temp_over[r1];
1875 data->reg_temp_over[r1] = data->reg_temp_over[r2];
1876 data->reg_temp_over[r2] = tmp;
1877
1878 tmp = data->reg_temp_hyst[r1];
1879 data->reg_temp_hyst[r1] = data->reg_temp_hyst[r2];
1880 data->reg_temp_hyst[r2] = tmp;
1881
1882 tmp = data->reg_temp_config[r1];
1883 data->reg_temp_config[r1] = data->reg_temp_config[r2];
1884 data->reg_temp_config[r2] = tmp;
1885 }
1886
1887 static void __devinit
w83627ehf_set_temp_reg_ehf(struct w83627ehf_data * data,int n_temp)1888 w83627ehf_set_temp_reg_ehf(struct w83627ehf_data *data, int n_temp)
1889 {
1890 int i;
1891
1892 for (i = 0; i < n_temp; i++) {
1893 data->reg_temp[i] = W83627EHF_REG_TEMP[i];
1894 data->reg_temp_over[i] = W83627EHF_REG_TEMP_OVER[i];
1895 data->reg_temp_hyst[i] = W83627EHF_REG_TEMP_HYST[i];
1896 data->reg_temp_config[i] = W83627EHF_REG_TEMP_CONFIG[i];
1897 }
1898 }
1899
1900 static void __devinit
w83627ehf_check_fan_inputs(const struct w83627ehf_sio_data * sio_data,struct w83627ehf_data * data)1901 w83627ehf_check_fan_inputs(const struct w83627ehf_sio_data *sio_data,
1902 struct w83627ehf_data *data)
1903 {
1904 int fan3pin, fan4pin, fan4min, fan5pin, regval;
1905
1906 /* The W83627UHG is simple, only two fan inputs, no config */
1907 if (sio_data->kind == w83627uhg) {
1908 data->has_fan = 0x03; /* fan1 and fan2 */
1909 data->has_fan_min = 0x03;
1910 return;
1911 }
1912
1913 superio_enter(sio_data->sioreg);
1914
1915 /* fan4 and fan5 share some pins with the GPIO and serial flash */
1916 if (sio_data->kind == nct6775) {
1917 /* On NCT6775, fan4 shares pins with the fdc interface */
1918 fan3pin = 1;
1919 fan4pin = !(superio_inb(sio_data->sioreg, 0x2A) & 0x80);
1920 fan4min = 0;
1921 fan5pin = 0;
1922 } else if (sio_data->kind == nct6776) {
1923 bool gpok = superio_inb(sio_data->sioreg, 0x27) & 0x80;
1924
1925 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
1926 regval = superio_inb(sio_data->sioreg, SIO_REG_ENABLE);
1927
1928 if (regval & 0x80)
1929 fan3pin = gpok;
1930 else
1931 fan3pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x40);
1932
1933 if (regval & 0x40)
1934 fan4pin = gpok;
1935 else
1936 fan4pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x01);
1937
1938 if (regval & 0x20)
1939 fan5pin = gpok;
1940 else
1941 fan5pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x02);
1942
1943 fan4min = fan4pin;
1944 } else if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) {
1945 fan3pin = 1;
1946 fan4pin = superio_inb(sio_data->sioreg, 0x27) & 0x40;
1947 fan5pin = superio_inb(sio_data->sioreg, 0x27) & 0x20;
1948 fan4min = fan4pin;
1949 } else {
1950 fan3pin = 1;
1951 fan4pin = !(superio_inb(sio_data->sioreg, 0x29) & 0x06);
1952 fan5pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x02);
1953 fan4min = fan4pin;
1954 }
1955
1956 superio_exit(sio_data->sioreg);
1957
1958 data->has_fan = data->has_fan_min = 0x03; /* fan1 and fan2 */
1959 data->has_fan |= (fan3pin << 2);
1960 data->has_fan_min |= (fan3pin << 2);
1961
1962 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1963 /*
1964 * NCT6775F and NCT6776F don't have the W83627EHF_REG_FANDIV1
1965 * register
1966 */
1967 data->has_fan |= (fan4pin << 3) | (fan5pin << 4);
1968 data->has_fan_min |= (fan4min << 3) | (fan5pin << 4);
1969 } else {
1970 /*
1971 * It looks like fan4 and fan5 pins can be alternatively used
1972 * as fan on/off switches, but fan5 control is write only :/
1973 * We assume that if the serial interface is disabled, designers
1974 * connected fan5 as input unless they are emitting log 1, which
1975 * is not the default.
1976 */
1977 regval = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
1978 if ((regval & (1 << 2)) && fan4pin) {
1979 data->has_fan |= (1 << 3);
1980 data->has_fan_min |= (1 << 3);
1981 }
1982 if (!(regval & (1 << 1)) && fan5pin) {
1983 data->has_fan |= (1 << 4);
1984 data->has_fan_min |= (1 << 4);
1985 }
1986 }
1987 }
1988
w83627ehf_probe(struct platform_device * pdev)1989 static int __devinit w83627ehf_probe(struct platform_device *pdev)
1990 {
1991 struct device *dev = &pdev->dev;
1992 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1993 struct w83627ehf_data *data;
1994 struct resource *res;
1995 u8 en_vrm10;
1996 int i, err = 0;
1997
1998 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1999 if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
2000 err = -EBUSY;
2001 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
2002 (unsigned long)res->start,
2003 (unsigned long)res->start + IOREGION_LENGTH - 1);
2004 goto exit;
2005 }
2006
2007 data = devm_kzalloc(&pdev->dev, sizeof(struct w83627ehf_data),
2008 GFP_KERNEL);
2009 if (!data) {
2010 err = -ENOMEM;
2011 goto exit_release;
2012 }
2013
2014 data->addr = res->start;
2015 mutex_init(&data->lock);
2016 mutex_init(&data->update_lock);
2017 data->name = w83627ehf_device_names[sio_data->kind];
2018 platform_set_drvdata(pdev, data);
2019
2020 /* 627EHG and 627EHF have 10 voltage inputs; 627DHG and 667HG have 9 */
2021 data->in_num = (sio_data->kind == w83627ehf) ? 10 : 9;
2022 /* 667HG, NCT6775F, and NCT6776F have 3 pwms, and 627UHG has only 2 */
2023 switch (sio_data->kind) {
2024 default:
2025 data->pwm_num = 4;
2026 break;
2027 case w83667hg:
2028 case w83667hg_b:
2029 case nct6775:
2030 case nct6776:
2031 data->pwm_num = 3;
2032 break;
2033 case w83627uhg:
2034 data->pwm_num = 2;
2035 break;
2036 }
2037
2038 /* Default to 3 temperature inputs, code below will adjust as needed */
2039 data->have_temp = 0x07;
2040
2041 /* Deal with temperature register setup first. */
2042 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
2043 int mask = 0;
2044
2045 /*
2046 * Display temperature sensor output only if it monitors
2047 * a source other than one already reported. Always display
2048 * first three temperature registers, though.
2049 */
2050 for (i = 0; i < NUM_REG_TEMP; i++) {
2051 u8 src;
2052
2053 data->reg_temp[i] = NCT6775_REG_TEMP[i];
2054 data->reg_temp_over[i] = NCT6775_REG_TEMP_OVER[i];
2055 data->reg_temp_hyst[i] = NCT6775_REG_TEMP_HYST[i];
2056 data->reg_temp_config[i] = NCT6775_REG_TEMP_CONFIG[i];
2057
2058 src = w83627ehf_read_value(data,
2059 NCT6775_REG_TEMP_SOURCE[i]);
2060 src &= 0x1f;
2061 if (src && !(mask & (1 << src))) {
2062 data->have_temp |= 1 << i;
2063 mask |= 1 << src;
2064 }
2065
2066 data->temp_src[i] = src;
2067
2068 /*
2069 * Now do some register swapping if index 0..2 don't
2070 * point to SYSTIN(1), CPUIN(2), and AUXIN(3).
2071 * Idea is to have the first three attributes
2072 * report SYSTIN, CPUIN, and AUXIN if possible
2073 * without overriding the basic system configuration.
2074 */
2075 if (i > 0 && data->temp_src[0] != 1
2076 && data->temp_src[i] == 1)
2077 w82627ehf_swap_tempreg(data, 0, i);
2078 if (i > 1 && data->temp_src[1] != 2
2079 && data->temp_src[i] == 2)
2080 w82627ehf_swap_tempreg(data, 1, i);
2081 if (i > 2 && data->temp_src[2] != 3
2082 && data->temp_src[i] == 3)
2083 w82627ehf_swap_tempreg(data, 2, i);
2084 }
2085 if (sio_data->kind == nct6776) {
2086 /*
2087 * On NCT6776, AUXTIN and VIN3 pins are shared.
2088 * Only way to detect it is to check if AUXTIN is used
2089 * as a temperature source, and if that source is
2090 * enabled.
2091 *
2092 * If that is the case, disable in6, which reports VIN3.
2093 * Otherwise disable temp3.
2094 */
2095 if (data->temp_src[2] == 3) {
2096 u8 reg;
2097
2098 if (data->reg_temp_config[2])
2099 reg = w83627ehf_read_value(data,
2100 data->reg_temp_config[2]);
2101 else
2102 reg = 0; /* Assume AUXTIN is used */
2103
2104 if (reg & 0x01)
2105 data->have_temp &= ~(1 << 2);
2106 else
2107 data->in6_skip = 1;
2108 }
2109 data->temp_label = nct6776_temp_label;
2110 } else {
2111 data->temp_label = nct6775_temp_label;
2112 }
2113 } else if (sio_data->kind == w83667hg_b) {
2114 u8 reg;
2115
2116 w83627ehf_set_temp_reg_ehf(data, 4);
2117
2118 /*
2119 * Temperature sources are selected with bank 0, registers 0x49
2120 * and 0x4a.
2121 */
2122 reg = w83627ehf_read_value(data, 0x4a);
2123 data->temp_src[0] = reg >> 5;
2124 reg = w83627ehf_read_value(data, 0x49);
2125 data->temp_src[1] = reg & 0x07;
2126 data->temp_src[2] = (reg >> 4) & 0x07;
2127
2128 /*
2129 * W83667HG-B has another temperature register at 0x7e.
2130 * The temperature source is selected with register 0x7d.
2131 * Support it if the source differs from already reported
2132 * sources.
2133 */
2134 reg = w83627ehf_read_value(data, 0x7d);
2135 reg &= 0x07;
2136 if (reg != data->temp_src[0] && reg != data->temp_src[1]
2137 && reg != data->temp_src[2]) {
2138 data->temp_src[3] = reg;
2139 data->have_temp |= 1 << 3;
2140 }
2141
2142 /*
2143 * Chip supports either AUXTIN or VIN3. Try to find out which
2144 * one.
2145 */
2146 reg = w83627ehf_read_value(data, W83627EHF_REG_TEMP_CONFIG[2]);
2147 if (data->temp_src[2] == 2 && (reg & 0x01))
2148 data->have_temp &= ~(1 << 2);
2149
2150 if ((data->temp_src[2] == 2 && (data->have_temp & (1 << 2)))
2151 || (data->temp_src[3] == 2 && (data->have_temp & (1 << 3))))
2152 data->in6_skip = 1;
2153
2154 data->temp_label = w83667hg_b_temp_label;
2155 } else if (sio_data->kind == w83627uhg) {
2156 u8 reg;
2157
2158 w83627ehf_set_temp_reg_ehf(data, 3);
2159
2160 /*
2161 * Temperature sources for temp2 and temp3 are selected with
2162 * bank 0, registers 0x49 and 0x4a.
2163 */
2164 data->temp_src[0] = 0; /* SYSTIN */
2165 reg = w83627ehf_read_value(data, 0x49) & 0x07;
2166 /* Adjust to have the same mapping as other source registers */
2167 if (reg == 0)
2168 data->temp_src[1] = 1;
2169 else if (reg >= 2 && reg <= 5)
2170 data->temp_src[1] = reg + 2;
2171 else /* should never happen */
2172 data->have_temp &= ~(1 << 1);
2173 reg = w83627ehf_read_value(data, 0x4a);
2174 data->temp_src[2] = reg >> 5;
2175
2176 /*
2177 * Skip temp3 if source is invalid or the same as temp1
2178 * or temp2.
2179 */
2180 if (data->temp_src[2] == 2 || data->temp_src[2] == 3 ||
2181 data->temp_src[2] == data->temp_src[0] ||
2182 ((data->have_temp & (1 << 1)) &&
2183 data->temp_src[2] == data->temp_src[1]))
2184 data->have_temp &= ~(1 << 2);
2185 else
2186 data->temp3_val_only = 1; /* No limit regs */
2187
2188 data->in6_skip = 1; /* No VIN3 */
2189
2190 data->temp_label = w83667hg_b_temp_label;
2191 } else {
2192 w83627ehf_set_temp_reg_ehf(data, 3);
2193
2194 /* Temperature sources are fixed */
2195
2196 if (sio_data->kind == w83667hg) {
2197 u8 reg;
2198
2199 /*
2200 * Chip supports either AUXTIN or VIN3. Try to find
2201 * out which one.
2202 */
2203 reg = w83627ehf_read_value(data,
2204 W83627EHF_REG_TEMP_CONFIG[2]);
2205 if (reg & 0x01)
2206 data->have_temp &= ~(1 << 2);
2207 else
2208 data->in6_skip = 1;
2209 }
2210 }
2211
2212 if (sio_data->kind == nct6775) {
2213 data->has_fan_div = true;
2214 data->fan_from_reg = fan_from_reg16;
2215 data->fan_from_reg_min = fan_from_reg8;
2216 data->REG_PWM = NCT6775_REG_PWM;
2217 data->REG_TARGET = NCT6775_REG_TARGET;
2218 data->REG_FAN = NCT6775_REG_FAN;
2219 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2220 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2221 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2222 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2223 data->REG_FAN_MAX_OUTPUT = NCT6775_REG_FAN_MAX_OUTPUT;
2224 data->REG_FAN_STEP_OUTPUT = NCT6775_REG_FAN_STEP_OUTPUT;
2225 } else if (sio_data->kind == nct6776) {
2226 data->has_fan_div = false;
2227 data->fan_from_reg = fan_from_reg13;
2228 data->fan_from_reg_min = fan_from_reg13;
2229 data->REG_PWM = NCT6775_REG_PWM;
2230 data->REG_TARGET = NCT6775_REG_TARGET;
2231 data->REG_FAN = NCT6775_REG_FAN;
2232 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
2233 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2234 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2235 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2236 } else if (sio_data->kind == w83667hg_b) {
2237 data->has_fan_div = true;
2238 data->fan_from_reg = fan_from_reg8;
2239 data->fan_from_reg_min = fan_from_reg8;
2240 data->REG_PWM = W83627EHF_REG_PWM;
2241 data->REG_TARGET = W83627EHF_REG_TARGET;
2242 data->REG_FAN = W83627EHF_REG_FAN;
2243 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2244 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2245 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2246 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
2247 data->REG_FAN_MAX_OUTPUT =
2248 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B;
2249 data->REG_FAN_STEP_OUTPUT =
2250 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B;
2251 } else {
2252 data->has_fan_div = true;
2253 data->fan_from_reg = fan_from_reg8;
2254 data->fan_from_reg_min = fan_from_reg8;
2255 data->REG_PWM = W83627EHF_REG_PWM;
2256 data->REG_TARGET = W83627EHF_REG_TARGET;
2257 data->REG_FAN = W83627EHF_REG_FAN;
2258 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2259 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2260 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2261 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
2262 data->REG_FAN_MAX_OUTPUT =
2263 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON;
2264 data->REG_FAN_STEP_OUTPUT =
2265 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON;
2266 }
2267
2268 /* Setup input voltage scaling factors */
2269 if (sio_data->kind == w83627uhg)
2270 data->scale_in = scale_in_w83627uhg;
2271 else
2272 data->scale_in = scale_in_common;
2273
2274 /* Initialize the chip */
2275 w83627ehf_init_device(data, sio_data->kind);
2276
2277 data->vrm = vid_which_vrm();
2278 superio_enter(sio_data->sioreg);
2279 /* Read VID value */
2280 if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b ||
2281 sio_data->kind == nct6775 || sio_data->kind == nct6776) {
2282 /* W83667HG has different pins for VID input and output, so
2283 we can get the VID input values directly at logical device D
2284 0xe3. */
2285 superio_select(sio_data->sioreg, W83667HG_LD_VID);
2286 data->vid = superio_inb(sio_data->sioreg, 0xe3);
2287 err = device_create_file(dev, &dev_attr_cpu0_vid);
2288 if (err)
2289 goto exit_release;
2290 } else if (sio_data->kind != w83627uhg) {
2291 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2292 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) {
2293 /* Set VID input sensibility if needed. In theory the
2294 BIOS should have set it, but in practice it's not
2295 always the case. We only do it for the W83627EHF/EHG
2296 because the W83627DHG is more complex in this
2297 respect. */
2298 if (sio_data->kind == w83627ehf) {
2299 en_vrm10 = superio_inb(sio_data->sioreg,
2300 SIO_REG_EN_VRM10);
2301 if ((en_vrm10 & 0x08) && data->vrm == 90) {
2302 dev_warn(dev, "Setting VID input "
2303 "voltage to TTL\n");
2304 superio_outb(sio_data->sioreg,
2305 SIO_REG_EN_VRM10,
2306 en_vrm10 & ~0x08);
2307 } else if (!(en_vrm10 & 0x08)
2308 && data->vrm == 100) {
2309 dev_warn(dev, "Setting VID input "
2310 "voltage to VRM10\n");
2311 superio_outb(sio_data->sioreg,
2312 SIO_REG_EN_VRM10,
2313 en_vrm10 | 0x08);
2314 }
2315 }
2316
2317 data->vid = superio_inb(sio_data->sioreg,
2318 SIO_REG_VID_DATA);
2319 if (sio_data->kind == w83627ehf) /* 6 VID pins only */
2320 data->vid &= 0x3f;
2321
2322 err = device_create_file(dev, &dev_attr_cpu0_vid);
2323 if (err)
2324 goto exit_release;
2325 } else {
2326 dev_info(dev, "VID pins in output mode, CPU VID not "
2327 "available\n");
2328 }
2329 }
2330
2331 if (fan_debounce &&
2332 (sio_data->kind == nct6775 || sio_data->kind == nct6776)) {
2333 u8 tmp;
2334
2335 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2336 tmp = superio_inb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE);
2337 if (sio_data->kind == nct6776)
2338 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2339 0x3e | tmp);
2340 else
2341 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2342 0x1e | tmp);
2343 pr_info("Enabled fan debounce for chip %s\n", data->name);
2344 }
2345
2346 superio_exit(sio_data->sioreg);
2347
2348 w83627ehf_check_fan_inputs(sio_data, data);
2349
2350 /* Read fan clock dividers immediately */
2351 w83627ehf_update_fan_div_common(dev, data);
2352
2353 /* Read pwm data to save original values */
2354 w83627ehf_update_pwm_common(dev, data);
2355 for (i = 0; i < data->pwm_num; i++)
2356 data->pwm_enable_orig[i] = data->pwm_enable[i];
2357
2358 /* Register sysfs hooks */
2359 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++) {
2360 err = device_create_file(dev, &sda_sf3_arrays[i].dev_attr);
2361 if (err)
2362 goto exit_remove;
2363 }
2364
2365 for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
2366 struct sensor_device_attribute *attr =
2367 &sda_sf3_max_step_arrays[i];
2368 if (data->REG_FAN_STEP_OUTPUT &&
2369 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff) {
2370 err = device_create_file(dev, &attr->dev_attr);
2371 if (err)
2372 goto exit_remove;
2373 }
2374 }
2375 /* if fan3 and fan4 are enabled create the sf3 files for them */
2376 if ((data->has_fan & (1 << 2)) && data->pwm_num >= 3)
2377 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan3); i++) {
2378 err = device_create_file(dev,
2379 &sda_sf3_arrays_fan3[i].dev_attr);
2380 if (err)
2381 goto exit_remove;
2382 }
2383 if ((data->has_fan & (1 << 3)) && data->pwm_num >= 4)
2384 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
2385 err = device_create_file(dev,
2386 &sda_sf3_arrays_fan4[i].dev_attr);
2387 if (err)
2388 goto exit_remove;
2389 }
2390
2391 for (i = 0; i < data->in_num; i++) {
2392 if ((i == 6) && data->in6_skip)
2393 continue;
2394 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
2395 || (err = device_create_file(dev,
2396 &sda_in_alarm[i].dev_attr))
2397 || (err = device_create_file(dev,
2398 &sda_in_min[i].dev_attr))
2399 || (err = device_create_file(dev,
2400 &sda_in_max[i].dev_attr)))
2401 goto exit_remove;
2402 }
2403
2404 for (i = 0; i < 5; i++) {
2405 if (data->has_fan & (1 << i)) {
2406 if ((err = device_create_file(dev,
2407 &sda_fan_input[i].dev_attr))
2408 || (err = device_create_file(dev,
2409 &sda_fan_alarm[i].dev_attr)))
2410 goto exit_remove;
2411 if (sio_data->kind != nct6776) {
2412 err = device_create_file(dev,
2413 &sda_fan_div[i].dev_attr);
2414 if (err)
2415 goto exit_remove;
2416 }
2417 if (data->has_fan_min & (1 << i)) {
2418 err = device_create_file(dev,
2419 &sda_fan_min[i].dev_attr);
2420 if (err)
2421 goto exit_remove;
2422 }
2423 if (i < data->pwm_num &&
2424 ((err = device_create_file(dev,
2425 &sda_pwm[i].dev_attr))
2426 || (err = device_create_file(dev,
2427 &sda_pwm_mode[i].dev_attr))
2428 || (err = device_create_file(dev,
2429 &sda_pwm_enable[i].dev_attr))
2430 || (err = device_create_file(dev,
2431 &sda_target_temp[i].dev_attr))
2432 || (err = device_create_file(dev,
2433 &sda_tolerance[i].dev_attr))))
2434 goto exit_remove;
2435 }
2436 }
2437
2438 for (i = 0; i < NUM_REG_TEMP; i++) {
2439 if (!(data->have_temp & (1 << i)))
2440 continue;
2441 err = device_create_file(dev, &sda_temp_input[i].dev_attr);
2442 if (err)
2443 goto exit_remove;
2444 if (data->temp_label) {
2445 err = device_create_file(dev,
2446 &sda_temp_label[i].dev_attr);
2447 if (err)
2448 goto exit_remove;
2449 }
2450 if (i == 2 && data->temp3_val_only)
2451 continue;
2452 if (data->reg_temp_over[i]) {
2453 err = device_create_file(dev,
2454 &sda_temp_max[i].dev_attr);
2455 if (err)
2456 goto exit_remove;
2457 }
2458 if (data->reg_temp_hyst[i]) {
2459 err = device_create_file(dev,
2460 &sda_temp_max_hyst[i].dev_attr);
2461 if (err)
2462 goto exit_remove;
2463 }
2464 if (i > 2)
2465 continue;
2466 if ((err = device_create_file(dev,
2467 &sda_temp_alarm[i].dev_attr))
2468 || (err = device_create_file(dev,
2469 &sda_temp_type[i].dev_attr)))
2470 goto exit_remove;
2471 }
2472
2473 err = device_create_file(dev, &sda_caseopen[0].dev_attr);
2474 if (err)
2475 goto exit_remove;
2476
2477 if (sio_data->kind == nct6776) {
2478 err = device_create_file(dev, &sda_caseopen[1].dev_attr);
2479 if (err)
2480 goto exit_remove;
2481 }
2482
2483 err = device_create_file(dev, &dev_attr_name);
2484 if (err)
2485 goto exit_remove;
2486
2487 data->hwmon_dev = hwmon_device_register(dev);
2488 if (IS_ERR(data->hwmon_dev)) {
2489 err = PTR_ERR(data->hwmon_dev);
2490 goto exit_remove;
2491 }
2492
2493 return 0;
2494
2495 exit_remove:
2496 w83627ehf_device_remove_files(dev);
2497 exit_release:
2498 platform_set_drvdata(pdev, NULL);
2499 release_region(res->start, IOREGION_LENGTH);
2500 exit:
2501 return err;
2502 }
2503
w83627ehf_remove(struct platform_device * pdev)2504 static int __devexit w83627ehf_remove(struct platform_device *pdev)
2505 {
2506 struct w83627ehf_data *data = platform_get_drvdata(pdev);
2507
2508 hwmon_device_unregister(data->hwmon_dev);
2509 w83627ehf_device_remove_files(&pdev->dev);
2510 release_region(data->addr, IOREGION_LENGTH);
2511 platform_set_drvdata(pdev, NULL);
2512
2513 return 0;
2514 }
2515
2516 static struct platform_driver w83627ehf_driver = {
2517 .driver = {
2518 .owner = THIS_MODULE,
2519 .name = DRVNAME,
2520 },
2521 .probe = w83627ehf_probe,
2522 .remove = __devexit_p(w83627ehf_remove),
2523 };
2524
2525 /* w83627ehf_find() looks for a '627 in the Super-I/O config space */
w83627ehf_find(int sioaddr,unsigned short * addr,struct w83627ehf_sio_data * sio_data)2526 static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
2527 struct w83627ehf_sio_data *sio_data)
2528 {
2529 static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
2530 static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
2531 static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
2532 static const char __initdata sio_name_W83627DHG_P[] = "W83627DHG-P";
2533 static const char __initdata sio_name_W83627UHG[] = "W83627UHG";
2534 static const char __initdata sio_name_W83667HG[] = "W83667HG";
2535 static const char __initdata sio_name_W83667HG_B[] = "W83667HG-B";
2536 static const char __initdata sio_name_NCT6775[] = "NCT6775F";
2537 static const char __initdata sio_name_NCT6776[] = "NCT6776F";
2538
2539 u16 val;
2540 const char *sio_name;
2541
2542 superio_enter(sioaddr);
2543
2544 if (force_id)
2545 val = force_id;
2546 else
2547 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
2548 | superio_inb(sioaddr, SIO_REG_DEVID + 1);
2549 switch (val & SIO_ID_MASK) {
2550 case SIO_W83627EHF_ID:
2551 sio_data->kind = w83627ehf;
2552 sio_name = sio_name_W83627EHF;
2553 break;
2554 case SIO_W83627EHG_ID:
2555 sio_data->kind = w83627ehf;
2556 sio_name = sio_name_W83627EHG;
2557 break;
2558 case SIO_W83627DHG_ID:
2559 sio_data->kind = w83627dhg;
2560 sio_name = sio_name_W83627DHG;
2561 break;
2562 case SIO_W83627DHG_P_ID:
2563 sio_data->kind = w83627dhg_p;
2564 sio_name = sio_name_W83627DHG_P;
2565 break;
2566 case SIO_W83627UHG_ID:
2567 sio_data->kind = w83627uhg;
2568 sio_name = sio_name_W83627UHG;
2569 break;
2570 case SIO_W83667HG_ID:
2571 sio_data->kind = w83667hg;
2572 sio_name = sio_name_W83667HG;
2573 break;
2574 case SIO_W83667HG_B_ID:
2575 sio_data->kind = w83667hg_b;
2576 sio_name = sio_name_W83667HG_B;
2577 break;
2578 case SIO_NCT6775_ID:
2579 sio_data->kind = nct6775;
2580 sio_name = sio_name_NCT6775;
2581 break;
2582 case SIO_NCT6776_ID:
2583 sio_data->kind = nct6776;
2584 sio_name = sio_name_NCT6776;
2585 break;
2586 default:
2587 if (val != 0xffff)
2588 pr_debug("unsupported chip ID: 0x%04x\n", val);
2589 superio_exit(sioaddr);
2590 return -ENODEV;
2591 }
2592
2593 /* We have a known chip, find the HWM I/O address */
2594 superio_select(sioaddr, W83627EHF_LD_HWM);
2595 val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
2596 | superio_inb(sioaddr, SIO_REG_ADDR + 1);
2597 *addr = val & IOREGION_ALIGNMENT;
2598 if (*addr == 0) {
2599 pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n");
2600 superio_exit(sioaddr);
2601 return -ENODEV;
2602 }
2603
2604 /* Activate logical device if needed */
2605 val = superio_inb(sioaddr, SIO_REG_ENABLE);
2606 if (!(val & 0x01)) {
2607 pr_warn("Forcibly enabling Super-I/O. "
2608 "Sensor is probably unusable.\n");
2609 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
2610 }
2611
2612 superio_exit(sioaddr);
2613 pr_info("Found %s chip at %#x\n", sio_name, *addr);
2614 sio_data->sioreg = sioaddr;
2615
2616 return 0;
2617 }
2618
2619 /* when Super-I/O functions move to a separate file, the Super-I/O
2620 * bus will manage the lifetime of the device and this module will only keep
2621 * track of the w83627ehf driver. But since we platform_device_alloc(), we
2622 * must keep track of the device */
2623 static struct platform_device *pdev;
2624
sensors_w83627ehf_init(void)2625 static int __init sensors_w83627ehf_init(void)
2626 {
2627 int err;
2628 unsigned short address;
2629 struct resource res;
2630 struct w83627ehf_sio_data sio_data;
2631
2632 /* initialize sio_data->kind and sio_data->sioreg.
2633 *
2634 * when Super-I/O functions move to a separate file, the Super-I/O
2635 * driver will probe 0x2e and 0x4e and auto-detect the presence of a
2636 * w83627ehf hardware monitor, and call probe() */
2637 if (w83627ehf_find(0x2e, &address, &sio_data) &&
2638 w83627ehf_find(0x4e, &address, &sio_data))
2639 return -ENODEV;
2640
2641 err = platform_driver_register(&w83627ehf_driver);
2642 if (err)
2643 goto exit;
2644
2645 pdev = platform_device_alloc(DRVNAME, address);
2646 if (!pdev) {
2647 err = -ENOMEM;
2648 pr_err("Device allocation failed\n");
2649 goto exit_unregister;
2650 }
2651
2652 err = platform_device_add_data(pdev, &sio_data,
2653 sizeof(struct w83627ehf_sio_data));
2654 if (err) {
2655 pr_err("Platform data allocation failed\n");
2656 goto exit_device_put;
2657 }
2658
2659 memset(&res, 0, sizeof(res));
2660 res.name = DRVNAME;
2661 res.start = address + IOREGION_OFFSET;
2662 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
2663 res.flags = IORESOURCE_IO;
2664
2665 err = acpi_check_resource_conflict(&res);
2666 if (err)
2667 goto exit_device_put;
2668
2669 err = platform_device_add_resources(pdev, &res, 1);
2670 if (err) {
2671 pr_err("Device resource addition failed (%d)\n", err);
2672 goto exit_device_put;
2673 }
2674
2675 /* platform_device_add calls probe() */
2676 err = platform_device_add(pdev);
2677 if (err) {
2678 pr_err("Device addition failed (%d)\n", err);
2679 goto exit_device_put;
2680 }
2681
2682 return 0;
2683
2684 exit_device_put:
2685 platform_device_put(pdev);
2686 exit_unregister:
2687 platform_driver_unregister(&w83627ehf_driver);
2688 exit:
2689 return err;
2690 }
2691
sensors_w83627ehf_exit(void)2692 static void __exit sensors_w83627ehf_exit(void)
2693 {
2694 platform_device_unregister(pdev);
2695 platform_driver_unregister(&w83627ehf_driver);
2696 }
2697
2698 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
2699 MODULE_DESCRIPTION("W83627EHF driver");
2700 MODULE_LICENSE("GPL");
2701
2702 module_init(sensors_w83627ehf_init);
2703 module_exit(sensors_w83627ehf_exit);
2704