?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / hwmon / w83627ehf.c
blob0e0af0445222c4346af8fef879831831e49caffa
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 2 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
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
126 superio_inb(int ioreg, int reg)
127 {
128 outb(reg, ioreg);
129 return inb(ioreg + 1);
130 }
131
132 static inline void
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
140 superio_enter(int ioreg)
141 {
142 outb(0x87, ioreg);
143 outb(0x87, ioreg);
144 }
145
146 static inline void
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
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 */
347 static inline unsigned int step_time_from_reg(u8 reg, u8 mode)
348 {
349 return mode ? 100 * reg : 400 * reg;
350 }
351
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
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
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
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
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
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
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 */
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
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
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 */
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
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 */
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 */
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
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
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
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
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
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
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
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
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)
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
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
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
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
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
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
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)
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 int nr = sensor_attr->index;
1323 unsigned long val;
1324 int err;
1325 u16 reg;
1326
1327 err = kstrtoul(buf, 10, &val);
1328 if (err < 0)
1329 return err;
1330
1331 if (val > 1)
1332 return -EINVAL;
1333 mutex_lock(&data->update_lock);
1334 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1335 data->pwm_mode[nr] = val;
1336 reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]);
1337 if (!val)
1338 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr];
1339 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1340 mutex_unlock(&data->update_lock);
1341 return count;
1342 }
1343
1344 static ssize_t
1345 store_pwm(struct device *dev, struct device_attribute *attr,
1346 const char *buf, size_t count)
1347 {
1348 struct w83627ehf_data *data = dev_get_drvdata(dev);
1349 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1350 int nr = sensor_attr->index;
1351 unsigned long val;
1352 int err;
1353
1354 err = kstrtoul(buf, 10, &val);
1355 if (err < 0)
1356 return err;
1357
1358 val = SENSORS_LIMIT(val, 0, 255);
1359
1360 mutex_lock(&data->update_lock);
1361 data->pwm[nr] = val;
1362 w83627ehf_write_value(data, data->REG_PWM[nr], val);
1363 mutex_unlock(&data->update_lock);
1364 return count;
1365 }
1366
1367 static ssize_t
1368 store_pwm_enable(struct device *dev, struct device_attribute *attr,
1369 const char *buf, size_t count)
1370 {
1371 struct w83627ehf_data *data = dev_get_drvdata(dev);
1372 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1373 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1374 int nr = sensor_attr->index;
1375 unsigned long val;
1376 int err;
1377 u16 reg;
1378
1379 err = kstrtoul(buf, 10, &val);
1380 if (err < 0)
1381 return err;
1382
1383 if (!val || (val > 4 && val != data->pwm_enable_orig[nr]))
1384 return -EINVAL;
1385 /* SmartFan III mode is not supported on NCT6776F */
1386 if (sio_data->kind == nct6776 && val == 4)
1387 return -EINVAL;
1388
1389 mutex_lock(&data->update_lock);
1390 data->pwm_enable[nr] = val;
1391 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1392 reg = w83627ehf_read_value(data,
1393 NCT6775_REG_FAN_MODE[nr]);
1394 reg &= 0x0f;
1395 reg |= (val - 1) << 4;
1396 w83627ehf_write_value(data,
1397 NCT6775_REG_FAN_MODE[nr], reg);
1398 } else {
1399 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]);
1400 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]);
1401 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr];
1402 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg);
1403 }
1404 mutex_unlock(&data->update_lock);
1405 return count;
1406 }
1407
1408
1409 #define show_tol_temp(reg) \
1410 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1411 char *buf) \
1412 { \
1413 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1414 struct sensor_device_attribute *sensor_attr = \
1415 to_sensor_dev_attr(attr); \
1416 int nr = sensor_attr->index; \
1417 return sprintf(buf, "%d\n", data->reg[nr] * 1000); \
1418 }
1419
1420 show_tol_temp(tolerance)
1421 show_tol_temp(target_temp)
1422
1423 static ssize_t
1424 store_target_temp(struct device *dev, struct device_attribute *attr,
1425 const char *buf, size_t count)
1426 {
1427 struct w83627ehf_data *data = dev_get_drvdata(dev);
1428 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1429 int nr = sensor_attr->index;
1430 long val;
1431 int err;
1432
1433 err = kstrtol(buf, 10, &val);
1434 if (err < 0)
1435 return err;
1436
1437 val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 127);
1438
1439 mutex_lock(&data->update_lock);
1440 data->target_temp[nr] = val;
1441 w83627ehf_write_value(data, data->REG_TARGET[nr], val);
1442 mutex_unlock(&data->update_lock);
1443 return count;
1444 }
1445
1446 static ssize_t
1447 store_tolerance(struct device *dev, struct device_attribute *attr,
1448 const char *buf, size_t count)
1449 {
1450 struct w83627ehf_data *data = dev_get_drvdata(dev);
1451 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1452 struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
1453 int nr = sensor_attr->index;
1454 u16 reg;
1455 long val;
1456 int err;
1457
1458 err = kstrtol(buf, 10, &val);
1459 if (err < 0)
1460 return err;
1461
1462 /* Limit the temp to 0C - 15C */
1463 val = SENSORS_LIMIT(DIV_ROUND_CLOSEST(val, 1000), 0, 15);
1464
1465 mutex_lock(&data->update_lock);
1466 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1467 /* Limit tolerance further for NCT6776F */
1468 if (sio_data->kind == nct6776 && val > 7)
1469 val = 7;
1470 reg = w83627ehf_read_value(data, NCT6775_REG_FAN_MODE[nr]);
1471 reg = (reg & 0xf0) | val;
1472 w83627ehf_write_value(data, NCT6775_REG_FAN_MODE[nr], reg);
1473 } else {
1474 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]);
1475 if (nr == 1)
1476 reg = (reg & 0x0f) | (val << 4);
1477 else
1478 reg = (reg & 0xf0) | val;
1479 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg);
1480 }
1481 data->tolerance[nr] = val;
1482 mutex_unlock(&data->update_lock);
1483 return count;
1484 }
1485
1486 static struct sensor_device_attribute sda_pwm[] = {
1487 SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0),
1488 SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1),
1489 SENSOR_ATTR(pwm3, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 2),
1490 SENSOR_ATTR(pwm4, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 3),
1491 };
1492
1493 static struct sensor_device_attribute sda_pwm_mode[] = {
1494 SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1495 store_pwm_mode, 0),
1496 SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1497 store_pwm_mode, 1),
1498 SENSOR_ATTR(pwm3_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1499 store_pwm_mode, 2),
1500 SENSOR_ATTR(pwm4_mode, S_IWUSR | S_IRUGO, show_pwm_mode,
1501 store_pwm_mode, 3),
1502 };
1503
1504 static struct sensor_device_attribute sda_pwm_enable[] = {
1505 SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1506 store_pwm_enable, 0),
1507 SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1508 store_pwm_enable, 1),
1509 SENSOR_ATTR(pwm3_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1510 store_pwm_enable, 2),
1511 SENSOR_ATTR(pwm4_enable, S_IWUSR | S_IRUGO, show_pwm_enable,
1512 store_pwm_enable, 3),
1513 };
1514
1515 static struct sensor_device_attribute sda_target_temp[] = {
1516 SENSOR_ATTR(pwm1_target, S_IWUSR | S_IRUGO, show_target_temp,
1517 store_target_temp, 0),
1518 SENSOR_ATTR(pwm2_target, S_IWUSR | S_IRUGO, show_target_temp,
1519 store_target_temp, 1),
1520 SENSOR_ATTR(pwm3_target, S_IWUSR | S_IRUGO, show_target_temp,
1521 store_target_temp, 2),
1522 SENSOR_ATTR(pwm4_target, S_IWUSR | S_IRUGO, show_target_temp,
1523 store_target_temp, 3),
1524 };
1525
1526 static struct sensor_device_attribute sda_tolerance[] = {
1527 SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1528 store_tolerance, 0),
1529 SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1530 store_tolerance, 1),
1531 SENSOR_ATTR(pwm3_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1532 store_tolerance, 2),
1533 SENSOR_ATTR(pwm4_tolerance, S_IWUSR | S_IRUGO, show_tolerance,
1534 store_tolerance, 3),
1535 };
1536
1537 /* Smart Fan registers */
1538
1539 #define fan_functions(reg, REG) \
1540 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1541 char *buf) \
1542 { \
1543 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1544 struct sensor_device_attribute *sensor_attr = \
1545 to_sensor_dev_attr(attr); \
1546 int nr = sensor_attr->index; \
1547 return sprintf(buf, "%d\n", data->reg[nr]); \
1548 } \
1549 static ssize_t \
1550 store_##reg(struct device *dev, struct device_attribute *attr, \
1551 const char *buf, size_t count) \
1552 { \
1553 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1554 struct sensor_device_attribute *sensor_attr = \
1555 to_sensor_dev_attr(attr); \
1556 int nr = sensor_attr->index; \
1557 unsigned long val; \
1558 int err; \
1559 err = kstrtoul(buf, 10, &val); \
1560 if (err < 0) \
1561 return err; \
1562 val = SENSORS_LIMIT(val, 1, 255); \
1563 mutex_lock(&data->update_lock); \
1564 data->reg[nr] = val; \
1565 w83627ehf_write_value(data, data->REG_##REG[nr], val); \
1566 mutex_unlock(&data->update_lock); \
1567 return count; \
1568 }
1569
1570 fan_functions(fan_start_output, FAN_START_OUTPUT)
1571 fan_functions(fan_stop_output, FAN_STOP_OUTPUT)
1572 fan_functions(fan_max_output, FAN_MAX_OUTPUT)
1573 fan_functions(fan_step_output, FAN_STEP_OUTPUT)
1574
1575 #define fan_time_functions(reg, REG) \
1576 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1577 char *buf) \
1578 { \
1579 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1580 struct sensor_device_attribute *sensor_attr = \
1581 to_sensor_dev_attr(attr); \
1582 int nr = sensor_attr->index; \
1583 return sprintf(buf, "%d\n", \
1584 step_time_from_reg(data->reg[nr], \
1585 data->pwm_mode[nr])); \
1586 } \
1587 \
1588 static ssize_t \
1589 store_##reg(struct device *dev, struct device_attribute *attr, \
1590 const char *buf, size_t count) \
1591 { \
1592 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1593 struct sensor_device_attribute *sensor_attr = \
1594 to_sensor_dev_attr(attr); \
1595 int nr = sensor_attr->index; \
1596 unsigned long val; \
1597 int err; \
1598 err = kstrtoul(buf, 10, &val); \
1599 if (err < 0) \
1600 return err; \
1601 val = step_time_to_reg(val, data->pwm_mode[nr]); \
1602 mutex_lock(&data->update_lock); \
1603 data->reg[nr] = val; \
1604 w83627ehf_write_value(data, W83627EHF_REG_##REG[nr], val); \
1605 mutex_unlock(&data->update_lock); \
1606 return count; \
1607 } \
1608
1609 fan_time_functions(fan_stop_time, FAN_STOP_TIME)
1610
1611 static ssize_t show_name(struct device *dev, struct device_attribute *attr,
1612 char *buf)
1613 {
1614 struct w83627ehf_data *data = dev_get_drvdata(dev);
1615
1616 return sprintf(buf, "%s\n", data->name);
1617 }
1618 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
1619
1620 static struct sensor_device_attribute sda_sf3_arrays_fan4[] = {
1621 SENSOR_ATTR(pwm4_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1622 store_fan_stop_time, 3),
1623 SENSOR_ATTR(pwm4_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1624 store_fan_start_output, 3),
1625 SENSOR_ATTR(pwm4_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1626 store_fan_stop_output, 3),
1627 SENSOR_ATTR(pwm4_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1628 store_fan_max_output, 3),
1629 SENSOR_ATTR(pwm4_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1630 store_fan_step_output, 3),
1631 };
1632
1633 static struct sensor_device_attribute sda_sf3_arrays_fan3[] = {
1634 SENSOR_ATTR(pwm3_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1635 store_fan_stop_time, 2),
1636 SENSOR_ATTR(pwm3_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1637 store_fan_start_output, 2),
1638 SENSOR_ATTR(pwm3_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1639 store_fan_stop_output, 2),
1640 };
1641
1642 static struct sensor_device_attribute sda_sf3_arrays[] = {
1643 SENSOR_ATTR(pwm1_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1644 store_fan_stop_time, 0),
1645 SENSOR_ATTR(pwm2_stop_time, S_IWUSR | S_IRUGO, show_fan_stop_time,
1646 store_fan_stop_time, 1),
1647 SENSOR_ATTR(pwm1_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1648 store_fan_start_output, 0),
1649 SENSOR_ATTR(pwm2_start_output, S_IWUSR | S_IRUGO, show_fan_start_output,
1650 store_fan_start_output, 1),
1651 SENSOR_ATTR(pwm1_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1652 store_fan_stop_output, 0),
1653 SENSOR_ATTR(pwm2_stop_output, S_IWUSR | S_IRUGO, show_fan_stop_output,
1654 store_fan_stop_output, 1),
1655 };
1656
1657
1658 /*
1659 * pwm1 and pwm3 don't support max and step settings on all chips.
1660 * Need to check support while generating/removing attribute files.
1661 */
1662 static struct sensor_device_attribute sda_sf3_max_step_arrays[] = {
1663 SENSOR_ATTR(pwm1_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1664 store_fan_max_output, 0),
1665 SENSOR_ATTR(pwm1_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1666 store_fan_step_output, 0),
1667 SENSOR_ATTR(pwm2_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1668 store_fan_max_output, 1),
1669 SENSOR_ATTR(pwm2_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1670 store_fan_step_output, 1),
1671 SENSOR_ATTR(pwm3_max_output, S_IWUSR | S_IRUGO, show_fan_max_output,
1672 store_fan_max_output, 2),
1673 SENSOR_ATTR(pwm3_step_output, S_IWUSR | S_IRUGO, show_fan_step_output,
1674 store_fan_step_output, 2),
1675 };
1676
1677 static ssize_t
1678 show_vid(struct device *dev, struct device_attribute *attr, char *buf)
1679 {
1680 struct w83627ehf_data *data = dev_get_drvdata(dev);
1681 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1682 }
1683 static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
1684
1685
1686 /* Case open detection */
1687
1688 static ssize_t
1689 show_caseopen(struct device *dev, struct device_attribute *attr, char *buf)
1690 {
1691 struct w83627ehf_data *data = w83627ehf_update_device(dev);
1692
1693 return sprintf(buf, "%d\n",
1694 !!(data->caseopen & to_sensor_dev_attr_2(attr)->index));
1695 }
1696
1697 static ssize_t
1698 clear_caseopen(struct device *dev, struct device_attribute *attr,
1699 const char *buf, size_t count)
1700 {
1701 struct w83627ehf_data *data = dev_get_drvdata(dev);
1702 unsigned long val;
1703 u16 reg, mask;
1704
1705 if (kstrtoul(buf, 10, &val) || val != 0)
1706 return -EINVAL;
1707
1708 mask = to_sensor_dev_attr_2(attr)->nr;
1709
1710 mutex_lock(&data->update_lock);
1711 reg = w83627ehf_read_value(data, W83627EHF_REG_CASEOPEN_CLR);
1712 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg | mask);
1713 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg & ~mask);
1714 data->valid = 0; /* Force cache refresh */
1715 mutex_unlock(&data->update_lock);
1716
1717 return count;
1718 }
1719
1720 static struct sensor_device_attribute_2 sda_caseopen[] = {
1721 SENSOR_ATTR_2(intrusion0_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1722 clear_caseopen, 0x80, 0x10),
1723 SENSOR_ATTR_2(intrusion1_alarm, S_IWUSR | S_IRUGO, show_caseopen,
1724 clear_caseopen, 0x40, 0x40),
1725 };
1726
1727 /*
1728 * Driver and device management
1729 */
1730
1731 static void w83627ehf_device_remove_files(struct device *dev)
1732 {
1733 /* some entries in the following arrays may not have been used in
1734 * device_create_file(), but device_remove_file() will ignore them */
1735 int i;
1736 struct w83627ehf_data *data = dev_get_drvdata(dev);
1737
1738 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++)
1739 device_remove_file(dev, &sda_sf3_arrays[i].dev_attr);
1740 for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
1741 struct sensor_device_attribute *attr =
1742 &sda_sf3_max_step_arrays[i];
1743 if (data->REG_FAN_STEP_OUTPUT &&
1744 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff)
1745 device_remove_file(dev, &attr->dev_attr);
1746 }
1747 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan3); i++)
1748 device_remove_file(dev, &sda_sf3_arrays_fan3[i].dev_attr);
1749 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++)
1750 device_remove_file(dev, &sda_sf3_arrays_fan4[i].dev_attr);
1751 for (i = 0; i < data->in_num; i++) {
1752 if ((i == 6) && data->in6_skip)
1753 continue;
1754 device_remove_file(dev, &sda_in_input[i].dev_attr);
1755 device_remove_file(dev, &sda_in_alarm[i].dev_attr);
1756 device_remove_file(dev, &sda_in_min[i].dev_attr);
1757 device_remove_file(dev, &sda_in_max[i].dev_attr);
1758 }
1759 for (i = 0; i < 5; i++) {
1760 device_remove_file(dev, &sda_fan_input[i].dev_attr);
1761 device_remove_file(dev, &sda_fan_alarm[i].dev_attr);
1762 device_remove_file(dev, &sda_fan_div[i].dev_attr);
1763 device_remove_file(dev, &sda_fan_min[i].dev_attr);
1764 }
1765 for (i = 0; i < data->pwm_num; i++) {
1766 device_remove_file(dev, &sda_pwm[i].dev_attr);
1767 device_remove_file(dev, &sda_pwm_mode[i].dev_attr);
1768 device_remove_file(dev, &sda_pwm_enable[i].dev_attr);
1769 device_remove_file(dev, &sda_target_temp[i].dev_attr);
1770 device_remove_file(dev, &sda_tolerance[i].dev_attr);
1771 }
1772 for (i = 0; i < NUM_REG_TEMP; i++) {
1773 if (!(data->have_temp & (1 << i)))
1774 continue;
1775 device_remove_file(dev, &sda_temp_input[i].dev_attr);
1776 device_remove_file(dev, &sda_temp_label[i].dev_attr);
1777 if (i == 2 && data->temp3_val_only)
1778 continue;
1779 device_remove_file(dev, &sda_temp_max[i].dev_attr);
1780 device_remove_file(dev, &sda_temp_max_hyst[i].dev_attr);
1781 if (i > 2)
1782 continue;
1783 device_remove_file(dev, &sda_temp_alarm[i].dev_attr);
1784 device_remove_file(dev, &sda_temp_type[i].dev_attr);
1785 }
1786
1787 device_remove_file(dev, &sda_caseopen[0].dev_attr);
1788 device_remove_file(dev, &sda_caseopen[1].dev_attr);
1789
1790 device_remove_file(dev, &dev_attr_name);
1791 device_remove_file(dev, &dev_attr_cpu0_vid);
1792 }
1793
1794 /* Get the monitoring functions started */
1795 static inline void __devinit w83627ehf_init_device(struct w83627ehf_data *data,
1796 enum kinds kind)
1797 {
1798 int i;
1799 u8 tmp, diode;
1800
1801 /* Start monitoring is needed */
1802 tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG);
1803 if (!(tmp & 0x01))
1804 w83627ehf_write_value(data, W83627EHF_REG_CONFIG,
1805 tmp | 0x01);
1806
1807 /* Enable temperature sensors if needed */
1808 for (i = 0; i < NUM_REG_TEMP; i++) {
1809 if (!(data->have_temp & (1 << i)))
1810 continue;
1811 if (!data->reg_temp_config[i])
1812 continue;
1813 tmp = w83627ehf_read_value(data,
1814 data->reg_temp_config[i]);
1815 if (tmp & 0x01)
1816 w83627ehf_write_value(data,
1817 data->reg_temp_config[i],
1818 tmp & 0xfe);
1819 }
1820
1821 /* Enable VBAT monitoring if needed */
1822 tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT);
1823 if (!(tmp & 0x01))
1824 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01);
1825
1826 /* Get thermal sensor types */
1827 switch (kind) {
1828 case w83627ehf:
1829 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE);
1830 break;
1831 case w83627uhg:
1832 diode = 0x00;
1833 break;
1834 default:
1835 diode = 0x70;
1836 }
1837 for (i = 0; i < 3; i++) {
1838 const char *label = NULL;
1839
1840 if (data->temp_label)
1841 label = data->temp_label[data->temp_src[i]];
1842
1843 /* Digital source overrides analog type */
1844 if (label && strncmp(label, "PECI", 4) == 0)
1845 data->temp_type[i] = 6;
1846 else if (label && strncmp(label, "AMD", 3) == 0)
1847 data->temp_type[i] = 5;
1848 else if ((tmp & (0x02 << i)))
1849 data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 3;
1850 else
1851 data->temp_type[i] = 4; /* thermistor */
1852 }
1853 }
1854
1855 static void w82627ehf_swap_tempreg(struct w83627ehf_data *data,
1856 int r1, int r2)
1857 {
1858 u16 tmp;
1859
1860 tmp = data->temp_src[r1];
1861 data->temp_src[r1] = data->temp_src[r2];
1862 data->temp_src[r2] = tmp;
1863
1864 tmp = data->reg_temp[r1];
1865 data->reg_temp[r1] = data->reg_temp[r2];
1866 data->reg_temp[r2] = tmp;
1867
1868 tmp = data->reg_temp_over[r1];
1869 data->reg_temp_over[r1] = data->reg_temp_over[r2];
1870 data->reg_temp_over[r2] = tmp;
1871
1872 tmp = data->reg_temp_hyst[r1];
1873 data->reg_temp_hyst[r1] = data->reg_temp_hyst[r2];
1874 data->reg_temp_hyst[r2] = tmp;
1875
1876 tmp = data->reg_temp_config[r1];
1877 data->reg_temp_config[r1] = data->reg_temp_config[r2];
1878 data->reg_temp_config[r2] = tmp;
1879 }
1880
1881 static void __devinit
1882 w83627ehf_set_temp_reg_ehf(struct w83627ehf_data *data, int n_temp)
1883 {
1884 int i;
1885
1886 for (i = 0; i < n_temp; i++) {
1887 data->reg_temp[i] = W83627EHF_REG_TEMP[i];
1888 data->reg_temp_over[i] = W83627EHF_REG_TEMP_OVER[i];
1889 data->reg_temp_hyst[i] = W83627EHF_REG_TEMP_HYST[i];
1890 data->reg_temp_config[i] = W83627EHF_REG_TEMP_CONFIG[i];
1891 }
1892 }
1893
1894 static void __devinit
1895 w83627ehf_check_fan_inputs(const struct w83627ehf_sio_data *sio_data,
1896 struct w83627ehf_data *data)
1897 {
1898 int fan3pin, fan4pin, fan4min, fan5pin, regval;
1899
1900 /* The W83627UHG is simple, only two fan inputs, no config */
1901 if (sio_data->kind == w83627uhg) {
1902 data->has_fan = 0x03; /* fan1 and fan2 */
1903 data->has_fan_min = 0x03;
1904 return;
1905 }
1906
1907 superio_enter(sio_data->sioreg);
1908
1909 /* fan4 and fan5 share some pins with the GPIO and serial flash */
1910 if (sio_data->kind == nct6775) {
1911 /* On NCT6775, fan4 shares pins with the fdc interface */
1912 fan3pin = 1;
1913 fan4pin = !(superio_inb(sio_data->sioreg, 0x2A) & 0x80);
1914 fan4min = 0;
1915 fan5pin = 0;
1916 } else if (sio_data->kind == nct6776) {
1917 fan3pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x40);
1918 fan4pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x01);
1919 fan5pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x02);
1920 fan4min = fan4pin;
1921 } else if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) {
1922 fan3pin = 1;
1923 fan4pin = superio_inb(sio_data->sioreg, 0x27) & 0x40;
1924 fan5pin = superio_inb(sio_data->sioreg, 0x27) & 0x20;
1925 fan4min = fan4pin;
1926 } else {
1927 fan3pin = 1;
1928 fan4pin = !(superio_inb(sio_data->sioreg, 0x29) & 0x06);
1929 fan5pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x02);
1930 fan4min = fan4pin;
1931 }
1932
1933 superio_exit(sio_data->sioreg);
1934
1935 data->has_fan = data->has_fan_min = 0x03; /* fan1 and fan2 */
1936 data->has_fan |= (fan3pin << 2);
1937 data->has_fan_min |= (fan3pin << 2);
1938
1939 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
1940 /*
1941 * NCT6775F and NCT6776F don't have the W83627EHF_REG_FANDIV1
1942 * register
1943 */
1944 data->has_fan |= (fan4pin << 3) | (fan5pin << 4);
1945 data->has_fan_min |= (fan4min << 3) | (fan5pin << 4);
1946 } else {
1947 /*
1948 * It looks like fan4 and fan5 pins can be alternatively used
1949 * as fan on/off switches, but fan5 control is write only :/
1950 * We assume that if the serial interface is disabled, designers
1951 * connected fan5 as input unless they are emitting log 1, which
1952 * is not the default.
1953 */
1954 regval = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1);
1955 if ((regval & (1 << 2)) && fan4pin) {
1956 data->has_fan |= (1 << 3);
1957 data->has_fan_min |= (1 << 3);
1958 }
1959 if (!(regval & (1 << 1)) && fan5pin) {
1960 data->has_fan |= (1 << 4);
1961 data->has_fan_min |= (1 << 4);
1962 }
1963 }
1964 }
1965
1966 static int __devinit w83627ehf_probe(struct platform_device *pdev)
1967 {
1968 struct device *dev = &pdev->dev;
1969 struct w83627ehf_sio_data *sio_data = dev->platform_data;
1970 struct w83627ehf_data *data;
1971 struct resource *res;
1972 u8 en_vrm10;
1973 int i, err = 0;
1974
1975 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
1976 if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) {
1977 err = -EBUSY;
1978 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n",
1979 (unsigned long)res->start,
1980 (unsigned long)res->start + IOREGION_LENGTH - 1);
1981 goto exit;
1982 }
1983
1984 data = kzalloc(sizeof(struct w83627ehf_data), GFP_KERNEL);
1985 if (!data) {
1986 err = -ENOMEM;
1987 goto exit_release;
1988 }
1989
1990 data->addr = res->start;
1991 mutex_init(&data->lock);
1992 mutex_init(&data->update_lock);
1993 data->name = w83627ehf_device_names[sio_data->kind];
1994 platform_set_drvdata(pdev, data);
1995
1996 /* 627EHG and 627EHF have 10 voltage inputs; 627DHG and 667HG have 9 */
1997 data->in_num = (sio_data->kind == w83627ehf) ? 10 : 9;
1998 /* 667HG, NCT6775F, and NCT6776F have 3 pwms, and 627UHG has only 2 */
1999 switch (sio_data->kind) {
2000 default:
2001 data->pwm_num = 4;
2002 break;
2003 case w83667hg:
2004 case w83667hg_b:
2005 case nct6775:
2006 case nct6776:
2007 data->pwm_num = 3;
2008 break;
2009 case w83627uhg:
2010 data->pwm_num = 2;
2011 break;
2012 }
2013
2014 /* Default to 3 temperature inputs, code below will adjust as needed */
2015 data->have_temp = 0x07;
2016
2017 /* Deal with temperature register setup first. */
2018 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) {
2019 int mask = 0;
2020
2021 /*
2022 * Display temperature sensor output only if it monitors
2023 * a source other than one already reported. Always display
2024 * first three temperature registers, though.
2025 */
2026 for (i = 0; i < NUM_REG_TEMP; i++) {
2027 u8 src;
2028
2029 data->reg_temp[i] = NCT6775_REG_TEMP[i];
2030 data->reg_temp_over[i] = NCT6775_REG_TEMP_OVER[i];
2031 data->reg_temp_hyst[i] = NCT6775_REG_TEMP_HYST[i];
2032 data->reg_temp_config[i] = NCT6775_REG_TEMP_CONFIG[i];
2033
2034 src = w83627ehf_read_value(data,
2035 NCT6775_REG_TEMP_SOURCE[i]);
2036 src &= 0x1f;
2037 if (src && !(mask & (1 << src))) {
2038 data->have_temp |= 1 << i;
2039 mask |= 1 << src;
2040 }
2041
2042 data->temp_src[i] = src;
2043
2044 /*
2045 * Now do some register swapping if index 0..2 don't
2046 * point to SYSTIN(1), CPUIN(2), and AUXIN(3).
2047 * Idea is to have the first three attributes
2048 * report SYSTIN, CPUIN, and AUXIN if possible
2049 * without overriding the basic system configuration.
2050 */
2051 if (i > 0 && data->temp_src[0] != 1
2052 && data->temp_src[i] == 1)
2053 w82627ehf_swap_tempreg(data, 0, i);
2054 if (i > 1 && data->temp_src[1] != 2
2055 && data->temp_src[i] == 2)
2056 w82627ehf_swap_tempreg(data, 1, i);
2057 if (i > 2 && data->temp_src[2] != 3
2058 && data->temp_src[i] == 3)
2059 w82627ehf_swap_tempreg(data, 2, i);
2060 }
2061 if (sio_data->kind == nct6776) {
2062 /*
2063 * On NCT6776, AUXTIN and VIN3 pins are shared.
2064 * Only way to detect it is to check if AUXTIN is used
2065 * as a temperature source, and if that source is
2066 * enabled.
2067 *
2068 * If that is the case, disable in6, which reports VIN3.
2069 * Otherwise disable temp3.
2070 */
2071 if (data->temp_src[2] == 3) {
2072 u8 reg;
2073
2074 if (data->reg_temp_config[2])
2075 reg = w83627ehf_read_value(data,
2076 data->reg_temp_config[2]);
2077 else
2078 reg = 0; /* Assume AUXTIN is used */
2079
2080 if (reg & 0x01)
2081 data->have_temp &= ~(1 << 2);
2082 else
2083 data->in6_skip = 1;
2084 }
2085 data->temp_label = nct6776_temp_label;
2086 } else {
2087 data->temp_label = nct6775_temp_label;
2088 }
2089 } else if (sio_data->kind == w83667hg_b) {
2090 u8 reg;
2091
2092 w83627ehf_set_temp_reg_ehf(data, 4);
2093
2094 /*
2095 * Temperature sources are selected with bank 0, registers 0x49
2096 * and 0x4a.
2097 */
2098 reg = w83627ehf_read_value(data, 0x4a);
2099 data->temp_src[0] = reg >> 5;
2100 reg = w83627ehf_read_value(data, 0x49);
2101 data->temp_src[1] = reg & 0x07;
2102 data->temp_src[2] = (reg >> 4) & 0x07;
2103
2104 /*
2105 * W83667HG-B has another temperature register at 0x7e.
2106 * The temperature source is selected with register 0x7d.
2107 * Support it if the source differs from already reported
2108 * sources.
2109 */
2110 reg = w83627ehf_read_value(data, 0x7d);
2111 reg &= 0x07;
2112 if (reg != data->temp_src[0] && reg != data->temp_src[1]
2113 && reg != data->temp_src[2]) {
2114 data->temp_src[3] = reg;
2115 data->have_temp |= 1 << 3;
2116 }
2117
2118 /*
2119 * Chip supports either AUXTIN or VIN3. Try to find out which
2120 * one.
2121 */
2122 reg = w83627ehf_read_value(data, W83627EHF_REG_TEMP_CONFIG[2]);
2123 if (data->temp_src[2] == 2 && (reg & 0x01))
2124 data->have_temp &= ~(1 << 2);
2125
2126 if ((data->temp_src[2] == 2 && (data->have_temp & (1 << 2)))
2127 || (data->temp_src[3] == 2 && (data->have_temp & (1 << 3))))
2128 data->in6_skip = 1;
2129
2130 data->temp_label = w83667hg_b_temp_label;
2131 } else if (sio_data->kind == w83627uhg) {
2132 u8 reg;
2133
2134 w83627ehf_set_temp_reg_ehf(data, 3);
2135
2136 /*
2137 * Temperature sources for temp1 and temp2 are selected with
2138 * bank 0, registers 0x49 and 0x4a.
2139 */
2140 data->temp_src[0] = 0; /* SYSTIN */
2141 reg = w83627ehf_read_value(data, 0x49) & 0x07;
2142 /* Adjust to have the same mapping as other source registers */
2143 if (reg == 0)
2144 data->temp_src[1]++;
2145 else if (reg >= 2 && reg <= 5)
2146 data->temp_src[1] += 2;
2147 else /* should never happen */
2148 data->have_temp &= ~(1 << 1);
2149 reg = w83627ehf_read_value(data, 0x4a);
2150 data->temp_src[2] = reg >> 5;
2151
2152 /*
2153 * Skip temp3 if source is invalid or the same as temp1
2154 * or temp2.
2155 */
2156 if (data->temp_src[2] == 2 || data->temp_src[2] == 3 ||
2157 data->temp_src[2] == data->temp_src[0] ||
2158 ((data->have_temp & (1 << 1)) &&
2159 data->temp_src[2] == data->temp_src[1]))
2160 data->have_temp &= ~(1 << 2);
2161 else
2162 data->temp3_val_only = 1; /* No limit regs */
2163
2164 data->in6_skip = 1; /* No VIN3 */
2165
2166 data->temp_label = w83667hg_b_temp_label;
2167 } else {
2168 w83627ehf_set_temp_reg_ehf(data, 3);
2169
2170 /* Temperature sources are fixed */
2171
2172 if (sio_data->kind == w83667hg) {
2173 u8 reg;
2174
2175 /*
2176 * Chip supports either AUXTIN or VIN3. Try to find
2177 * out which one.
2178 */
2179 reg = w83627ehf_read_value(data,
2180 W83627EHF_REG_TEMP_CONFIG[2]);
2181 if (reg & 0x01)
2182 data->have_temp &= ~(1 << 2);
2183 else
2184 data->in6_skip = 1;
2185 }
2186 }
2187
2188 if (sio_data->kind == nct6775) {
2189 data->has_fan_div = true;
2190 data->fan_from_reg = fan_from_reg16;
2191 data->fan_from_reg_min = fan_from_reg8;
2192 data->REG_PWM = NCT6775_REG_PWM;
2193 data->REG_TARGET = NCT6775_REG_TARGET;
2194 data->REG_FAN = NCT6775_REG_FAN;
2195 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2196 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2197 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2198 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2199 data->REG_FAN_MAX_OUTPUT = NCT6775_REG_FAN_MAX_OUTPUT;
2200 data->REG_FAN_STEP_OUTPUT = NCT6775_REG_FAN_STEP_OUTPUT;
2201 } else if (sio_data->kind == nct6776) {
2202 data->has_fan_div = false;
2203 data->fan_from_reg = fan_from_reg13;
2204 data->fan_from_reg_min = fan_from_reg13;
2205 data->REG_PWM = NCT6775_REG_PWM;
2206 data->REG_TARGET = NCT6775_REG_TARGET;
2207 data->REG_FAN = NCT6775_REG_FAN;
2208 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
2209 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT;
2210 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT;
2211 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME;
2212 } else if (sio_data->kind == w83667hg_b) {
2213 data->has_fan_div = true;
2214 data->fan_from_reg = fan_from_reg8;
2215 data->fan_from_reg_min = fan_from_reg8;
2216 data->REG_PWM = W83627EHF_REG_PWM;
2217 data->REG_TARGET = W83627EHF_REG_TARGET;
2218 data->REG_FAN = W83627EHF_REG_FAN;
2219 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2220 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2221 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2222 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
2223 data->REG_FAN_MAX_OUTPUT =
2224 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B;
2225 data->REG_FAN_STEP_OUTPUT =
2226 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B;
2227 } else {
2228 data->has_fan_div = true;
2229 data->fan_from_reg = fan_from_reg8;
2230 data->fan_from_reg_min = fan_from_reg8;
2231 data->REG_PWM = W83627EHF_REG_PWM;
2232 data->REG_TARGET = W83627EHF_REG_TARGET;
2233 data->REG_FAN = W83627EHF_REG_FAN;
2234 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN;
2235 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT;
2236 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT;
2237 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME;
2238 data->REG_FAN_MAX_OUTPUT =
2239 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON;
2240 data->REG_FAN_STEP_OUTPUT =
2241 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON;
2242 }
2243
2244 /* Setup input voltage scaling factors */
2245 if (sio_data->kind == w83627uhg)
2246 data->scale_in = scale_in_w83627uhg;
2247 else
2248 data->scale_in = scale_in_common;
2249
2250 /* Initialize the chip */
2251 w83627ehf_init_device(data, sio_data->kind);
2252
2253 data->vrm = vid_which_vrm();
2254 superio_enter(sio_data->sioreg);
2255 /* Read VID value */
2256 if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b ||
2257 sio_data->kind == nct6775 || sio_data->kind == nct6776) {
2258 /* W83667HG has different pins for VID input and output, so
2259 we can get the VID input values directly at logical device D
2260 0xe3. */
2261 superio_select(sio_data->sioreg, W83667HG_LD_VID);
2262 data->vid = superio_inb(sio_data->sioreg, 0xe3);
2263 err = device_create_file(dev, &dev_attr_cpu0_vid);
2264 if (err)
2265 goto exit_release;
2266 } else if (sio_data->kind != w83627uhg) {
2267 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2268 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) {
2269 /* Set VID input sensibility if needed. In theory the
2270 BIOS should have set it, but in practice it's not
2271 always the case. We only do it for the W83627EHF/EHG
2272 because the W83627DHG is more complex in this
2273 respect. */
2274 if (sio_data->kind == w83627ehf) {
2275 en_vrm10 = superio_inb(sio_data->sioreg,
2276 SIO_REG_EN_VRM10);
2277 if ((en_vrm10 & 0x08) && data->vrm == 90) {
2278 dev_warn(dev, "Setting VID input "
2279 "voltage to TTL\n");
2280 superio_outb(sio_data->sioreg,
2281 SIO_REG_EN_VRM10,
2282 en_vrm10 & ~0x08);
2283 } else if (!(en_vrm10 & 0x08)
2284 && data->vrm == 100) {
2285 dev_warn(dev, "Setting VID input "
2286 "voltage to VRM10\n");
2287 superio_outb(sio_data->sioreg,
2288 SIO_REG_EN_VRM10,
2289 en_vrm10 | 0x08);
2290 }
2291 }
2292
2293 data->vid = superio_inb(sio_data->sioreg,
2294 SIO_REG_VID_DATA);
2295 if (sio_data->kind == w83627ehf) /* 6 VID pins only */
2296 data->vid &= 0x3f;
2297
2298 err = device_create_file(dev, &dev_attr_cpu0_vid);
2299 if (err)
2300 goto exit_release;
2301 } else {
2302 dev_info(dev, "VID pins in output mode, CPU VID not "
2303 "available\n");
2304 }
2305 }
2306
2307 if (fan_debounce &&
2308 (sio_data->kind == nct6775 || sio_data->kind == nct6776)) {
2309 u8 tmp;
2310
2311 superio_select(sio_data->sioreg, W83627EHF_LD_HWM);
2312 tmp = superio_inb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE);
2313 if (sio_data->kind == nct6776)
2314 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2315 0x3e | tmp);
2316 else
2317 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE,
2318 0x1e | tmp);
2319 pr_info("Enabled fan debounce for chip %s\n", data->name);
2320 }
2321
2322 superio_exit(sio_data->sioreg);
2323
2324 w83627ehf_check_fan_inputs(sio_data, data);
2325
2326 /* Read fan clock dividers immediately */
2327 w83627ehf_update_fan_div_common(dev, data);
2328
2329 /* Read pwm data to save original values */
2330 w83627ehf_update_pwm_common(dev, data);
2331 for (i = 0; i < data->pwm_num; i++)
2332 data->pwm_enable_orig[i] = data->pwm_enable[i];
2333
2334 /* Read pwm data to save original values */
2335 w83627ehf_update_pwm_common(dev, data);
2336 for (i = 0; i < data->pwm_num; i++)
2337 data->pwm_enable_orig[i] = data->pwm_enable[i];
2338
2339 /* Register sysfs hooks */
2340 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays); i++) {
2341 err = device_create_file(dev, &sda_sf3_arrays[i].dev_attr);
2342 if (err)
2343 goto exit_remove;
2344 }
2345
2346 for (i = 0; i < ARRAY_SIZE(sda_sf3_max_step_arrays); i++) {
2347 struct sensor_device_attribute *attr =
2348 &sda_sf3_max_step_arrays[i];
2349 if (data->REG_FAN_STEP_OUTPUT &&
2350 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff) {
2351 err = device_create_file(dev, &attr->dev_attr);
2352 if (err)
2353 goto exit_remove;
2354 }
2355 }
2356 /* if fan3 and fan4 are enabled create the sf3 files for them */
2357 if ((data->has_fan & (1 << 2)) && data->pwm_num >= 3)
2358 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan3); i++) {
2359 err = device_create_file(dev,
2360 &sda_sf3_arrays_fan3[i].dev_attr);
2361 if (err)
2362 goto exit_remove;
2363 }
2364 if ((data->has_fan & (1 << 3)) && data->pwm_num >= 4)
2365 for (i = 0; i < ARRAY_SIZE(sda_sf3_arrays_fan4); i++) {
2366 err = device_create_file(dev,
2367 &sda_sf3_arrays_fan4[i].dev_attr);
2368 if (err)
2369 goto exit_remove;
2370 }
2371
2372 for (i = 0; i < data->in_num; i++) {
2373 if ((i == 6) && data->in6_skip)
2374 continue;
2375 if ((err = device_create_file(dev, &sda_in_input[i].dev_attr))
2376 || (err = device_create_file(dev,
2377 &sda_in_alarm[i].dev_attr))
2378 || (err = device_create_file(dev,
2379 &sda_in_min[i].dev_attr))
2380 || (err = device_create_file(dev,
2381 &sda_in_max[i].dev_attr)))
2382 goto exit_remove;
2383 }
2384
2385 for (i = 0; i < 5; i++) {
2386 if (data->has_fan & (1 << i)) {
2387 if ((err = device_create_file(dev,
2388 &sda_fan_input[i].dev_attr))
2389 || (err = device_create_file(dev,
2390 &sda_fan_alarm[i].dev_attr)))
2391 goto exit_remove;
2392 if (sio_data->kind != nct6776) {
2393 err = device_create_file(dev,
2394 &sda_fan_div[i].dev_attr);
2395 if (err)
2396 goto exit_remove;
2397 }
2398 if (data->has_fan_min & (1 << i)) {
2399 err = device_create_file(dev,
2400 &sda_fan_min[i].dev_attr);
2401 if (err)
2402 goto exit_remove;
2403 }
2404 if (i < data->pwm_num &&
2405 ((err = device_create_file(dev,
2406 &sda_pwm[i].dev_attr))
2407 || (err = device_create_file(dev,
2408 &sda_pwm_mode[i].dev_attr))
2409 || (err = device_create_file(dev,
2410 &sda_pwm_enable[i].dev_attr))
2411 || (err = device_create_file(dev,
2412 &sda_target_temp[i].dev_attr))
2413 || (err = device_create_file(dev,
2414 &sda_tolerance[i].dev_attr))))
2415 goto exit_remove;
2416 }
2417 }
2418
2419 for (i = 0; i < NUM_REG_TEMP; i++) {
2420 if (!(data->have_temp & (1 << i)))
2421 continue;
2422 err = device_create_file(dev, &sda_temp_input[i].dev_attr);
2423 if (err)
2424 goto exit_remove;
2425 if (data->temp_label) {
2426 err = device_create_file(dev,
2427 &sda_temp_label[i].dev_attr);
2428 if (err)
2429 goto exit_remove;
2430 }
2431 if (i == 2 && data->temp3_val_only)
2432 continue;
2433 if (data->reg_temp_over[i]) {
2434 err = device_create_file(dev,
2435 &sda_temp_max[i].dev_attr);
2436 if (err)
2437 goto exit_remove;
2438 }
2439 if (data->reg_temp_hyst[i]) {
2440 err = device_create_file(dev,
2441 &sda_temp_max_hyst[i].dev_attr);
2442 if (err)
2443 goto exit_remove;
2444 }
2445 if (i > 2)
2446 continue;
2447 if ((err = device_create_file(dev,
2448 &sda_temp_alarm[i].dev_attr))
2449 || (err = device_create_file(dev,
2450 &sda_temp_type[i].dev_attr)))
2451 goto exit_remove;
2452 }
2453
2454 err = device_create_file(dev, &sda_caseopen[0].dev_attr);
2455 if (err)
2456 goto exit_remove;
2457
2458 if (sio_data->kind == nct6776) {
2459 err = device_create_file(dev, &sda_caseopen[1].dev_attr);
2460 if (err)
2461 goto exit_remove;
2462 }
2463
2464 err = device_create_file(dev, &dev_attr_name);
2465 if (err)
2466 goto exit_remove;
2467
2468 data->hwmon_dev = hwmon_device_register(dev);
2469 if (IS_ERR(data->hwmon_dev)) {
2470 err = PTR_ERR(data->hwmon_dev);
2471 goto exit_remove;
2472 }
2473
2474 return 0;
2475
2476 exit_remove:
2477 w83627ehf_device_remove_files(dev);
2478 kfree(data);
2479 platform_set_drvdata(pdev, NULL);
2480 exit_release:
2481 release_region(res->start, IOREGION_LENGTH);
2482 exit:
2483 return err;
2484 }
2485
2486 static int __devexit w83627ehf_remove(struct platform_device *pdev)
2487 {
2488 struct w83627ehf_data *data = platform_get_drvdata(pdev);
2489
2490 hwmon_device_unregister(data->hwmon_dev);
2491 w83627ehf_device_remove_files(&pdev->dev);
2492 release_region(data->addr, IOREGION_LENGTH);
2493 platform_set_drvdata(pdev, NULL);
2494 kfree(data);
2495
2496 return 0;
2497 }
2498
2499 static struct platform_driver w83627ehf_driver = {
2500 .driver = {
2501 .owner = THIS_MODULE,
2502 .name = DRVNAME,
2503 },
2504 .probe = w83627ehf_probe,
2505 .remove = __devexit_p(w83627ehf_remove),
2506 };
2507
2508 /* w83627ehf_find() looks for a '627 in the Super-I/O config space */
2509 static int __init w83627ehf_find(int sioaddr, unsigned short *addr,
2510 struct w83627ehf_sio_data *sio_data)
2511 {
2512 static const char __initdata sio_name_W83627EHF[] = "W83627EHF";
2513 static const char __initdata sio_name_W83627EHG[] = "W83627EHG";
2514 static const char __initdata sio_name_W83627DHG[] = "W83627DHG";
2515 static const char __initdata sio_name_W83627DHG_P[] = "W83627DHG-P";
2516 static const char __initdata sio_name_W83627UHG[] = "W83627UHG";
2517 static const char __initdata sio_name_W83667HG[] = "W83667HG";
2518 static const char __initdata sio_name_W83667HG_B[] = "W83667HG-B";
2519 static const char __initdata sio_name_NCT6775[] = "NCT6775F";
2520 static const char __initdata sio_name_NCT6776[] = "NCT6776F";
2521
2522 u16 val;
2523 const char *sio_name;
2524
2525 superio_enter(sioaddr);
2526
2527 if (force_id)
2528 val = force_id;
2529 else
2530 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8)
2531 | superio_inb(sioaddr, SIO_REG_DEVID + 1);
2532 switch (val & SIO_ID_MASK) {
2533 case SIO_W83627EHF_ID:
2534 sio_data->kind = w83627ehf;
2535 sio_name = sio_name_W83627EHF;
2536 break;
2537 case SIO_W83627EHG_ID:
2538 sio_data->kind = w83627ehf;
2539 sio_name = sio_name_W83627EHG;
2540 break;
2541 case SIO_W83627DHG_ID:
2542 sio_data->kind = w83627dhg;
2543 sio_name = sio_name_W83627DHG;
2544 break;
2545 case SIO_W83627DHG_P_ID:
2546 sio_data->kind = w83627dhg_p;
2547 sio_name = sio_name_W83627DHG_P;
2548 break;
2549 case SIO_W83627UHG_ID:
2550 sio_data->kind = w83627uhg;
2551 sio_name = sio_name_W83627UHG;
2552 break;
2553 case SIO_W83667HG_ID:
2554 sio_data->kind = w83667hg;
2555 sio_name = sio_name_W83667HG;
2556 break;
2557 case SIO_W83667HG_B_ID:
2558 sio_data->kind = w83667hg_b;
2559 sio_name = sio_name_W83667HG_B;
2560 break;
2561 case SIO_NCT6775_ID:
2562 sio_data->kind = nct6775;
2563 sio_name = sio_name_NCT6775;
2564 break;
2565 case SIO_NCT6776_ID:
2566 sio_data->kind = nct6776;
2567 sio_name = sio_name_NCT6776;
2568 break;
2569 default:
2570 if (val != 0xffff)
2571 pr_debug("unsupported chip ID: 0x%04x\n", val);
2572 superio_exit(sioaddr);
2573 return -ENODEV;
2574 }
2575
2576 /* We have a known chip, find the HWM I/O address */
2577 superio_select(sioaddr, W83627EHF_LD_HWM);
2578 val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
2579 | superio_inb(sioaddr, SIO_REG_ADDR + 1);
2580 *addr = val & IOREGION_ALIGNMENT;
2581 if (*addr == 0) {
2582 pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n");
2583 superio_exit(sioaddr);
2584 return -ENODEV;
2585 }
2586
2587 /* Activate logical device if needed */
2588 val = superio_inb(sioaddr, SIO_REG_ENABLE);
2589 if (!(val & 0x01)) {
2590 pr_warn("Forcibly enabling Super-I/O. "
2591 "Sensor is probably unusable.\n");
2592 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
2593 }
2594
2595 superio_exit(sioaddr);
2596 pr_info("Found %s chip at %#x\n", sio_name, *addr);
2597 sio_data->sioreg = sioaddr;
2598
2599 return 0;
2600 }
2601
2602 /* when Super-I/O functions move to a separate file, the Super-I/O
2603 * bus will manage the lifetime of the device and this module will only keep
2604 * track of the w83627ehf driver. But since we platform_device_alloc(), we
2605 * must keep track of the device */
2606 static struct platform_device *pdev;
2607
2608 static int __init sensors_w83627ehf_init(void)
2609 {
2610 int err;
2611 unsigned short address;
2612 struct resource res;
2613 struct w83627ehf_sio_data sio_data;
2614
2615 /* initialize sio_data->kind and sio_data->sioreg.
2616 *
2617 * when Super-I/O functions move to a separate file, the Super-I/O
2618 * driver will probe 0x2e and 0x4e and auto-detect the presence of a
2619 * w83627ehf hardware monitor, and call probe() */
2620 if (w83627ehf_find(0x2e, &address, &sio_data) &&
2621 w83627ehf_find(0x4e, &address, &sio_data))
2622 return -ENODEV;
2623
2624 err = platform_driver_register(&w83627ehf_driver);
2625 if (err)
2626 goto exit;
2627
2628 pdev = platform_device_alloc(DRVNAME, address);
2629 if (!pdev) {
2630 err = -ENOMEM;
2631 pr_err("Device allocation failed\n");
2632 goto exit_unregister;
2633 }
2634
2635 err = platform_device_add_data(pdev, &sio_data,
2636 sizeof(struct w83627ehf_sio_data));
2637 if (err) {
2638 pr_err("Platform data allocation failed\n");
2639 goto exit_device_put;
2640 }
2641
2642 memset(&res, 0, sizeof(res));
2643 res.name = DRVNAME;
2644 res.start = address + IOREGION_OFFSET;
2645 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
2646 res.flags = IORESOURCE_IO;
2647
2648 err = acpi_check_resource_conflict(&res);
2649 if (err)
2650 goto exit_device_put;
2651
2652 err = platform_device_add_resources(pdev, &res, 1);
2653 if (err) {
2654 pr_err("Device resource addition failed (%d)\n", err);
2655 goto exit_device_put;
2656 }
2657
2658 /* platform_device_add calls probe() */
2659 err = platform_device_add(pdev);
2660 if (err) {
2661 pr_err("Device addition failed (%d)\n", err);
2662 goto exit_device_put;
2663 }
2664
2665 return 0;
2666
2667 exit_device_put:
2668 platform_device_put(pdev);
2669 exit_unregister:
2670 platform_driver_unregister(&w83627ehf_driver);
2671 exit:
2672 return err;
2673 }
2674
2675 static void __exit sensors_w83627ehf_exit(void)
2676 {
2677 platform_device_unregister(pdev);
2678 platform_driver_unregister(&w83627ehf_driver);
2679 }
2680
2681 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
2682 MODULE_DESCRIPTION("W83627EHF driver");
2683 MODULE_LICENSE("GPL");
2684
2685 module_init(sensors_w83627ehf_init);
2686 module_exit(sensors_w83627ehf_exit);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree