1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * nct6775 - Driver for the hardware monitoring functionality of
4 * Nuvoton NCT677x Super-I/O chips
5 *
6 * Copyright (C) 2012 Guenter Roeck <linux@roeck-us.net>
7 *
8 * Derived from w83627ehf driver
9 * Copyright (C) 2005-2012 Jean Delvare <jdelvare@suse.de>
10 * Copyright (C) 2006 Yuan Mu (Winbond),
11 * Rudolf Marek <r.marek@assembler.cz>
12 * David Hubbard <david.c.hubbard@gmail.com>
13 * Daniel J Blueman <daniel.blueman@gmail.com>
14 * Copyright (C) 2010 Sheng-Yuan Huang (Nuvoton) (PS00)
15 *
16 * Shamelessly ripped from the w83627hf driver
17 * Copyright (C) 2003 Mark Studebaker
18 *
19 * Supports the following chips:
20 *
21 * Chip #vin #fan #pwm #temp chip IDs man ID
22 * nct6106d 9 3 3 6+3 0xc450 0xc1 0x5ca3
23 * nct6116d 9 5 5 3+3 0xd280 0xc1 0x5ca3
24 * nct6775f 9 4 3 6+3 0xb470 0xc1 0x5ca3
25 * nct6776f 9 5 3 6+3 0xc330 0xc1 0x5ca3
26 * nct6779d 15 5 5 2+6 0xc560 0xc1 0x5ca3
27 * nct6791d 15 6 6 2+6 0xc800 0xc1 0x5ca3
28 * nct6792d 15 6 6 2+6 0xc910 0xc1 0x5ca3
29 * nct6793d 15 6 6 2+6 0xd120 0xc1 0x5ca3
30 * nct6795d 14 6 6 2+6 0xd350 0xc1 0x5ca3
31 * nct6796d 14 7 7 2+6 0xd420 0xc1 0x5ca3
32 * nct6797d 14 7 7 2+6 0xd450 0xc1 0x5ca3
33 * (0xd451)
34 * nct6798d 14 7 7 2+6 0xd428 0xc1 0x5ca3
35 * (0xd429)
36 *
37 * #temp lists the number of monitored temperature sources (first value) plus
38 * the number of directly connectable temperature sensors (second value).
39 */
40
41 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
42
43 #include <linux/module.h>
44 #include <linux/init.h>
45 #include <linux/slab.h>
46 #include <linux/jiffies.h>
47 #include <linux/platform_device.h>
48 #include <linux/hwmon.h>
49 #include <linux/hwmon-sysfs.h>
50 #include <linux/hwmon-vid.h>
51 #include <linux/err.h>
52 #include <linux/mutex.h>
53 #include <linux/acpi.h>
54 #include <linux/bitops.h>
55 #include <linux/dmi.h>
56 #include <linux/io.h>
57 #include <linux/nospec.h>
58 #include "lm75.h"
59
60 #define USE_ALTERNATE
61
62 enum kinds { nct6106, nct6116, nct6775, nct6776, nct6779, nct6791, nct6792,
63 nct6793, nct6795, nct6796, nct6797, nct6798 };
64
65 /* used to set data->name = nct6775_device_names[data->sio_kind] */
66 static const char * const nct6775_device_names[] = {
67 "nct6106",
68 "nct6116",
69 "nct6775",
70 "nct6776",
71 "nct6779",
72 "nct6791",
73 "nct6792",
74 "nct6793",
75 "nct6795",
76 "nct6796",
77 "nct6797",
78 "nct6798",
79 };
80
81 static const char * const nct6775_sio_names[] __initconst = {
82 "NCT6106D",
83 "NCT6116D",
84 "NCT6775F",
85 "NCT6776D/F",
86 "NCT6779D",
87 "NCT6791D",
88 "NCT6792D",
89 "NCT6793D",
90 "NCT6795D",
91 "NCT6796D",
92 "NCT6797D",
93 "NCT6798D",
94 };
95
96 static unsigned short force_id;
97 module_param(force_id, ushort, 0);
98 MODULE_PARM_DESC(force_id, "Override the detected device ID");
99
100 static unsigned short fan_debounce;
101 module_param(fan_debounce, ushort, 0);
102 MODULE_PARM_DESC(fan_debounce, "Enable debouncing for fan RPM signal");
103
104 #define DRVNAME "nct6775"
105
106 /*
107 * Super-I/O constants and functions
108 */
109
110 #define NCT6775_LD_ACPI 0x0a
111 #define NCT6775_LD_HWM 0x0b
112 #define NCT6775_LD_VID 0x0d
113 #define NCT6775_LD_12 0x12
114
115 #define SIO_REG_LDSEL 0x07 /* Logical device select */
116 #define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */
117 #define SIO_REG_ENABLE 0x30 /* Logical device enable */
118 #define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
119
120 #define SIO_NCT6106_ID 0xc450
121 #define SIO_NCT6116_ID 0xd280
122 #define SIO_NCT6775_ID 0xb470
123 #define SIO_NCT6776_ID 0xc330
124 #define SIO_NCT6779_ID 0xc560
125 #define SIO_NCT6791_ID 0xc800
126 #define SIO_NCT6792_ID 0xc910
127 #define SIO_NCT6793_ID 0xd120
128 #define SIO_NCT6795_ID 0xd350
129 #define SIO_NCT6796_ID 0xd420
130 #define SIO_NCT6797_ID 0xd450
131 #define SIO_NCT6798_ID 0xd428
132 #define SIO_ID_MASK 0xFFF8
133
134 enum pwm_enable { off, manual, thermal_cruise, speed_cruise, sf3, sf4 };
135
136 static inline void
superio_outb(int ioreg,int reg,int val)137 superio_outb(int ioreg, int reg, int val)
138 {
139 outb(reg, ioreg);
140 outb(val, ioreg + 1);
141 }
142
143 static inline int
superio_inb(int ioreg,int reg)144 superio_inb(int ioreg, int reg)
145 {
146 outb(reg, ioreg);
147 return inb(ioreg + 1);
148 }
149
150 static inline void
superio_select(int ioreg,int ld)151 superio_select(int ioreg, int ld)
152 {
153 outb(SIO_REG_LDSEL, ioreg);
154 outb(ld, ioreg + 1);
155 }
156
157 static inline int
superio_enter(int ioreg)158 superio_enter(int ioreg)
159 {
160 /*
161 * Try to reserve <ioreg> and <ioreg + 1> for exclusive access.
162 */
163 if (!request_muxed_region(ioreg, 2, DRVNAME))
164 return -EBUSY;
165
166 outb(0x87, ioreg);
167 outb(0x87, ioreg);
168
169 return 0;
170 }
171
172 static inline void
superio_exit(int ioreg)173 superio_exit(int ioreg)
174 {
175 outb(0xaa, ioreg);
176 outb(0x02, ioreg);
177 outb(0x02, ioreg + 1);
178 release_region(ioreg, 2);
179 }
180
181 /*
182 * ISA constants
183 */
184
185 #define IOREGION_ALIGNMENT (~7)
186 #define IOREGION_OFFSET 5
187 #define IOREGION_LENGTH 2
188 #define ADDR_REG_OFFSET 0
189 #define DATA_REG_OFFSET 1
190
191 #define NCT6775_REG_BANK 0x4E
192 #define NCT6775_REG_CONFIG 0x40
193
194 /*
195 * Not currently used:
196 * REG_MAN_ID has the value 0x5ca3 for all supported chips.
197 * REG_CHIP_ID == 0x88/0xa1/0xc1 depending on chip model.
198 * REG_MAN_ID is at port 0x4f
199 * REG_CHIP_ID is at port 0x58
200 */
201
202 #define NUM_TEMP 10 /* Max number of temp attribute sets w/ limits*/
203 #define NUM_TEMP_FIXED 6 /* Max number of fixed temp attribute sets */
204
205 #define NUM_REG_ALARM 7 /* Max number of alarm registers */
206 #define NUM_REG_BEEP 5 /* Max number of beep registers */
207
208 #define NUM_FAN 7
209
210 /* Common and NCT6775 specific data */
211
212 /* Voltage min/max registers for nr=7..14 are in bank 5 */
213
214 static const u16 NCT6775_REG_IN_MAX[] = {
215 0x2b, 0x2d, 0x2f, 0x31, 0x33, 0x35, 0x37, 0x554, 0x556, 0x558, 0x55a,
216 0x55c, 0x55e, 0x560, 0x562 };
217 static const u16 NCT6775_REG_IN_MIN[] = {
218 0x2c, 0x2e, 0x30, 0x32, 0x34, 0x36, 0x38, 0x555, 0x557, 0x559, 0x55b,
219 0x55d, 0x55f, 0x561, 0x563 };
220 static const u16 NCT6775_REG_IN[] = {
221 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x550, 0x551, 0x552
222 };
223
224 #define NCT6775_REG_VBAT 0x5D
225 #define NCT6775_REG_DIODE 0x5E
226 #define NCT6775_DIODE_MASK 0x02
227
228 #define NCT6775_REG_FANDIV1 0x506
229 #define NCT6775_REG_FANDIV2 0x507
230
231 #define NCT6775_REG_CR_FAN_DEBOUNCE 0xf0
232
233 static const u16 NCT6775_REG_ALARM[NUM_REG_ALARM] = { 0x459, 0x45A, 0x45B };
234
235 /* 0..15 voltages, 16..23 fans, 24..29 temperatures, 30..31 intrusion */
236
237 static const s8 NCT6775_ALARM_BITS[] = {
238 0, 1, 2, 3, 8, 21, 20, 16, /* in0.. in7 */
239 17, -1, -1, -1, -1, -1, -1, /* in8..in14 */
240 -1, /* unused */
241 6, 7, 11, -1, -1, /* fan1..fan5 */
242 -1, -1, -1, /* unused */
243 4, 5, 13, -1, -1, -1, /* temp1..temp6 */
244 12, -1 }; /* intrusion0, intrusion1 */
245
246 #define FAN_ALARM_BASE 16
247 #define TEMP_ALARM_BASE 24
248 #define INTRUSION_ALARM_BASE 30
249
250 static const u16 NCT6775_REG_BEEP[NUM_REG_BEEP] = { 0x56, 0x57, 0x453, 0x4e };
251
252 /*
253 * 0..14 voltages, 15 global beep enable, 16..23 fans, 24..29 temperatures,
254 * 30..31 intrusion
255 */
256 static const s8 NCT6775_BEEP_BITS[] = {
257 0, 1, 2, 3, 8, 9, 10, 16, /* in0.. in7 */
258 17, -1, -1, -1, -1, -1, -1, /* in8..in14 */
259 21, /* global beep enable */
260 6, 7, 11, 28, -1, /* fan1..fan5 */
261 -1, -1, -1, /* unused */
262 4, 5, 13, -1, -1, -1, /* temp1..temp6 */
263 12, -1 }; /* intrusion0, intrusion1 */
264
265 #define BEEP_ENABLE_BASE 15
266
267 static const u8 NCT6775_REG_CR_CASEOPEN_CLR[] = { 0xe6, 0xee };
268 static const u8 NCT6775_CR_CASEOPEN_CLR_MASK[] = { 0x20, 0x01 };
269
270 /* DC or PWM output fan configuration */
271 static const u8 NCT6775_REG_PWM_MODE[] = { 0x04, 0x04, 0x12 };
272 static const u8 NCT6775_PWM_MODE_MASK[] = { 0x01, 0x02, 0x01 };
273
274 /* Advanced Fan control, some values are common for all fans */
275
276 static const u16 NCT6775_REG_TARGET[] = {
277 0x101, 0x201, 0x301, 0x801, 0x901, 0xa01, 0xb01 };
278 static const u16 NCT6775_REG_FAN_MODE[] = {
279 0x102, 0x202, 0x302, 0x802, 0x902, 0xa02, 0xb02 };
280 static const u16 NCT6775_REG_FAN_STEP_DOWN_TIME[] = {
281 0x103, 0x203, 0x303, 0x803, 0x903, 0xa03, 0xb03 };
282 static const u16 NCT6775_REG_FAN_STEP_UP_TIME[] = {
283 0x104, 0x204, 0x304, 0x804, 0x904, 0xa04, 0xb04 };
284 static const u16 NCT6775_REG_FAN_STOP_OUTPUT[] = {
285 0x105, 0x205, 0x305, 0x805, 0x905, 0xa05, 0xb05 };
286 static const u16 NCT6775_REG_FAN_START_OUTPUT[] = {
287 0x106, 0x206, 0x306, 0x806, 0x906, 0xa06, 0xb06 };
288 static const u16 NCT6775_REG_FAN_MAX_OUTPUT[] = { 0x10a, 0x20a, 0x30a };
289 static const u16 NCT6775_REG_FAN_STEP_OUTPUT[] = { 0x10b, 0x20b, 0x30b };
290
291 static const u16 NCT6775_REG_FAN_STOP_TIME[] = {
292 0x107, 0x207, 0x307, 0x807, 0x907, 0xa07, 0xb07 };
293 static const u16 NCT6775_REG_PWM[] = {
294 0x109, 0x209, 0x309, 0x809, 0x909, 0xa09, 0xb09 };
295 static const u16 NCT6775_REG_PWM_READ[] = {
296 0x01, 0x03, 0x11, 0x13, 0x15, 0xa09, 0xb09 };
297
298 static const u16 NCT6775_REG_FAN[] = { 0x630, 0x632, 0x634, 0x636, 0x638 };
299 static const u16 NCT6775_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d };
300 static const u16 NCT6775_REG_FAN_PULSES[NUM_FAN] = {
301 0x641, 0x642, 0x643, 0x644 };
302 static const u16 NCT6775_FAN_PULSE_SHIFT[NUM_FAN] = { };
303
304 static const u16 NCT6775_REG_TEMP[] = {
305 0x27, 0x150, 0x250, 0x62b, 0x62c, 0x62d };
306
307 static const u16 NCT6775_REG_TEMP_MON[] = { 0x73, 0x75, 0x77 };
308
309 static const u16 NCT6775_REG_TEMP_CONFIG[ARRAY_SIZE(NCT6775_REG_TEMP)] = {
310 0, 0x152, 0x252, 0x628, 0x629, 0x62A };
311 static const u16 NCT6775_REG_TEMP_HYST[ARRAY_SIZE(NCT6775_REG_TEMP)] = {
312 0x3a, 0x153, 0x253, 0x673, 0x678, 0x67D };
313 static const u16 NCT6775_REG_TEMP_OVER[ARRAY_SIZE(NCT6775_REG_TEMP)] = {
314 0x39, 0x155, 0x255, 0x672, 0x677, 0x67C };
315
316 static const u16 NCT6775_REG_TEMP_SOURCE[ARRAY_SIZE(NCT6775_REG_TEMP)] = {
317 0x621, 0x622, 0x623, 0x624, 0x625, 0x626 };
318
319 static const u16 NCT6775_REG_TEMP_SEL[] = {
320 0x100, 0x200, 0x300, 0x800, 0x900, 0xa00, 0xb00 };
321
322 static const u16 NCT6775_REG_WEIGHT_TEMP_SEL[] = {
323 0x139, 0x239, 0x339, 0x839, 0x939, 0xa39 };
324 static const u16 NCT6775_REG_WEIGHT_TEMP_STEP[] = {
325 0x13a, 0x23a, 0x33a, 0x83a, 0x93a, 0xa3a };
326 static const u16 NCT6775_REG_WEIGHT_TEMP_STEP_TOL[] = {
327 0x13b, 0x23b, 0x33b, 0x83b, 0x93b, 0xa3b };
328 static const u16 NCT6775_REG_WEIGHT_DUTY_STEP[] = {
329 0x13c, 0x23c, 0x33c, 0x83c, 0x93c, 0xa3c };
330 static const u16 NCT6775_REG_WEIGHT_TEMP_BASE[] = {
331 0x13d, 0x23d, 0x33d, 0x83d, 0x93d, 0xa3d };
332
333 static const u16 NCT6775_REG_TEMP_OFFSET[] = { 0x454, 0x455, 0x456 };
334
335 static const u16 NCT6775_REG_AUTO_TEMP[] = {
336 0x121, 0x221, 0x321, 0x821, 0x921, 0xa21, 0xb21 };
337 static const u16 NCT6775_REG_AUTO_PWM[] = {
338 0x127, 0x227, 0x327, 0x827, 0x927, 0xa27, 0xb27 };
339
340 #define NCT6775_AUTO_TEMP(data, nr, p) ((data)->REG_AUTO_TEMP[nr] + (p))
341 #define NCT6775_AUTO_PWM(data, nr, p) ((data)->REG_AUTO_PWM[nr] + (p))
342
343 static const u16 NCT6775_REG_CRITICAL_ENAB[] = { 0x134, 0x234, 0x334 };
344
345 static const u16 NCT6775_REG_CRITICAL_TEMP[] = {
346 0x135, 0x235, 0x335, 0x835, 0x935, 0xa35, 0xb35 };
347 static const u16 NCT6775_REG_CRITICAL_TEMP_TOLERANCE[] = {
348 0x138, 0x238, 0x338, 0x838, 0x938, 0xa38, 0xb38 };
349
350 static const char *const nct6775_temp_label[] = {
351 "",
352 "SYSTIN",
353 "CPUTIN",
354 "AUXTIN",
355 "AMD SB-TSI",
356 "PECI Agent 0",
357 "PECI Agent 1",
358 "PECI Agent 2",
359 "PECI Agent 3",
360 "PECI Agent 4",
361 "PECI Agent 5",
362 "PECI Agent 6",
363 "PECI Agent 7",
364 "PCH_CHIP_CPU_MAX_TEMP",
365 "PCH_CHIP_TEMP",
366 "PCH_CPU_TEMP",
367 "PCH_MCH_TEMP",
368 "PCH_DIM0_TEMP",
369 "PCH_DIM1_TEMP",
370 "PCH_DIM2_TEMP",
371 "PCH_DIM3_TEMP"
372 };
373
374 #define NCT6775_TEMP_MASK 0x001ffffe
375 #define NCT6775_VIRT_TEMP_MASK 0x00000000
376
377 static const u16 NCT6775_REG_TEMP_ALTERNATE[32] = {
378 [13] = 0x661,
379 [14] = 0x662,
380 [15] = 0x664,
381 };
382
383 static const u16 NCT6775_REG_TEMP_CRIT[32] = {
384 [4] = 0xa00,
385 [5] = 0xa01,
386 [6] = 0xa02,
387 [7] = 0xa03,
388 [8] = 0xa04,
389 [9] = 0xa05,
390 [10] = 0xa06,
391 [11] = 0xa07
392 };
393
394 /* NCT6776 specific data */
395
396 /* STEP_UP_TIME and STEP_DOWN_TIME regs are swapped for all chips but NCT6775 */
397 #define NCT6776_REG_FAN_STEP_UP_TIME NCT6775_REG_FAN_STEP_DOWN_TIME
398 #define NCT6776_REG_FAN_STEP_DOWN_TIME NCT6775_REG_FAN_STEP_UP_TIME
399
400 static const s8 NCT6776_ALARM_BITS[] = {
401 0, 1, 2, 3, 8, 21, 20, 16, /* in0.. in7 */
402 17, -1, -1, -1, -1, -1, -1, /* in8..in14 */
403 -1, /* unused */
404 6, 7, 11, 10, 23, /* fan1..fan5 */
405 -1, -1, -1, /* unused */
406 4, 5, 13, -1, -1, -1, /* temp1..temp6 */
407 12, 9 }; /* intrusion0, intrusion1 */
408
409 static const u16 NCT6776_REG_BEEP[NUM_REG_BEEP] = { 0xb2, 0xb3, 0xb4, 0xb5 };
410
411 static const s8 NCT6776_BEEP_BITS[] = {
412 0, 1, 2, 3, 4, 5, 6, 7, /* in0.. in7 */
413 8, -1, -1, -1, -1, -1, -1, /* in8..in14 */
414 24, /* global beep enable */
415 25, 26, 27, 28, 29, /* fan1..fan5 */
416 -1, -1, -1, /* unused */
417 16, 17, 18, 19, 20, 21, /* temp1..temp6 */
418 30, 31 }; /* intrusion0, intrusion1 */
419
420 static const u16 NCT6776_REG_TOLERANCE_H[] = {
421 0x10c, 0x20c, 0x30c, 0x80c, 0x90c, 0xa0c, 0xb0c };
422
423 static const u8 NCT6776_REG_PWM_MODE[] = { 0x04, 0, 0, 0, 0, 0 };
424 static const u8 NCT6776_PWM_MODE_MASK[] = { 0x01, 0, 0, 0, 0, 0 };
425
426 static const u16 NCT6776_REG_FAN_MIN[] = {
427 0x63a, 0x63c, 0x63e, 0x640, 0x642, 0x64a, 0x64c };
428 static const u16 NCT6776_REG_FAN_PULSES[NUM_FAN] = {
429 0x644, 0x645, 0x646, 0x647, 0x648, 0x649 };
430
431 static const u16 NCT6776_REG_WEIGHT_DUTY_BASE[] = {
432 0x13e, 0x23e, 0x33e, 0x83e, 0x93e, 0xa3e };
433
434 static const u16 NCT6776_REG_TEMP_CONFIG[ARRAY_SIZE(NCT6775_REG_TEMP)] = {
435 0x18, 0x152, 0x252, 0x628, 0x629, 0x62A };
436
437 static const char *const nct6776_temp_label[] = {
438 "",
439 "SYSTIN",
440 "CPUTIN",
441 "AUXTIN",
442 "SMBUSMASTER 0",
443 "SMBUSMASTER 1",
444 "SMBUSMASTER 2",
445 "SMBUSMASTER 3",
446 "SMBUSMASTER 4",
447 "SMBUSMASTER 5",
448 "SMBUSMASTER 6",
449 "SMBUSMASTER 7",
450 "PECI Agent 0",
451 "PECI Agent 1",
452 "PCH_CHIP_CPU_MAX_TEMP",
453 "PCH_CHIP_TEMP",
454 "PCH_CPU_TEMP",
455 "PCH_MCH_TEMP",
456 "PCH_DIM0_TEMP",
457 "PCH_DIM1_TEMP",
458 "PCH_DIM2_TEMP",
459 "PCH_DIM3_TEMP",
460 "BYTE_TEMP"
461 };
462
463 #define NCT6776_TEMP_MASK 0x007ffffe
464 #define NCT6776_VIRT_TEMP_MASK 0x00000000
465
466 static const u16 NCT6776_REG_TEMP_ALTERNATE[32] = {
467 [14] = 0x401,
468 [15] = 0x402,
469 [16] = 0x404,
470 };
471
472 static const u16 NCT6776_REG_TEMP_CRIT[32] = {
473 [11] = 0x709,
474 [12] = 0x70a,
475 };
476
477 /* NCT6779 specific data */
478
479 static const u16 NCT6779_REG_IN[] = {
480 0x480, 0x481, 0x482, 0x483, 0x484, 0x485, 0x486, 0x487,
481 0x488, 0x489, 0x48a, 0x48b, 0x48c, 0x48d, 0x48e };
482
483 static const u16 NCT6779_REG_ALARM[NUM_REG_ALARM] = {
484 0x459, 0x45A, 0x45B, 0x568 };
485
486 static const s8 NCT6779_ALARM_BITS[] = {
487 0, 1, 2, 3, 8, 21, 20, 16, /* in0.. in7 */
488 17, 24, 25, 26, 27, 28, 29, /* in8..in14 */
489 -1, /* unused */
490 6, 7, 11, 10, 23, /* fan1..fan5 */
491 -1, -1, -1, /* unused */
492 4, 5, 13, -1, -1, -1, /* temp1..temp6 */
493 12, 9 }; /* intrusion0, intrusion1 */
494
495 static const s8 NCT6779_BEEP_BITS[] = {
496 0, 1, 2, 3, 4, 5, 6, 7, /* in0.. in7 */
497 8, 9, 10, 11, 12, 13, 14, /* in8..in14 */
498 24, /* global beep enable */
499 25, 26, 27, 28, 29, /* fan1..fan5 */
500 -1, -1, -1, /* unused */
501 16, 17, -1, -1, -1, -1, /* temp1..temp6 */
502 30, 31 }; /* intrusion0, intrusion1 */
503
504 static const u16 NCT6779_REG_FAN[] = {
505 0x4c0, 0x4c2, 0x4c4, 0x4c6, 0x4c8, 0x4ca, 0x4ce };
506 static const u16 NCT6779_REG_FAN_PULSES[NUM_FAN] = {
507 0x644, 0x645, 0x646, 0x647, 0x648, 0x649, 0x64f };
508
509 static const u16 NCT6779_REG_CRITICAL_PWM_ENABLE[] = {
510 0x136, 0x236, 0x336, 0x836, 0x936, 0xa36, 0xb36 };
511 #define NCT6779_CRITICAL_PWM_ENABLE_MASK 0x01
512 static const u16 NCT6779_REG_CRITICAL_PWM[] = {
513 0x137, 0x237, 0x337, 0x837, 0x937, 0xa37, 0xb37 };
514
515 static const u16 NCT6779_REG_TEMP[] = { 0x27, 0x150 };
516 static const u16 NCT6779_REG_TEMP_MON[] = { 0x73, 0x75, 0x77, 0x79, 0x7b };
517 static const u16 NCT6779_REG_TEMP_CONFIG[ARRAY_SIZE(NCT6779_REG_TEMP)] = {
518 0x18, 0x152 };
519 static const u16 NCT6779_REG_TEMP_HYST[ARRAY_SIZE(NCT6779_REG_TEMP)] = {
520 0x3a, 0x153 };
521 static const u16 NCT6779_REG_TEMP_OVER[ARRAY_SIZE(NCT6779_REG_TEMP)] = {
522 0x39, 0x155 };
523
524 static const u16 NCT6779_REG_TEMP_OFFSET[] = {
525 0x454, 0x455, 0x456, 0x44a, 0x44b, 0x44c };
526
527 static const char *const nct6779_temp_label[] = {
528 "",
529 "SYSTIN",
530 "CPUTIN",
531 "AUXTIN0",
532 "AUXTIN1",
533 "AUXTIN2",
534 "AUXTIN3",
535 "",
536 "SMBUSMASTER 0",
537 "SMBUSMASTER 1",
538 "SMBUSMASTER 2",
539 "SMBUSMASTER 3",
540 "SMBUSMASTER 4",
541 "SMBUSMASTER 5",
542 "SMBUSMASTER 6",
543 "SMBUSMASTER 7",
544 "PECI Agent 0",
545 "PECI Agent 1",
546 "PCH_CHIP_CPU_MAX_TEMP",
547 "PCH_CHIP_TEMP",
548 "PCH_CPU_TEMP",
549 "PCH_MCH_TEMP",
550 "PCH_DIM0_TEMP",
551 "PCH_DIM1_TEMP",
552 "PCH_DIM2_TEMP",
553 "PCH_DIM3_TEMP",
554 "BYTE_TEMP",
555 "",
556 "",
557 "",
558 "",
559 "Virtual_TEMP"
560 };
561
562 #define NCT6779_TEMP_MASK 0x07ffff7e
563 #define NCT6779_VIRT_TEMP_MASK 0x00000000
564 #define NCT6791_TEMP_MASK 0x87ffff7e
565 #define NCT6791_VIRT_TEMP_MASK 0x80000000
566
567 static const u16 NCT6779_REG_TEMP_ALTERNATE[32]
568 = { 0x490, 0x491, 0x492, 0x493, 0x494, 0x495, 0, 0,
569 0, 0, 0, 0, 0, 0, 0, 0,
570 0, 0x400, 0x401, 0x402, 0x404, 0x405, 0x406, 0x407,
571 0x408, 0 };
572
573 static const u16 NCT6779_REG_TEMP_CRIT[32] = {
574 [15] = 0x709,
575 [16] = 0x70a,
576 };
577
578 /* NCT6791 specific data */
579
580 #define NCT6791_REG_HM_IO_SPACE_LOCK_ENABLE 0x28
581
582 static const u16 NCT6791_REG_WEIGHT_TEMP_SEL[NUM_FAN] = { 0, 0x239 };
583 static const u16 NCT6791_REG_WEIGHT_TEMP_STEP[NUM_FAN] = { 0, 0x23a };
584 static const u16 NCT6791_REG_WEIGHT_TEMP_STEP_TOL[NUM_FAN] = { 0, 0x23b };
585 static const u16 NCT6791_REG_WEIGHT_DUTY_STEP[NUM_FAN] = { 0, 0x23c };
586 static const u16 NCT6791_REG_WEIGHT_TEMP_BASE[NUM_FAN] = { 0, 0x23d };
587 static const u16 NCT6791_REG_WEIGHT_DUTY_BASE[NUM_FAN] = { 0, 0x23e };
588
589 static const u16 NCT6791_REG_ALARM[NUM_REG_ALARM] = {
590 0x459, 0x45A, 0x45B, 0x568, 0x45D };
591
592 static const s8 NCT6791_ALARM_BITS[] = {
593 0, 1, 2, 3, 8, 21, 20, 16, /* in0.. in7 */
594 17, 24, 25, 26, 27, 28, 29, /* in8..in14 */
595 -1, /* unused */
596 6, 7, 11, 10, 23, 33, /* fan1..fan6 */
597 -1, -1, /* unused */
598 4, 5, 13, -1, -1, -1, /* temp1..temp6 */
599 12, 9 }; /* intrusion0, intrusion1 */
600
601 /* NCT6792/NCT6793 specific data */
602
603 static const u16 NCT6792_REG_TEMP_MON[] = {
604 0x73, 0x75, 0x77, 0x79, 0x7b, 0x7d };
605 static const u16 NCT6792_REG_BEEP[NUM_REG_BEEP] = {
606 0xb2, 0xb3, 0xb4, 0xb5, 0xbf };
607
608 static const char *const nct6792_temp_label[] = {
609 "",
610 "SYSTIN",
611 "CPUTIN",
612 "AUXTIN0",
613 "AUXTIN1",
614 "AUXTIN2",
615 "AUXTIN3",
616 "",
617 "SMBUSMASTER 0",
618 "SMBUSMASTER 1",
619 "SMBUSMASTER 2",
620 "SMBUSMASTER 3",
621 "SMBUSMASTER 4",
622 "SMBUSMASTER 5",
623 "SMBUSMASTER 6",
624 "SMBUSMASTER 7",
625 "PECI Agent 0",
626 "PECI Agent 1",
627 "PCH_CHIP_CPU_MAX_TEMP",
628 "PCH_CHIP_TEMP",
629 "PCH_CPU_TEMP",
630 "PCH_MCH_TEMP",
631 "PCH_DIM0_TEMP",
632 "PCH_DIM1_TEMP",
633 "PCH_DIM2_TEMP",
634 "PCH_DIM3_TEMP",
635 "BYTE_TEMP",
636 "PECI Agent 0 Calibration",
637 "PECI Agent 1 Calibration",
638 "",
639 "",
640 "Virtual_TEMP"
641 };
642
643 #define NCT6792_TEMP_MASK 0x9fffff7e
644 #define NCT6792_VIRT_TEMP_MASK 0x80000000
645
646 static const char *const nct6793_temp_label[] = {
647 "",
648 "SYSTIN",
649 "CPUTIN",
650 "AUXTIN0",
651 "AUXTIN1",
652 "AUXTIN2",
653 "AUXTIN3",
654 "",
655 "SMBUSMASTER 0",
656 "SMBUSMASTER 1",
657 "",
658 "",
659 "",
660 "",
661 "",
662 "",
663 "PECI Agent 0",
664 "PECI Agent 1",
665 "PCH_CHIP_CPU_MAX_TEMP",
666 "PCH_CHIP_TEMP",
667 "PCH_CPU_TEMP",
668 "PCH_MCH_TEMP",
669 "Agent0 Dimm0 ",
670 "Agent0 Dimm1",
671 "Agent1 Dimm0",
672 "Agent1 Dimm1",
673 "BYTE_TEMP0",
674 "BYTE_TEMP1",
675 "PECI Agent 0 Calibration",
676 "PECI Agent 1 Calibration",
677 "",
678 "Virtual_TEMP"
679 };
680
681 #define NCT6793_TEMP_MASK 0xbfff037e
682 #define NCT6793_VIRT_TEMP_MASK 0x80000000
683
684 static const char *const nct6795_temp_label[] = {
685 "",
686 "SYSTIN",
687 "CPUTIN",
688 "AUXTIN0",
689 "AUXTIN1",
690 "AUXTIN2",
691 "AUXTIN3",
692 "",
693 "SMBUSMASTER 0",
694 "SMBUSMASTER 1",
695 "SMBUSMASTER 2",
696 "SMBUSMASTER 3",
697 "SMBUSMASTER 4",
698 "SMBUSMASTER 5",
699 "SMBUSMASTER 6",
700 "SMBUSMASTER 7",
701 "PECI Agent 0",
702 "PECI Agent 1",
703 "PCH_CHIP_CPU_MAX_TEMP",
704 "PCH_CHIP_TEMP",
705 "PCH_CPU_TEMP",
706 "PCH_MCH_TEMP",
707 "Agent0 Dimm0",
708 "Agent0 Dimm1",
709 "Agent1 Dimm0",
710 "Agent1 Dimm1",
711 "BYTE_TEMP0",
712 "BYTE_TEMP1",
713 "PECI Agent 0 Calibration",
714 "PECI Agent 1 Calibration",
715 "",
716 "Virtual_TEMP"
717 };
718
719 #define NCT6795_TEMP_MASK 0xbfffff7e
720 #define NCT6795_VIRT_TEMP_MASK 0x80000000
721
722 static const char *const nct6796_temp_label[] = {
723 "",
724 "SYSTIN",
725 "CPUTIN",
726 "AUXTIN0",
727 "AUXTIN1",
728 "AUXTIN2",
729 "AUXTIN3",
730 "AUXTIN4",
731 "SMBUSMASTER 0",
732 "SMBUSMASTER 1",
733 "Virtual_TEMP",
734 "Virtual_TEMP",
735 "",
736 "",
737 "",
738 "",
739 "PECI Agent 0",
740 "PECI Agent 1",
741 "PCH_CHIP_CPU_MAX_TEMP",
742 "PCH_CHIP_TEMP",
743 "PCH_CPU_TEMP",
744 "PCH_MCH_TEMP",
745 "Agent0 Dimm0",
746 "Agent0 Dimm1",
747 "Agent1 Dimm0",
748 "Agent1 Dimm1",
749 "BYTE_TEMP0",
750 "BYTE_TEMP1",
751 "PECI Agent 0 Calibration",
752 "PECI Agent 1 Calibration",
753 "",
754 "Virtual_TEMP"
755 };
756
757 #define NCT6796_TEMP_MASK 0xbfff0ffe
758 #define NCT6796_VIRT_TEMP_MASK 0x80000c00
759
760 static const char *const nct6798_temp_label[] = {
761 "",
762 "SYSTIN",
763 "CPUTIN",
764 "AUXTIN0",
765 "AUXTIN1",
766 "AUXTIN2",
767 "AUXTIN3",
768 "AUXTIN4",
769 "SMBUSMASTER 0",
770 "SMBUSMASTER 1",
771 "Virtual_TEMP",
772 "Virtual_TEMP",
773 "",
774 "",
775 "",
776 "",
777 "PECI Agent 0",
778 "PECI Agent 1",
779 "PCH_CHIP_CPU_MAX_TEMP",
780 "PCH_CHIP_TEMP",
781 "PCH_CPU_TEMP",
782 "PCH_MCH_TEMP",
783 "Agent0 Dimm0",
784 "Agent0 Dimm1",
785 "Agent1 Dimm0",
786 "Agent1 Dimm1",
787 "BYTE_TEMP0",
788 "BYTE_TEMP1",
789 "",
790 "",
791 "",
792 "Virtual_TEMP"
793 };
794
795 #define NCT6798_TEMP_MASK 0x8fff0ffe
796 #define NCT6798_VIRT_TEMP_MASK 0x80000c00
797
798 /* NCT6102D/NCT6106D specific data */
799
800 #define NCT6106_REG_VBAT 0x318
801 #define NCT6106_REG_DIODE 0x319
802 #define NCT6106_DIODE_MASK 0x01
803
804 static const u16 NCT6106_REG_IN_MAX[] = {
805 0x90, 0x92, 0x94, 0x96, 0x98, 0x9a, 0x9e, 0xa0, 0xa2 };
806 static const u16 NCT6106_REG_IN_MIN[] = {
807 0x91, 0x93, 0x95, 0x97, 0x99, 0x9b, 0x9f, 0xa1, 0xa3 };
808 static const u16 NCT6106_REG_IN[] = {
809 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x07, 0x08, 0x09 };
810
811 static const u16 NCT6106_REG_TEMP[] = { 0x10, 0x11, 0x12, 0x13, 0x14, 0x15 };
812 static const u16 NCT6106_REG_TEMP_MON[] = { 0x18, 0x19, 0x1a };
813 static const u16 NCT6106_REG_TEMP_HYST[] = {
814 0xc3, 0xc7, 0xcb, 0xcf, 0xd3, 0xd7 };
815 static const u16 NCT6106_REG_TEMP_OVER[] = {
816 0xc2, 0xc6, 0xca, 0xce, 0xd2, 0xd6 };
817 static const u16 NCT6106_REG_TEMP_CRIT_L[] = {
818 0xc0, 0xc4, 0xc8, 0xcc, 0xd0, 0xd4 };
819 static const u16 NCT6106_REG_TEMP_CRIT_H[] = {
820 0xc1, 0xc5, 0xc9, 0xcf, 0xd1, 0xd5 };
821 static const u16 NCT6106_REG_TEMP_OFFSET[] = { 0x311, 0x312, 0x313 };
822 static const u16 NCT6106_REG_TEMP_CONFIG[] = {
823 0xb7, 0xb8, 0xb9, 0xba, 0xbb, 0xbc };
824
825 static const u16 NCT6106_REG_FAN[] = { 0x20, 0x22, 0x24 };
826 static const u16 NCT6106_REG_FAN_MIN[] = { 0xe0, 0xe2, 0xe4 };
827 static const u16 NCT6106_REG_FAN_PULSES[] = { 0xf6, 0xf6, 0xf6 };
828 static const u16 NCT6106_FAN_PULSE_SHIFT[] = { 0, 2, 4 };
829
830 static const u8 NCT6106_REG_PWM_MODE[] = { 0xf3, 0xf3, 0xf3 };
831 static const u8 NCT6106_PWM_MODE_MASK[] = { 0x01, 0x02, 0x04 };
832 static const u16 NCT6106_REG_PWM_READ[] = { 0x4a, 0x4b, 0x4c };
833 static const u16 NCT6106_REG_FAN_MODE[] = { 0x113, 0x123, 0x133 };
834 static const u16 NCT6106_REG_TEMP_SOURCE[] = {
835 0xb0, 0xb1, 0xb2, 0xb3, 0xb4, 0xb5 };
836
837 static const u16 NCT6106_REG_CRITICAL_TEMP[] = { 0x11a, 0x12a, 0x13a };
838 static const u16 NCT6106_REG_CRITICAL_TEMP_TOLERANCE[] = {
839 0x11b, 0x12b, 0x13b };
840
841 static const u16 NCT6106_REG_CRITICAL_PWM_ENABLE[] = { 0x11c, 0x12c, 0x13c };
842 #define NCT6106_CRITICAL_PWM_ENABLE_MASK 0x10
843 static const u16 NCT6106_REG_CRITICAL_PWM[] = { 0x11d, 0x12d, 0x13d };
844
845 static const u16 NCT6106_REG_FAN_STEP_UP_TIME[] = { 0x114, 0x124, 0x134 };
846 static const u16 NCT6106_REG_FAN_STEP_DOWN_TIME[] = { 0x115, 0x125, 0x135 };
847 static const u16 NCT6106_REG_FAN_STOP_OUTPUT[] = { 0x116, 0x126, 0x136 };
848 static const u16 NCT6106_REG_FAN_START_OUTPUT[] = { 0x117, 0x127, 0x137 };
849 static const u16 NCT6106_REG_FAN_STOP_TIME[] = { 0x118, 0x128, 0x138 };
850 static const u16 NCT6106_REG_TOLERANCE_H[] = { 0x112, 0x122, 0x132 };
851
852 static const u16 NCT6106_REG_TARGET[] = { 0x111, 0x121, 0x131 };
853
854 static const u16 NCT6106_REG_WEIGHT_TEMP_SEL[] = { 0x168, 0x178, 0x188 };
855 static const u16 NCT6106_REG_WEIGHT_TEMP_STEP[] = { 0x169, 0x179, 0x189 };
856 static const u16 NCT6106_REG_WEIGHT_TEMP_STEP_TOL[] = { 0x16a, 0x17a, 0x18a };
857 static const u16 NCT6106_REG_WEIGHT_DUTY_STEP[] = { 0x16b, 0x17b, 0x18b };
858 static const u16 NCT6106_REG_WEIGHT_TEMP_BASE[] = { 0x16c, 0x17c, 0x18c };
859 static const u16 NCT6106_REG_WEIGHT_DUTY_BASE[] = { 0x16d, 0x17d, 0x18d };
860
861 static const u16 NCT6106_REG_AUTO_TEMP[] = { 0x160, 0x170, 0x180 };
862 static const u16 NCT6106_REG_AUTO_PWM[] = { 0x164, 0x174, 0x184 };
863
864 static const u16 NCT6106_REG_ALARM[NUM_REG_ALARM] = {
865 0x77, 0x78, 0x79, 0x7a, 0x7b, 0x7c, 0x7d };
866
867 static const s8 NCT6106_ALARM_BITS[] = {
868 0, 1, 2, 3, 4, 5, 7, 8, /* in0.. in7 */
869 9, -1, -1, -1, -1, -1, -1, /* in8..in14 */
870 -1, /* unused */
871 32, 33, 34, -1, -1, /* fan1..fan5 */
872 -1, -1, -1, /* unused */
873 16, 17, 18, 19, 20, 21, /* temp1..temp6 */
874 48, -1 /* intrusion0, intrusion1 */
875 };
876
877 static const u16 NCT6106_REG_BEEP[NUM_REG_BEEP] = {
878 0x3c0, 0x3c1, 0x3c2, 0x3c3, 0x3c4 };
879
880 static const s8 NCT6106_BEEP_BITS[] = {
881 0, 1, 2, 3, 4, 5, 7, 8, /* in0.. in7 */
882 9, 10, 11, 12, -1, -1, -1, /* in8..in14 */
883 32, /* global beep enable */
884 24, 25, 26, 27, 28, /* fan1..fan5 */
885 -1, -1, -1, /* unused */
886 16, 17, 18, 19, 20, 21, /* temp1..temp6 */
887 34, -1 /* intrusion0, intrusion1 */
888 };
889
890 static const u16 NCT6106_REG_TEMP_ALTERNATE[32] = {
891 [14] = 0x51,
892 [15] = 0x52,
893 [16] = 0x54,
894 };
895
896 static const u16 NCT6106_REG_TEMP_CRIT[32] = {
897 [11] = 0x204,
898 [12] = 0x205,
899 };
900
901 /* NCT6112D/NCT6114D/NCT6116D specific data */
902
903 static const u16 NCT6116_REG_FAN[] = { 0x20, 0x22, 0x24, 0x26, 0x28 };
904 static const u16 NCT6116_REG_FAN_MIN[] = { 0xe0, 0xe2, 0xe4, 0xe6, 0xe8 };
905 static const u16 NCT6116_REG_FAN_PULSES[] = { 0xf6, 0xf6, 0xf6, 0xf6, 0xf5 };
906 static const u16 NCT6116_FAN_PULSE_SHIFT[] = { 0, 2, 4, 6, 6 };
907
908 static const u16 NCT6116_REG_PWM[] = { 0x119, 0x129, 0x139, 0x199, 0x1a9 };
909 static const u16 NCT6116_REG_FAN_MODE[] = { 0x113, 0x123, 0x133, 0x193, 0x1a3 };
910 static const u16 NCT6116_REG_TEMP_SEL[] = { 0x110, 0x120, 0x130, 0x190, 0x1a0 };
911 static const u16 NCT6116_REG_TEMP_SOURCE[] = {
912 0xb0, 0xb1, 0xb2 };
913
914 static const u16 NCT6116_REG_CRITICAL_TEMP[] = {
915 0x11a, 0x12a, 0x13a, 0x19a, 0x1aa };
916 static const u16 NCT6116_REG_CRITICAL_TEMP_TOLERANCE[] = {
917 0x11b, 0x12b, 0x13b, 0x19b, 0x1ab };
918
919 static const u16 NCT6116_REG_CRITICAL_PWM_ENABLE[] = {
920 0x11c, 0x12c, 0x13c, 0x19c, 0x1ac };
921 static const u16 NCT6116_REG_CRITICAL_PWM[] = {
922 0x11d, 0x12d, 0x13d, 0x19d, 0x1ad };
923
924 static const u16 NCT6116_REG_FAN_STEP_UP_TIME[] = {
925 0x114, 0x124, 0x134, 0x194, 0x1a4 };
926 static const u16 NCT6116_REG_FAN_STEP_DOWN_TIME[] = {
927 0x115, 0x125, 0x135, 0x195, 0x1a5 };
928 static const u16 NCT6116_REG_FAN_STOP_OUTPUT[] = {
929 0x116, 0x126, 0x136, 0x196, 0x1a6 };
930 static const u16 NCT6116_REG_FAN_START_OUTPUT[] = {
931 0x117, 0x127, 0x137, 0x197, 0x1a7 };
932 static const u16 NCT6116_REG_FAN_STOP_TIME[] = {
933 0x118, 0x128, 0x138, 0x198, 0x1a8 };
934 static const u16 NCT6116_REG_TOLERANCE_H[] = {
935 0x112, 0x122, 0x132, 0x192, 0x1a2 };
936
937 static const u16 NCT6116_REG_TARGET[] = {
938 0x111, 0x121, 0x131, 0x191, 0x1a1 };
939
940 static const u16 NCT6116_REG_AUTO_TEMP[] = {
941 0x160, 0x170, 0x180, 0x1d0, 0x1e0 };
942 static const u16 NCT6116_REG_AUTO_PWM[] = {
943 0x164, 0x174, 0x184, 0x1d4, 0x1e4 };
944
945 static const s8 NCT6116_ALARM_BITS[] = {
946 0, 1, 2, 3, 4, 5, 7, 8, /* in0.. in7 */
947 9, -1, -1, -1, -1, -1, -1, /* in8..in9 */
948 -1, /* unused */
949 32, 33, 34, 35, 36, /* fan1..fan5 */
950 -1, -1, -1, /* unused */
951 16, 17, 18, -1, -1, -1, /* temp1..temp6 */
952 48, -1 /* intrusion0, intrusion1 */
953 };
954
955 static const s8 NCT6116_BEEP_BITS[] = {
956 0, 1, 2, 3, 4, 5, 7, 8, /* in0.. in7 */
957 9, 10, 11, 12, -1, -1, -1, /* in8..in14 */
958 32, /* global beep enable */
959 24, 25, 26, 27, 28, /* fan1..fan5 */
960 -1, -1, -1, /* unused */
961 16, 17, 18, -1, -1, -1, /* temp1..temp6 */
962 34, -1 /* intrusion0, intrusion1 */
963 };
964
reg_to_pwm_enable(int pwm,int mode)965 static enum pwm_enable reg_to_pwm_enable(int pwm, int mode)
966 {
967 if (mode == 0 && pwm == 255)
968 return off;
969 return mode + 1;
970 }
971
pwm_enable_to_reg(enum pwm_enable mode)972 static int pwm_enable_to_reg(enum pwm_enable mode)
973 {
974 if (mode == off)
975 return 0;
976 return mode - 1;
977 }
978
979 /*
980 * Conversions
981 */
982
983 /* 1 is DC mode, output in ms */
step_time_from_reg(u8 reg,u8 mode)984 static unsigned int step_time_from_reg(u8 reg, u8 mode)
985 {
986 return mode ? 400 * reg : 100 * reg;
987 }
988
step_time_to_reg(unsigned int msec,u8 mode)989 static u8 step_time_to_reg(unsigned int msec, u8 mode)
990 {
991 return clamp_val((mode ? (msec + 200) / 400 :
992 (msec + 50) / 100), 1, 255);
993 }
994
fan_from_reg8(u16 reg,unsigned int divreg)995 static unsigned int fan_from_reg8(u16 reg, unsigned int divreg)
996 {
997 if (reg == 0 || reg == 255)
998 return 0;
999 return 1350000U / (reg << divreg);
1000 }
1001
fan_from_reg13(u16 reg,unsigned int divreg)1002 static unsigned int fan_from_reg13(u16 reg, unsigned int divreg)
1003 {
1004 if ((reg & 0xff1f) == 0xff1f)
1005 return 0;
1006
1007 reg = (reg & 0x1f) | ((reg & 0xff00) >> 3);
1008
1009 if (reg == 0)
1010 return 0;
1011
1012 return 1350000U / reg;
1013 }
1014
fan_from_reg16(u16 reg,unsigned int divreg)1015 static unsigned int fan_from_reg16(u16 reg, unsigned int divreg)
1016 {
1017 if (reg == 0 || reg == 0xffff)
1018 return 0;
1019
1020 /*
1021 * Even though the registers are 16 bit wide, the fan divisor
1022 * still applies.
1023 */
1024 return 1350000U / (reg << divreg);
1025 }
1026
fan_from_reg_rpm(u16 reg,unsigned int divreg)1027 static unsigned int fan_from_reg_rpm(u16 reg, unsigned int divreg)
1028 {
1029 return reg;
1030 }
1031
fan_to_reg(u32 fan,unsigned int divreg)1032 static u16 fan_to_reg(u32 fan, unsigned int divreg)
1033 {
1034 if (!fan)
1035 return 0;
1036
1037 return (1350000U / fan) >> divreg;
1038 }
1039
1040 static inline unsigned int
div_from_reg(u8 reg)1041 div_from_reg(u8 reg)
1042 {
1043 return BIT(reg);
1044 }
1045
1046 /*
1047 * Some of the voltage inputs have internal scaling, the tables below
1048 * contain 8 (the ADC LSB in mV) * scaling factor * 100
1049 */
1050 static const u16 scale_in[15] = {
1051 800, 800, 1600, 1600, 800, 800, 800, 1600, 1600, 800, 800, 800, 800,
1052 800, 800
1053 };
1054
in_from_reg(u8 reg,u8 nr)1055 static inline long in_from_reg(u8 reg, u8 nr)
1056 {
1057 return DIV_ROUND_CLOSEST(reg * scale_in[nr], 100);
1058 }
1059
in_to_reg(u32 val,u8 nr)1060 static inline u8 in_to_reg(u32 val, u8 nr)
1061 {
1062 return clamp_val(DIV_ROUND_CLOSEST(val * 100, scale_in[nr]), 0, 255);
1063 }
1064
1065 /*
1066 * Data structures and manipulation thereof
1067 */
1068
1069 struct nct6775_data {
1070 int addr; /* IO base of hw monitor block */
1071 int sioreg; /* SIO register address */
1072 enum kinds kind;
1073 const char *name;
1074
1075 const struct attribute_group *groups[6];
1076
1077 u16 reg_temp[5][NUM_TEMP]; /* 0=temp, 1=temp_over, 2=temp_hyst,
1078 * 3=temp_crit, 4=temp_lcrit
1079 */
1080 u8 temp_src[NUM_TEMP];
1081 u16 reg_temp_config[NUM_TEMP];
1082 const char * const *temp_label;
1083 u32 temp_mask;
1084 u32 virt_temp_mask;
1085
1086 u16 REG_CONFIG;
1087 u16 REG_VBAT;
1088 u16 REG_DIODE;
1089 u8 DIODE_MASK;
1090
1091 const s8 *ALARM_BITS;
1092 const s8 *BEEP_BITS;
1093
1094 const u16 *REG_VIN;
1095 const u16 *REG_IN_MINMAX[2];
1096
1097 const u16 *REG_TARGET;
1098 const u16 *REG_FAN;
1099 const u16 *REG_FAN_MODE;
1100 const u16 *REG_FAN_MIN;
1101 const u16 *REG_FAN_PULSES;
1102 const u16 *FAN_PULSE_SHIFT;
1103 const u16 *REG_FAN_TIME[3];
1104
1105 const u16 *REG_TOLERANCE_H;
1106
1107 const u8 *REG_PWM_MODE;
1108 const u8 *PWM_MODE_MASK;
1109
1110 const u16 *REG_PWM[7]; /* [0]=pwm, [1]=pwm_start, [2]=pwm_floor,
1111 * [3]=pwm_max, [4]=pwm_step,
1112 * [5]=weight_duty_step, [6]=weight_duty_base
1113 */
1114 const u16 *REG_PWM_READ;
1115
1116 const u16 *REG_CRITICAL_PWM_ENABLE;
1117 u8 CRITICAL_PWM_ENABLE_MASK;
1118 const u16 *REG_CRITICAL_PWM;
1119
1120 const u16 *REG_AUTO_TEMP;
1121 const u16 *REG_AUTO_PWM;
1122
1123 const u16 *REG_CRITICAL_TEMP;
1124 const u16 *REG_CRITICAL_TEMP_TOLERANCE;
1125
1126 const u16 *REG_TEMP_SOURCE; /* temp register sources */
1127 const u16 *REG_TEMP_SEL;
1128 const u16 *REG_WEIGHT_TEMP_SEL;
1129 const u16 *REG_WEIGHT_TEMP[3]; /* 0=base, 1=tolerance, 2=step */
1130
1131 const u16 *REG_TEMP_OFFSET;
1132
1133 const u16 *REG_ALARM;
1134 const u16 *REG_BEEP;
1135
1136 unsigned int (*fan_from_reg)(u16 reg, unsigned int divreg);
1137 unsigned int (*fan_from_reg_min)(u16 reg, unsigned int divreg);
1138
1139 struct mutex update_lock;
1140 bool valid; /* true if following fields are valid */
1141 unsigned long last_updated; /* In jiffies */
1142
1143 /* Register values */
1144 u8 bank; /* current register bank */
1145 u8 in_num; /* number of in inputs we have */
1146 u8 in[15][3]; /* [0]=in, [1]=in_max, [2]=in_min */
1147 unsigned int rpm[NUM_FAN];
1148 u16 fan_min[NUM_FAN];
1149 u8 fan_pulses[NUM_FAN];
1150 u8 fan_div[NUM_FAN];
1151 u8 has_pwm;
1152 u8 has_fan; /* some fan inputs can be disabled */
1153 u8 has_fan_min; /* some fans don't have min register */
1154 bool has_fan_div;
1155
1156 u8 num_temp_alarms; /* 2, 3, or 6 */
1157 u8 num_temp_beeps; /* 2, 3, or 6 */
1158 u8 temp_fixed_num; /* 3 or 6 */
1159 u8 temp_type[NUM_TEMP_FIXED];
1160 s8 temp_offset[NUM_TEMP_FIXED];
1161 s16 temp[5][NUM_TEMP]; /* 0=temp, 1=temp_over, 2=temp_hyst,
1162 * 3=temp_crit, 4=temp_lcrit */
1163 u64 alarms;
1164 u64 beeps;
1165
1166 u8 pwm_num; /* number of pwm */
1167 u8 pwm_mode[NUM_FAN]; /* 0->DC variable voltage,
1168 * 1->PWM variable duty cycle
1169 */
1170 enum pwm_enable pwm_enable[NUM_FAN];
1171 /* 0->off
1172 * 1->manual
1173 * 2->thermal cruise mode (also called SmartFan I)
1174 * 3->fan speed cruise mode
1175 * 4->SmartFan III
1176 * 5->enhanced variable thermal cruise (SmartFan IV)
1177 */
1178 u8 pwm[7][NUM_FAN]; /* [0]=pwm, [1]=pwm_start, [2]=pwm_floor,
1179 * [3]=pwm_max, [4]=pwm_step,
1180 * [5]=weight_duty_step, [6]=weight_duty_base
1181 */
1182
1183 u8 target_temp[NUM_FAN];
1184 u8 target_temp_mask;
1185 u32 target_speed[NUM_FAN];
1186 u32 target_speed_tolerance[NUM_FAN];
1187 u8 speed_tolerance_limit;
1188
1189 u8 temp_tolerance[2][NUM_FAN];
1190 u8 tolerance_mask;
1191
1192 u8 fan_time[3][NUM_FAN]; /* 0 = stop_time, 1 = step_up, 2 = step_down */
1193
1194 /* Automatic fan speed control registers */
1195 int auto_pwm_num;
1196 u8 auto_pwm[NUM_FAN][7];
1197 u8 auto_temp[NUM_FAN][7];
1198 u8 pwm_temp_sel[NUM_FAN];
1199 u8 pwm_weight_temp_sel[NUM_FAN];
1200 u8 weight_temp[3][NUM_FAN]; /* 0->temp_step, 1->temp_step_tol,
1201 * 2->temp_base
1202 */
1203
1204 u8 vid;
1205 u8 vrm;
1206
1207 bool have_vid;
1208
1209 u16 have_temp;
1210 u16 have_temp_fixed;
1211 u16 have_in;
1212
1213 /* Remember extra register values over suspend/resume */
1214 u8 vbat;
1215 u8 fandiv1;
1216 u8 fandiv2;
1217 u8 sio_reg_enable;
1218 };
1219
1220 struct nct6775_sio_data {
1221 int sioreg;
1222 enum kinds kind;
1223 };
1224
1225 struct sensor_device_template {
1226 struct device_attribute dev_attr;
1227 union {
1228 struct {
1229 u8 nr;
1230 u8 index;
1231 } s;
1232 int index;
1233 } u;
1234 bool s2; /* true if both index and nr are used */
1235 };
1236
1237 struct sensor_device_attr_u {
1238 union {
1239 struct sensor_device_attribute a1;
1240 struct sensor_device_attribute_2 a2;
1241 } u;
1242 char name[32];
1243 };
1244
1245 #define __TEMPLATE_ATTR(_template, _mode, _show, _store) { \
1246 .attr = {.name = _template, .mode = _mode }, \
1247 .show = _show, \
1248 .store = _store, \
1249 }
1250
1251 #define SENSOR_DEVICE_TEMPLATE(_template, _mode, _show, _store, _index) \
1252 { .dev_attr = __TEMPLATE_ATTR(_template, _mode, _show, _store), \
1253 .u.index = _index, \
1254 .s2 = false }
1255
1256 #define SENSOR_DEVICE_TEMPLATE_2(_template, _mode, _show, _store, \
1257 _nr, _index) \
1258 { .dev_attr = __TEMPLATE_ATTR(_template, _mode, _show, _store), \
1259 .u.s.index = _index, \
1260 .u.s.nr = _nr, \
1261 .s2 = true }
1262
1263 #define SENSOR_TEMPLATE(_name, _template, _mode, _show, _store, _index) \
1264 static struct sensor_device_template sensor_dev_template_##_name \
1265 = SENSOR_DEVICE_TEMPLATE(_template, _mode, _show, _store, \
1266 _index)
1267
1268 #define SENSOR_TEMPLATE_2(_name, _template, _mode, _show, _store, \
1269 _nr, _index) \
1270 static struct sensor_device_template sensor_dev_template_##_name \
1271 = SENSOR_DEVICE_TEMPLATE_2(_template, _mode, _show, _store, \
1272 _nr, _index)
1273
1274 struct sensor_template_group {
1275 struct sensor_device_template **templates;
1276 umode_t (*is_visible)(struct kobject *, struct attribute *, int);
1277 int base;
1278 };
1279
1280 static struct attribute_group *
nct6775_create_attr_group(struct device * dev,const struct sensor_template_group * tg,int repeat)1281 nct6775_create_attr_group(struct device *dev,
1282 const struct sensor_template_group *tg,
1283 int repeat)
1284 {
1285 struct attribute_group *group;
1286 struct sensor_device_attr_u *su;
1287 struct sensor_device_attribute *a;
1288 struct sensor_device_attribute_2 *a2;
1289 struct attribute **attrs;
1290 struct sensor_device_template **t;
1291 int i, count;
1292
1293 if (repeat <= 0)
1294 return ERR_PTR(-EINVAL);
1295
1296 t = tg->templates;
1297 for (count = 0; *t; t++, count++)
1298 ;
1299
1300 if (count == 0)
1301 return ERR_PTR(-EINVAL);
1302
1303 group = devm_kzalloc(dev, sizeof(*group), GFP_KERNEL);
1304 if (group == NULL)
1305 return ERR_PTR(-ENOMEM);
1306
1307 attrs = devm_kcalloc(dev, repeat * count + 1, sizeof(*attrs),
1308 GFP_KERNEL);
1309 if (attrs == NULL)
1310 return ERR_PTR(-ENOMEM);
1311
1312 su = devm_kzalloc(dev, array3_size(repeat, count, sizeof(*su)),
1313 GFP_KERNEL);
1314 if (su == NULL)
1315 return ERR_PTR(-ENOMEM);
1316
1317 group->attrs = attrs;
1318 group->is_visible = tg->is_visible;
1319
1320 for (i = 0; i < repeat; i++) {
1321 t = tg->templates;
1322 while (*t != NULL) {
1323 snprintf(su->name, sizeof(su->name),
1324 (*t)->dev_attr.attr.name, tg->base + i);
1325 if ((*t)->s2) {
1326 a2 = &su->u.a2;
1327 sysfs_attr_init(&a2->dev_attr.attr);
1328 a2->dev_attr.attr.name = su->name;
1329 a2->nr = (*t)->u.s.nr + i;
1330 a2->index = (*t)->u.s.index;
1331 a2->dev_attr.attr.mode =
1332 (*t)->dev_attr.attr.mode;
1333 a2->dev_attr.show = (*t)->dev_attr.show;
1334 a2->dev_attr.store = (*t)->dev_attr.store;
1335 *attrs = &a2->dev_attr.attr;
1336 } else {
1337 a = &su->u.a1;
1338 sysfs_attr_init(&a->dev_attr.attr);
1339 a->dev_attr.attr.name = su->name;
1340 a->index = (*t)->u.index + i;
1341 a->dev_attr.attr.mode =
1342 (*t)->dev_attr.attr.mode;
1343 a->dev_attr.show = (*t)->dev_attr.show;
1344 a->dev_attr.store = (*t)->dev_attr.store;
1345 *attrs = &a->dev_attr.attr;
1346 }
1347 attrs++;
1348 su++;
1349 t++;
1350 }
1351 }
1352
1353 return group;
1354 }
1355
is_word_sized(struct nct6775_data * data,u16 reg)1356 static bool is_word_sized(struct nct6775_data *data, u16 reg)
1357 {
1358 switch (data->kind) {
1359 case nct6106:
1360 return reg == 0x20 || reg == 0x22 || reg == 0x24 ||
1361 reg == 0xe0 || reg == 0xe2 || reg == 0xe4 ||
1362 reg == 0x111 || reg == 0x121 || reg == 0x131;
1363 case nct6116:
1364 return reg == 0x20 || reg == 0x22 || reg == 0x24 ||
1365 reg == 0x26 || reg == 0x28 || reg == 0xe0 || reg == 0xe2 ||
1366 reg == 0xe4 || reg == 0xe6 || reg == 0xe8 || reg == 0x111 ||
1367 reg == 0x121 || reg == 0x131 || reg == 0x191 || reg == 0x1a1;
1368 case nct6775:
1369 return (((reg & 0xff00) == 0x100 ||
1370 (reg & 0xff00) == 0x200) &&
1371 ((reg & 0x00ff) == 0x50 ||
1372 (reg & 0x00ff) == 0x53 ||
1373 (reg & 0x00ff) == 0x55)) ||
1374 (reg & 0xfff0) == 0x630 ||
1375 reg == 0x640 || reg == 0x642 ||
1376 reg == 0x662 ||
1377 ((reg & 0xfff0) == 0x650 && (reg & 0x000f) >= 0x06) ||
1378 reg == 0x73 || reg == 0x75 || reg == 0x77;
1379 case nct6776:
1380 return (((reg & 0xff00) == 0x100 ||
1381 (reg & 0xff00) == 0x200) &&
1382 ((reg & 0x00ff) == 0x50 ||
1383 (reg & 0x00ff) == 0x53 ||
1384 (reg & 0x00ff) == 0x55)) ||
1385 (reg & 0xfff0) == 0x630 ||
1386 reg == 0x402 ||
1387 reg == 0x640 || reg == 0x642 ||
1388 ((reg & 0xfff0) == 0x650 && (reg & 0x000f) >= 0x06) ||
1389 reg == 0x73 || reg == 0x75 || reg == 0x77;
1390 case nct6779:
1391 case nct6791:
1392 case nct6792:
1393 case nct6793:
1394 case nct6795:
1395 case nct6796:
1396 case nct6797:
1397 case nct6798:
1398 return reg == 0x150 || reg == 0x153 || reg == 0x155 ||
1399 (reg & 0xfff0) == 0x4c0 ||
1400 reg == 0x402 ||
1401 reg == 0x63a || reg == 0x63c || reg == 0x63e ||
1402 reg == 0x640 || reg == 0x642 || reg == 0x64a ||
1403 reg == 0x64c ||
1404 reg == 0x73 || reg == 0x75 || reg == 0x77 || reg == 0x79 ||
1405 reg == 0x7b || reg == 0x7d;
1406 }
1407 return false;
1408 }
1409
1410 /*
1411 * On older chips, only registers 0x50-0x5f are banked.
1412 * On more recent chips, all registers are banked.
1413 * Assume that is the case and set the bank number for each access.
1414 * Cache the bank number so it only needs to be set if it changes.
1415 */
nct6775_set_bank(struct nct6775_data * data,u16 reg)1416 static inline void nct6775_set_bank(struct nct6775_data *data, u16 reg)
1417 {
1418 u8 bank = reg >> 8;
1419
1420 if (data->bank != bank) {
1421 outb_p(NCT6775_REG_BANK, data->addr + ADDR_REG_OFFSET);
1422 outb_p(bank, data->addr + DATA_REG_OFFSET);
1423 data->bank = bank;
1424 }
1425 }
1426
nct6775_read_value(struct nct6775_data * data,u16 reg)1427 static u16 nct6775_read_value(struct nct6775_data *data, u16 reg)
1428 {
1429 int res, word_sized = is_word_sized(data, reg);
1430
1431 nct6775_set_bank(data, reg);
1432 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
1433 res = inb_p(data->addr + DATA_REG_OFFSET);
1434 if (word_sized) {
1435 outb_p((reg & 0xff) + 1,
1436 data->addr + ADDR_REG_OFFSET);
1437 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET);
1438 }
1439 return res;
1440 }
1441
nct6775_write_value(struct nct6775_data * data,u16 reg,u16 value)1442 static int nct6775_write_value(struct nct6775_data *data, u16 reg, u16 value)
1443 {
1444 int word_sized = is_word_sized(data, reg);
1445
1446 nct6775_set_bank(data, reg);
1447 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET);
1448 if (word_sized) {
1449 outb_p(value >> 8, data->addr + DATA_REG_OFFSET);
1450 outb_p((reg & 0xff) + 1,
1451 data->addr + ADDR_REG_OFFSET);
1452 }
1453 outb_p(value & 0xff, data->addr + DATA_REG_OFFSET);
1454 return 0;
1455 }
1456
1457 /* We left-align 8-bit temperature values to make the code simpler */
nct6775_read_temp(struct nct6775_data * data,u16 reg)1458 static u16 nct6775_read_temp(struct nct6775_data *data, u16 reg)
1459 {
1460 u16 res;
1461
1462 res = nct6775_read_value(data, reg);
1463 if (!is_word_sized(data, reg))
1464 res <<= 8;
1465
1466 return res;
1467 }
1468
nct6775_write_temp(struct nct6775_data * data,u16 reg,u16 value)1469 static int nct6775_write_temp(struct nct6775_data *data, u16 reg, u16 value)
1470 {
1471 if (!is_word_sized(data, reg))
1472 value >>= 8;
1473 return nct6775_write_value(data, reg, value);
1474 }
1475
1476 /* This function assumes that the caller holds data->update_lock */
nct6775_write_fan_div(struct nct6775_data * data,int nr)1477 static void nct6775_write_fan_div(struct nct6775_data *data, int nr)
1478 {
1479 u8 reg;
1480
1481 switch (nr) {
1482 case 0:
1483 reg = (nct6775_read_value(data, NCT6775_REG_FANDIV1) & 0x70)
1484 | (data->fan_div[0] & 0x7);
1485 nct6775_write_value(data, NCT6775_REG_FANDIV1, reg);
1486 break;
1487 case 1:
1488 reg = (nct6775_read_value(data, NCT6775_REG_FANDIV1) & 0x7)
1489 | ((data->fan_div[1] << 4) & 0x70);
1490 nct6775_write_value(data, NCT6775_REG_FANDIV1, reg);
1491 break;
1492 case 2:
1493 reg = (nct6775_read_value(data, NCT6775_REG_FANDIV2) & 0x70)
1494 | (data->fan_div[2] & 0x7);
1495 nct6775_write_value(data, NCT6775_REG_FANDIV2, reg);
1496 break;
1497 case 3:
1498 reg = (nct6775_read_value(data, NCT6775_REG_FANDIV2) & 0x7)
1499 | ((data->fan_div[3] << 4) & 0x70);
1500 nct6775_write_value(data, NCT6775_REG_FANDIV2, reg);
1501 break;
1502 }
1503 }
1504
nct6775_write_fan_div_common(struct nct6775_data * data,int nr)1505 static void nct6775_write_fan_div_common(struct nct6775_data *data, int nr)
1506 {
1507 if (data->kind == nct6775)
1508 nct6775_write_fan_div(data, nr);
1509 }
1510
nct6775_update_fan_div(struct nct6775_data * data)1511 static void nct6775_update_fan_div(struct nct6775_data *data)
1512 {
1513 u8 i;
1514
1515 i = nct6775_read_value(data, NCT6775_REG_FANDIV1);
1516 data->fan_div[0] = i & 0x7;
1517 data->fan_div[1] = (i & 0x70) >> 4;
1518 i = nct6775_read_value(data, NCT6775_REG_FANDIV2);
1519 data->fan_div[2] = i & 0x7;
1520 if (data->has_fan & BIT(3))
1521 data->fan_div[3] = (i & 0x70) >> 4;
1522 }
1523
nct6775_update_fan_div_common(struct nct6775_data * data)1524 static void nct6775_update_fan_div_common(struct nct6775_data *data)
1525 {
1526 if (data->kind == nct6775)
1527 nct6775_update_fan_div(data);
1528 }
1529
nct6775_init_fan_div(struct nct6775_data * data)1530 static void nct6775_init_fan_div(struct nct6775_data *data)
1531 {
1532 int i;
1533
1534 nct6775_update_fan_div_common(data);
1535 /*
1536 * For all fans, start with highest divider value if the divider
1537 * register is not initialized. This ensures that we get a
1538 * reading from the fan count register, even if it is not optimal.
1539 * We'll compute a better divider later on.
1540 */
1541 for (i = 0; i < ARRAY_SIZE(data->fan_div); i++) {
1542 if (!(data->has_fan & BIT(i)))
1543 continue;
1544 if (data->fan_div[i] == 0) {
1545 data->fan_div[i] = 7;
1546 nct6775_write_fan_div_common(data, i);
1547 }
1548 }
1549 }
1550
nct6775_init_fan_common(struct device * dev,struct nct6775_data * data)1551 static void nct6775_init_fan_common(struct device *dev,
1552 struct nct6775_data *data)
1553 {
1554 int i;
1555 u8 reg;
1556
1557 if (data->has_fan_div)
1558 nct6775_init_fan_div(data);
1559
1560 /*
1561 * If fan_min is not set (0), set it to 0xff to disable it. This
1562 * prevents the unnecessary warning when fanX_min is reported as 0.
1563 */
1564 for (i = 0; i < ARRAY_SIZE(data->fan_min); i++) {
1565 if (data->has_fan_min & BIT(i)) {
1566 reg = nct6775_read_value(data, data->REG_FAN_MIN[i]);
1567 if (!reg)
1568 nct6775_write_value(data, data->REG_FAN_MIN[i],
1569 data->has_fan_div ? 0xff
1570 : 0xff1f);
1571 }
1572 }
1573 }
1574
nct6775_select_fan_div(struct device * dev,struct nct6775_data * data,int nr,u16 reg)1575 static void nct6775_select_fan_div(struct device *dev,
1576 struct nct6775_data *data, int nr, u16 reg)
1577 {
1578 u8 fan_div = data->fan_div[nr];
1579 u16 fan_min;
1580
1581 if (!data->has_fan_div)
1582 return;
1583
1584 /*
1585 * If we failed to measure the fan speed, or the reported value is not
1586 * in the optimal range, and the clock divider can be modified,
1587 * let's try that for next time.
1588 */
1589 if (reg == 0x00 && fan_div < 0x07)
1590 fan_div++;
1591 else if (reg != 0x00 && reg < 0x30 && fan_div > 0)
1592 fan_div--;
1593
1594 if (fan_div != data->fan_div[nr]) {
1595 dev_dbg(dev, "Modifying fan%d clock divider from %u to %u\n",
1596 nr + 1, div_from_reg(data->fan_div[nr]),
1597 div_from_reg(fan_div));
1598
1599 /* Preserve min limit if possible */
1600 if (data->has_fan_min & BIT(nr)) {
1601 fan_min = data->fan_min[nr];
1602 if (fan_div > data->fan_div[nr]) {
1603 if (fan_min != 255 && fan_min > 1)
1604 fan_min >>= 1;
1605 } else {
1606 if (fan_min != 255) {
1607 fan_min <<= 1;
1608 if (fan_min > 254)
1609 fan_min = 254;
1610 }
1611 }
1612 if (fan_min != data->fan_min[nr]) {
1613 data->fan_min[nr] = fan_min;
1614 nct6775_write_value(data, data->REG_FAN_MIN[nr],
1615 fan_min);
1616 }
1617 }
1618 data->fan_div[nr] = fan_div;
1619 nct6775_write_fan_div_common(data, nr);
1620 }
1621 }
1622
nct6775_update_pwm(struct device * dev)1623 static void nct6775_update_pwm(struct device *dev)
1624 {
1625 struct nct6775_data *data = dev_get_drvdata(dev);
1626 int i, j;
1627 int fanmodecfg, reg;
1628 bool duty_is_dc;
1629
1630 for (i = 0; i < data->pwm_num; i++) {
1631 if (!(data->has_pwm & BIT(i)))
1632 continue;
1633
1634 duty_is_dc = data->REG_PWM_MODE[i] &&
1635 (nct6775_read_value(data, data->REG_PWM_MODE[i])
1636 & data->PWM_MODE_MASK[i]);
1637 data->pwm_mode[i] = !duty_is_dc;
1638
1639 fanmodecfg = nct6775_read_value(data, data->REG_FAN_MODE[i]);
1640 for (j = 0; j < ARRAY_SIZE(data->REG_PWM); j++) {
1641 if (data->REG_PWM[j] && data->REG_PWM[j][i]) {
1642 data->pwm[j][i]
1643 = nct6775_read_value(data,
1644 data->REG_PWM[j][i]);
1645 }
1646 }
1647
1648 data->pwm_enable[i] = reg_to_pwm_enable(data->pwm[0][i],
1649 (fanmodecfg >> 4) & 7);
1650
1651 if (!data->temp_tolerance[0][i] ||
1652 data->pwm_enable[i] != speed_cruise)
1653 data->temp_tolerance[0][i] = fanmodecfg & 0x0f;
1654 if (!data->target_speed_tolerance[i] ||
1655 data->pwm_enable[i] == speed_cruise) {
1656 u8 t = fanmodecfg & 0x0f;
1657
1658 if (data->REG_TOLERANCE_H) {
1659 t |= (nct6775_read_value(data,
1660 data->REG_TOLERANCE_H[i]) & 0x70) >> 1;
1661 }
1662 data->target_speed_tolerance[i] = t;
1663 }
1664
1665 data->temp_tolerance[1][i] =
1666 nct6775_read_value(data,
1667 data->REG_CRITICAL_TEMP_TOLERANCE[i]);
1668
1669 reg = nct6775_read_value(data, data->REG_TEMP_SEL[i]);
1670 data->pwm_temp_sel[i] = reg & 0x1f;
1671 /* If fan can stop, report floor as 0 */
1672 if (reg & 0x80)
1673 data->pwm[2][i] = 0;
1674
1675 if (!data->REG_WEIGHT_TEMP_SEL[i])
1676 continue;
1677
1678 reg = nct6775_read_value(data, data->REG_WEIGHT_TEMP_SEL[i]);
1679 data->pwm_weight_temp_sel[i] = reg & 0x1f;
1680 /* If weight is disabled, report weight source as 0 */
1681 if (!(reg & 0x80))
1682 data->pwm_weight_temp_sel[i] = 0;
1683
1684 /* Weight temp data */
1685 for (j = 0; j < ARRAY_SIZE(data->weight_temp); j++) {
1686 data->weight_temp[j][i]
1687 = nct6775_read_value(data,
1688 data->REG_WEIGHT_TEMP[j][i]);
1689 }
1690 }
1691 }
1692
nct6775_update_pwm_limits(struct device * dev)1693 static void nct6775_update_pwm_limits(struct device *dev)
1694 {
1695 struct nct6775_data *data = dev_get_drvdata(dev);
1696 int i, j;
1697 u8 reg;
1698 u16 reg_t;
1699
1700 for (i = 0; i < data->pwm_num; i++) {
1701 if (!(data->has_pwm & BIT(i)))
1702 continue;
1703
1704 for (j = 0; j < ARRAY_SIZE(data->fan_time); j++) {
1705 data->fan_time[j][i] =
1706 nct6775_read_value(data, data->REG_FAN_TIME[j][i]);
1707 }
1708
1709 reg_t = nct6775_read_value(data, data->REG_TARGET[i]);
1710 /* Update only in matching mode or if never updated */
1711 if (!data->target_temp[i] ||
1712 data->pwm_enable[i] == thermal_cruise)
1713 data->target_temp[i] = reg_t & data->target_temp_mask;
1714 if (!data->target_speed[i] ||
1715 data->pwm_enable[i] == speed_cruise) {
1716 if (data->REG_TOLERANCE_H) {
1717 reg_t |= (nct6775_read_value(data,
1718 data->REG_TOLERANCE_H[i]) & 0x0f) << 8;
1719 }
1720 data->target_speed[i] = reg_t;
1721 }
1722
1723 for (j = 0; j < data->auto_pwm_num; j++) {
1724 data->auto_pwm[i][j] =
1725 nct6775_read_value(data,
1726 NCT6775_AUTO_PWM(data, i, j));
1727 data->auto_temp[i][j] =
1728 nct6775_read_value(data,
1729 NCT6775_AUTO_TEMP(data, i, j));
1730 }
1731
1732 /* critical auto_pwm temperature data */
1733 data->auto_temp[i][data->auto_pwm_num] =
1734 nct6775_read_value(data, data->REG_CRITICAL_TEMP[i]);
1735
1736 switch (data->kind) {
1737 case nct6775:
1738 reg = nct6775_read_value(data,
1739 NCT6775_REG_CRITICAL_ENAB[i]);
1740 data->auto_pwm[i][data->auto_pwm_num] =
1741 (reg & 0x02) ? 0xff : 0x00;
1742 break;
1743 case nct6776:
1744 data->auto_pwm[i][data->auto_pwm_num] = 0xff;
1745 break;
1746 case nct6106:
1747 case nct6116:
1748 case nct6779:
1749 case nct6791:
1750 case nct6792:
1751 case nct6793:
1752 case nct6795:
1753 case nct6796:
1754 case nct6797:
1755 case nct6798:
1756 reg = nct6775_read_value(data,
1757 data->REG_CRITICAL_PWM_ENABLE[i]);
1758 if (reg & data->CRITICAL_PWM_ENABLE_MASK)
1759 reg = nct6775_read_value(data,
1760 data->REG_CRITICAL_PWM[i]);
1761 else
1762 reg = 0xff;
1763 data->auto_pwm[i][data->auto_pwm_num] = reg;
1764 break;
1765 }
1766 }
1767 }
1768
nct6775_update_device(struct device * dev)1769 static struct nct6775_data *nct6775_update_device(struct device *dev)
1770 {
1771 struct nct6775_data *data = dev_get_drvdata(dev);
1772 int i, j;
1773
1774 mutex_lock(&data->update_lock);
1775
1776 if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
1777 || !data->valid) {
1778 /* Fan clock dividers */
1779 nct6775_update_fan_div_common(data);
1780
1781 /* Measured voltages and limits */
1782 for (i = 0; i < data->in_num; i++) {
1783 if (!(data->have_in & BIT(i)))
1784 continue;
1785
1786 data->in[i][0] = nct6775_read_value(data,
1787 data->REG_VIN[i]);
1788 data->in[i][1] = nct6775_read_value(data,
1789 data->REG_IN_MINMAX[0][i]);
1790 data->in[i][2] = nct6775_read_value(data,
1791 data->REG_IN_MINMAX[1][i]);
1792 }
1793
1794 /* Measured fan speeds and limits */
1795 for (i = 0; i < ARRAY_SIZE(data->rpm); i++) {
1796 u16 reg;
1797
1798 if (!(data->has_fan & BIT(i)))
1799 continue;
1800
1801 reg = nct6775_read_value(data, data->REG_FAN[i]);
1802 data->rpm[i] = data->fan_from_reg(reg,
1803 data->fan_div[i]);
1804
1805 if (data->has_fan_min & BIT(i))
1806 data->fan_min[i] = nct6775_read_value(data,
1807 data->REG_FAN_MIN[i]);
1808
1809 if (data->REG_FAN_PULSES[i]) {
1810 data->fan_pulses[i] =
1811 (nct6775_read_value(data,
1812 data->REG_FAN_PULSES[i])
1813 >> data->FAN_PULSE_SHIFT[i]) & 0x03;
1814 }
1815
1816 nct6775_select_fan_div(dev, data, i, reg);
1817 }
1818
1819 nct6775_update_pwm(dev);
1820 nct6775_update_pwm_limits(dev);
1821
1822 /* Measured temperatures and limits */
1823 for (i = 0; i < NUM_TEMP; i++) {
1824 if (!(data->have_temp & BIT(i)))
1825 continue;
1826 for (j = 0; j < ARRAY_SIZE(data->reg_temp); j++) {
1827 if (data->reg_temp[j][i])
1828 data->temp[j][i]
1829 = nct6775_read_temp(data,
1830 data->reg_temp[j][i]);
1831 }
1832 if (i >= NUM_TEMP_FIXED ||
1833 !(data->have_temp_fixed & BIT(i)))
1834 continue;
1835 data->temp_offset[i]
1836 = nct6775_read_value(data, data->REG_TEMP_OFFSET[i]);
1837 }
1838
1839 data->alarms = 0;
1840 for (i = 0; i < NUM_REG_ALARM; i++) {
1841 u8 alarm;
1842
1843 if (!data->REG_ALARM[i])
1844 continue;
1845 alarm = nct6775_read_value(data, data->REG_ALARM[i]);
1846 data->alarms |= ((u64)alarm) << (i << 3);
1847 }
1848
1849 data->beeps = 0;
1850 for (i = 0; i < NUM_REG_BEEP; i++) {
1851 u8 beep;
1852
1853 if (!data->REG_BEEP[i])
1854 continue;
1855 beep = nct6775_read_value(data, data->REG_BEEP[i]);
1856 data->beeps |= ((u64)beep) << (i << 3);
1857 }
1858
1859 data->last_updated = jiffies;
1860 data->valid = true;
1861 }
1862
1863 mutex_unlock(&data->update_lock);
1864 return data;
1865 }
1866
1867 /*
1868 * Sysfs callback functions
1869 */
1870 static ssize_t
show_in_reg(struct device * dev,struct device_attribute * attr,char * buf)1871 show_in_reg(struct device *dev, struct device_attribute *attr, char *buf)
1872 {
1873 struct nct6775_data *data = nct6775_update_device(dev);
1874 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
1875 int index = sattr->index;
1876 int nr = sattr->nr;
1877
1878 return sprintf(buf, "%ld\n", in_from_reg(data->in[nr][index], nr));
1879 }
1880
1881 static ssize_t
store_in_reg(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1882 store_in_reg(struct device *dev, struct device_attribute *attr, const char *buf,
1883 size_t count)
1884 {
1885 struct nct6775_data *data = dev_get_drvdata(dev);
1886 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
1887 int index = sattr->index;
1888 int nr = sattr->nr;
1889 unsigned long val;
1890 int err;
1891
1892 err = kstrtoul(buf, 10, &val);
1893 if (err < 0)
1894 return err;
1895 mutex_lock(&data->update_lock);
1896 data->in[nr][index] = in_to_reg(val, nr);
1897 nct6775_write_value(data, data->REG_IN_MINMAX[index - 1][nr],
1898 data->in[nr][index]);
1899 mutex_unlock(&data->update_lock);
1900 return count;
1901 }
1902
1903 static ssize_t
show_alarm(struct device * dev,struct device_attribute * attr,char * buf)1904 show_alarm(struct device *dev, struct device_attribute *attr, char *buf)
1905 {
1906 struct nct6775_data *data = nct6775_update_device(dev);
1907 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
1908 int nr = data->ALARM_BITS[sattr->index];
1909
1910 return sprintf(buf, "%u\n",
1911 (unsigned int)((data->alarms >> nr) & 0x01));
1912 }
1913
find_temp_source(struct nct6775_data * data,int index,int count)1914 static int find_temp_source(struct nct6775_data *data, int index, int count)
1915 {
1916 int source = data->temp_src[index];
1917 int nr;
1918
1919 for (nr = 0; nr < count; nr++) {
1920 int src;
1921
1922 src = nct6775_read_value(data,
1923 data->REG_TEMP_SOURCE[nr]) & 0x1f;
1924 if (src == source)
1925 return nr;
1926 }
1927 return -ENODEV;
1928 }
1929
1930 static ssize_t
show_temp_alarm(struct device * dev,struct device_attribute * attr,char * buf)1931 show_temp_alarm(struct device *dev, struct device_attribute *attr, char *buf)
1932 {
1933 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
1934 struct nct6775_data *data = nct6775_update_device(dev);
1935 unsigned int alarm = 0;
1936 int nr;
1937
1938 /*
1939 * For temperatures, there is no fixed mapping from registers to alarm
1940 * bits. Alarm bits are determined by the temperature source mapping.
1941 */
1942 nr = find_temp_source(data, sattr->index, data->num_temp_alarms);
1943 if (nr >= 0) {
1944 int bit = data->ALARM_BITS[nr + TEMP_ALARM_BASE];
1945
1946 alarm = (data->alarms >> bit) & 0x01;
1947 }
1948 return sprintf(buf, "%u\n", alarm);
1949 }
1950
1951 static ssize_t
show_beep(struct device * dev,struct device_attribute * attr,char * buf)1952 show_beep(struct device *dev, struct device_attribute *attr, char *buf)
1953 {
1954 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
1955 struct nct6775_data *data = nct6775_update_device(dev);
1956 int nr = data->BEEP_BITS[sattr->index];
1957
1958 return sprintf(buf, "%u\n",
1959 (unsigned int)((data->beeps >> nr) & 0x01));
1960 }
1961
1962 static ssize_t
store_beep(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1963 store_beep(struct device *dev, struct device_attribute *attr, const char *buf,
1964 size_t count)
1965 {
1966 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
1967 struct nct6775_data *data = dev_get_drvdata(dev);
1968 int nr = data->BEEP_BITS[sattr->index];
1969 int regindex = nr >> 3;
1970 unsigned long val;
1971 int err;
1972
1973 err = kstrtoul(buf, 10, &val);
1974 if (err < 0)
1975 return err;
1976 if (val > 1)
1977 return -EINVAL;
1978
1979 mutex_lock(&data->update_lock);
1980 if (val)
1981 data->beeps |= (1ULL << nr);
1982 else
1983 data->beeps &= ~(1ULL << nr);
1984 nct6775_write_value(data, data->REG_BEEP[regindex],
1985 (data->beeps >> (regindex << 3)) & 0xff);
1986 mutex_unlock(&data->update_lock);
1987 return count;
1988 }
1989
1990 static ssize_t
show_temp_beep(struct device * dev,struct device_attribute * attr,char * buf)1991 show_temp_beep(struct device *dev, struct device_attribute *attr, char *buf)
1992 {
1993 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
1994 struct nct6775_data *data = nct6775_update_device(dev);
1995 unsigned int beep = 0;
1996 int nr;
1997
1998 /*
1999 * For temperatures, there is no fixed mapping from registers to beep
2000 * enable bits. Beep enable bits are determined by the temperature
2001 * source mapping.
2002 */
2003 nr = find_temp_source(data, sattr->index, data->num_temp_beeps);
2004 if (nr >= 0) {
2005 int bit = data->BEEP_BITS[nr + TEMP_ALARM_BASE];
2006
2007 beep = (data->beeps >> bit) & 0x01;
2008 }
2009 return sprintf(buf, "%u\n", beep);
2010 }
2011
2012 static ssize_t
store_temp_beep(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2013 store_temp_beep(struct device *dev, struct device_attribute *attr,
2014 const char *buf, size_t count)
2015 {
2016 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2017 struct nct6775_data *data = dev_get_drvdata(dev);
2018 int nr, bit, regindex;
2019 unsigned long val;
2020 int err;
2021
2022 err = kstrtoul(buf, 10, &val);
2023 if (err < 0)
2024 return err;
2025 if (val > 1)
2026 return -EINVAL;
2027
2028 nr = find_temp_source(data, sattr->index, data->num_temp_beeps);
2029 if (nr < 0)
2030 return nr;
2031
2032 bit = data->BEEP_BITS[nr + TEMP_ALARM_BASE];
2033 regindex = bit >> 3;
2034
2035 mutex_lock(&data->update_lock);
2036 if (val)
2037 data->beeps |= (1ULL << bit);
2038 else
2039 data->beeps &= ~(1ULL << bit);
2040 nct6775_write_value(data, data->REG_BEEP[regindex],
2041 (data->beeps >> (regindex << 3)) & 0xff);
2042 mutex_unlock(&data->update_lock);
2043
2044 return count;
2045 }
2046
nct6775_in_is_visible(struct kobject * kobj,struct attribute * attr,int index)2047 static umode_t nct6775_in_is_visible(struct kobject *kobj,
2048 struct attribute *attr, int index)
2049 {
2050 struct device *dev = container_of(kobj, struct device, kobj);
2051 struct nct6775_data *data = dev_get_drvdata(dev);
2052 int in = index / 5; /* voltage index */
2053
2054 if (!(data->have_in & BIT(in)))
2055 return 0;
2056
2057 return attr->mode;
2058 }
2059
2060 SENSOR_TEMPLATE_2(in_input, "in%d_input", S_IRUGO, show_in_reg, NULL, 0, 0);
2061 SENSOR_TEMPLATE(in_alarm, "in%d_alarm", S_IRUGO, show_alarm, NULL, 0);
2062 SENSOR_TEMPLATE(in_beep, "in%d_beep", S_IWUSR | S_IRUGO, show_beep, store_beep,
2063 0);
2064 SENSOR_TEMPLATE_2(in_min, "in%d_min", S_IWUSR | S_IRUGO, show_in_reg,
2065 store_in_reg, 0, 1);
2066 SENSOR_TEMPLATE_2(in_max, "in%d_max", S_IWUSR | S_IRUGO, show_in_reg,
2067 store_in_reg, 0, 2);
2068
2069 /*
2070 * nct6775_in_is_visible uses the index into the following array
2071 * to determine if attributes should be created or not.
2072 * Any change in order or content must be matched.
2073 */
2074 static struct sensor_device_template *nct6775_attributes_in_template[] = {
2075 &sensor_dev_template_in_input,
2076 &sensor_dev_template_in_alarm,
2077 &sensor_dev_template_in_beep,
2078 &sensor_dev_template_in_min,
2079 &sensor_dev_template_in_max,
2080 NULL
2081 };
2082
2083 static const struct sensor_template_group nct6775_in_template_group = {
2084 .templates = nct6775_attributes_in_template,
2085 .is_visible = nct6775_in_is_visible,
2086 };
2087
2088 static ssize_t
show_fan(struct device * dev,struct device_attribute * attr,char * buf)2089 show_fan(struct device *dev, struct device_attribute *attr, char *buf)
2090 {
2091 struct nct6775_data *data = nct6775_update_device(dev);
2092 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2093 int nr = sattr->index;
2094
2095 return sprintf(buf, "%d\n", data->rpm[nr]);
2096 }
2097
2098 static ssize_t
show_fan_min(struct device * dev,struct device_attribute * attr,char * buf)2099 show_fan_min(struct device *dev, struct device_attribute *attr, char *buf)
2100 {
2101 struct nct6775_data *data = nct6775_update_device(dev);
2102 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2103 int nr = sattr->index;
2104
2105 return sprintf(buf, "%d\n",
2106 data->fan_from_reg_min(data->fan_min[nr],
2107 data->fan_div[nr]));
2108 }
2109
2110 static ssize_t
show_fan_div(struct device * dev,struct device_attribute * attr,char * buf)2111 show_fan_div(struct device *dev, struct device_attribute *attr, char *buf)
2112 {
2113 struct nct6775_data *data = nct6775_update_device(dev);
2114 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2115 int nr = sattr->index;
2116
2117 return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr]));
2118 }
2119
2120 static ssize_t
store_fan_min(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2121 store_fan_min(struct device *dev, struct device_attribute *attr,
2122 const char *buf, size_t count)
2123 {
2124 struct nct6775_data *data = dev_get_drvdata(dev);
2125 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2126 int nr = sattr->index;
2127 unsigned long val;
2128 unsigned int reg;
2129 u8 new_div;
2130 int err;
2131
2132 err = kstrtoul(buf, 10, &val);
2133 if (err < 0)
2134 return err;
2135
2136 mutex_lock(&data->update_lock);
2137 if (!data->has_fan_div) {
2138 /* NCT6776F or NCT6779D; we know this is a 13 bit register */
2139 if (!val) {
2140 val = 0xff1f;
2141 } else {
2142 if (val > 1350000U)
2143 val = 135000U;
2144 val = 1350000U / val;
2145 val = (val & 0x1f) | ((val << 3) & 0xff00);
2146 }
2147 data->fan_min[nr] = val;
2148 goto write_min; /* Leave fan divider alone */
2149 }
2150 if (!val) {
2151 /* No min limit, alarm disabled */
2152 data->fan_min[nr] = 255;
2153 new_div = data->fan_div[nr]; /* No change */
2154 dev_info(dev, "fan%u low limit and alarm disabled\n", nr + 1);
2155 goto write_div;
2156 }
2157 reg = 1350000U / val;
2158 if (reg >= 128 * 255) {
2159 /*
2160 * Speed below this value cannot possibly be represented,
2161 * even with the highest divider (128)
2162 */
2163 data->fan_min[nr] = 254;
2164 new_div = 7; /* 128 == BIT(7) */
2165 dev_warn(dev,
2166 "fan%u low limit %lu below minimum %u, set to minimum\n",
2167 nr + 1, val, data->fan_from_reg_min(254, 7));
2168 } else if (!reg) {
2169 /*
2170 * Speed above this value cannot possibly be represented,
2171 * even with the lowest divider (1)
2172 */
2173 data->fan_min[nr] = 1;
2174 new_div = 0; /* 1 == BIT(0) */
2175 dev_warn(dev,
2176 "fan%u low limit %lu above maximum %u, set to maximum\n",
2177 nr + 1, val, data->fan_from_reg_min(1, 0));
2178 } else {
2179 /*
2180 * Automatically pick the best divider, i.e. the one such
2181 * that the min limit will correspond to a register value
2182 * in the 96..192 range
2183 */
2184 new_div = 0;
2185 while (reg > 192 && new_div < 7) {
2186 reg >>= 1;
2187 new_div++;
2188 }
2189 data->fan_min[nr] = reg;
2190 }
2191
2192 write_div:
2193 /*
2194 * Write both the fan clock divider (if it changed) and the new
2195 * fan min (unconditionally)
2196 */
2197 if (new_div != data->fan_div[nr]) {
2198 dev_dbg(dev, "fan%u clock divider changed from %u to %u\n",
2199 nr + 1, div_from_reg(data->fan_div[nr]),
2200 div_from_reg(new_div));
2201 data->fan_div[nr] = new_div;
2202 nct6775_write_fan_div_common(data, nr);
2203 /* Give the chip time to sample a new speed value */
2204 data->last_updated = jiffies;
2205 }
2206
2207 write_min:
2208 nct6775_write_value(data, data->REG_FAN_MIN[nr], data->fan_min[nr]);
2209 mutex_unlock(&data->update_lock);
2210
2211 return count;
2212 }
2213
2214 static ssize_t
show_fan_pulses(struct device * dev,struct device_attribute * attr,char * buf)2215 show_fan_pulses(struct device *dev, struct device_attribute *attr, char *buf)
2216 {
2217 struct nct6775_data *data = nct6775_update_device(dev);
2218 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2219 int p = data->fan_pulses[sattr->index];
2220
2221 return sprintf(buf, "%d\n", p ? : 4);
2222 }
2223
2224 static ssize_t
store_fan_pulses(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2225 store_fan_pulses(struct device *dev, struct device_attribute *attr,
2226 const char *buf, size_t count)
2227 {
2228 struct nct6775_data *data = dev_get_drvdata(dev);
2229 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2230 int nr = sattr->index;
2231 unsigned long val;
2232 int err;
2233 u8 reg;
2234
2235 err = kstrtoul(buf, 10, &val);
2236 if (err < 0)
2237 return err;
2238
2239 if (val > 4)
2240 return -EINVAL;
2241
2242 mutex_lock(&data->update_lock);
2243 data->fan_pulses[nr] = val & 3;
2244 reg = nct6775_read_value(data, data->REG_FAN_PULSES[nr]);
2245 reg &= ~(0x03 << data->FAN_PULSE_SHIFT[nr]);
2246 reg |= (val & 3) << data->FAN_PULSE_SHIFT[nr];
2247 nct6775_write_value(data, data->REG_FAN_PULSES[nr], reg);
2248 mutex_unlock(&data->update_lock);
2249
2250 return count;
2251 }
2252
nct6775_fan_is_visible(struct kobject * kobj,struct attribute * attr,int index)2253 static umode_t nct6775_fan_is_visible(struct kobject *kobj,
2254 struct attribute *attr, int index)
2255 {
2256 struct device *dev = container_of(kobj, struct device, kobj);
2257 struct nct6775_data *data = dev_get_drvdata(dev);
2258 int fan = index / 6; /* fan index */
2259 int nr = index % 6; /* attribute index */
2260
2261 if (!(data->has_fan & BIT(fan)))
2262 return 0;
2263
2264 if (nr == 1 && data->ALARM_BITS[FAN_ALARM_BASE + fan] == -1)
2265 return 0;
2266 if (nr == 2 && data->BEEP_BITS[FAN_ALARM_BASE + fan] == -1)
2267 return 0;
2268 if (nr == 3 && !data->REG_FAN_PULSES[fan])
2269 return 0;
2270 if (nr == 4 && !(data->has_fan_min & BIT(fan)))
2271 return 0;
2272 if (nr == 5 && data->kind != nct6775)
2273 return 0;
2274
2275 return attr->mode;
2276 }
2277
2278 SENSOR_TEMPLATE(fan_input, "fan%d_input", S_IRUGO, show_fan, NULL, 0);
2279 SENSOR_TEMPLATE(fan_alarm, "fan%d_alarm", S_IRUGO, show_alarm, NULL,
2280 FAN_ALARM_BASE);
2281 SENSOR_TEMPLATE(fan_beep, "fan%d_beep", S_IWUSR | S_IRUGO, show_beep,
2282 store_beep, FAN_ALARM_BASE);
2283 SENSOR_TEMPLATE(fan_pulses, "fan%d_pulses", S_IWUSR | S_IRUGO, show_fan_pulses,
2284 store_fan_pulses, 0);
2285 SENSOR_TEMPLATE(fan_min, "fan%d_min", S_IWUSR | S_IRUGO, show_fan_min,
2286 store_fan_min, 0);
2287 SENSOR_TEMPLATE(fan_div, "fan%d_div", S_IRUGO, show_fan_div, NULL, 0);
2288
2289 /*
2290 * nct6775_fan_is_visible uses the index into the following array
2291 * to determine if attributes should be created or not.
2292 * Any change in order or content must be matched.
2293 */
2294 static struct sensor_device_template *nct6775_attributes_fan_template[] = {
2295 &sensor_dev_template_fan_input,
2296 &sensor_dev_template_fan_alarm, /* 1 */
2297 &sensor_dev_template_fan_beep, /* 2 */
2298 &sensor_dev_template_fan_pulses,
2299 &sensor_dev_template_fan_min, /* 4 */
2300 &sensor_dev_template_fan_div, /* 5 */
2301 NULL
2302 };
2303
2304 static const struct sensor_template_group nct6775_fan_template_group = {
2305 .templates = nct6775_attributes_fan_template,
2306 .is_visible = nct6775_fan_is_visible,
2307 .base = 1,
2308 };
2309
2310 static ssize_t
show_temp_label(struct device * dev,struct device_attribute * attr,char * buf)2311 show_temp_label(struct device *dev, struct device_attribute *attr, char *buf)
2312 {
2313 struct nct6775_data *data = nct6775_update_device(dev);
2314 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2315 int nr = sattr->index;
2316
2317 return sprintf(buf, "%s\n", data->temp_label[data->temp_src[nr]]);
2318 }
2319
2320 static ssize_t
show_temp(struct device * dev,struct device_attribute * attr,char * buf)2321 show_temp(struct device *dev, struct device_attribute *attr, char *buf)
2322 {
2323 struct nct6775_data *data = nct6775_update_device(dev);
2324 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2325 int nr = sattr->nr;
2326 int index = sattr->index;
2327
2328 return sprintf(buf, "%d\n", LM75_TEMP_FROM_REG(data->temp[index][nr]));
2329 }
2330
2331 static ssize_t
store_temp(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2332 store_temp(struct device *dev, struct device_attribute *attr, const char *buf,
2333 size_t count)
2334 {
2335 struct nct6775_data *data = dev_get_drvdata(dev);
2336 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2337 int nr = sattr->nr;
2338 int index = sattr->index;
2339 int err;
2340 long val;
2341
2342 err = kstrtol(buf, 10, &val);
2343 if (err < 0)
2344 return err;
2345
2346 mutex_lock(&data->update_lock);
2347 data->temp[index][nr] = LM75_TEMP_TO_REG(val);
2348 nct6775_write_temp(data, data->reg_temp[index][nr],
2349 data->temp[index][nr]);
2350 mutex_unlock(&data->update_lock);
2351 return count;
2352 }
2353
2354 static ssize_t
show_temp_offset(struct device * dev,struct device_attribute * attr,char * buf)2355 show_temp_offset(struct device *dev, struct device_attribute *attr, char *buf)
2356 {
2357 struct nct6775_data *data = nct6775_update_device(dev);
2358 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2359
2360 return sprintf(buf, "%d\n", data->temp_offset[sattr->index] * 1000);
2361 }
2362
2363 static ssize_t
store_temp_offset(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2364 store_temp_offset(struct device *dev, struct device_attribute *attr,
2365 const char *buf, size_t count)
2366 {
2367 struct nct6775_data *data = dev_get_drvdata(dev);
2368 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2369 int nr = sattr->index;
2370 long val;
2371 int err;
2372
2373 err = kstrtol(buf, 10, &val);
2374 if (err < 0)
2375 return err;
2376
2377 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), -128, 127);
2378
2379 mutex_lock(&data->update_lock);
2380 data->temp_offset[nr] = val;
2381 nct6775_write_value(data, data->REG_TEMP_OFFSET[nr], val);
2382 mutex_unlock(&data->update_lock);
2383
2384 return count;
2385 }
2386
2387 static ssize_t
show_temp_type(struct device * dev,struct device_attribute * attr,char * buf)2388 show_temp_type(struct device *dev, struct device_attribute *attr, char *buf)
2389 {
2390 struct nct6775_data *data = nct6775_update_device(dev);
2391 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2392 int nr = sattr->index;
2393
2394 return sprintf(buf, "%d\n", (int)data->temp_type[nr]);
2395 }
2396
2397 static ssize_t
store_temp_type(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2398 store_temp_type(struct device *dev, struct device_attribute *attr,
2399 const char *buf, size_t count)
2400 {
2401 struct nct6775_data *data = nct6775_update_device(dev);
2402 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2403 int nr = sattr->index;
2404 unsigned long val;
2405 int err;
2406 u8 vbat, diode, vbit, dbit;
2407
2408 err = kstrtoul(buf, 10, &val);
2409 if (err < 0)
2410 return err;
2411
2412 if (val != 1 && val != 3 && val != 4)
2413 return -EINVAL;
2414
2415 mutex_lock(&data->update_lock);
2416
2417 data->temp_type[nr] = val;
2418 vbit = 0x02 << nr;
2419 dbit = data->DIODE_MASK << nr;
2420 vbat = nct6775_read_value(data, data->REG_VBAT) & ~vbit;
2421 diode = nct6775_read_value(data, data->REG_DIODE) & ~dbit;
2422 switch (val) {
2423 case 1: /* CPU diode (diode, current mode) */
2424 vbat |= vbit;
2425 diode |= dbit;
2426 break;
2427 case 3: /* diode, voltage mode */
2428 vbat |= dbit;
2429 break;
2430 case 4: /* thermistor */
2431 break;
2432 }
2433 nct6775_write_value(data, data->REG_VBAT, vbat);
2434 nct6775_write_value(data, data->REG_DIODE, diode);
2435
2436 mutex_unlock(&data->update_lock);
2437 return count;
2438 }
2439
nct6775_temp_is_visible(struct kobject * kobj,struct attribute * attr,int index)2440 static umode_t nct6775_temp_is_visible(struct kobject *kobj,
2441 struct attribute *attr, int index)
2442 {
2443 struct device *dev = container_of(kobj, struct device, kobj);
2444 struct nct6775_data *data = dev_get_drvdata(dev);
2445 int temp = index / 10; /* temp index */
2446 int nr = index % 10; /* attribute index */
2447
2448 if (!(data->have_temp & BIT(temp)))
2449 return 0;
2450
2451 if (nr == 1 && !data->temp_label)
2452 return 0;
2453
2454 if (nr == 2 && find_temp_source(data, temp, data->num_temp_alarms) < 0)
2455 return 0; /* alarm */
2456
2457 if (nr == 3 && find_temp_source(data, temp, data->num_temp_beeps) < 0)
2458 return 0; /* beep */
2459
2460 if (nr == 4 && !data->reg_temp[1][temp]) /* max */
2461 return 0;
2462
2463 if (nr == 5 && !data->reg_temp[2][temp]) /* max_hyst */
2464 return 0;
2465
2466 if (nr == 6 && !data->reg_temp[3][temp]) /* crit */
2467 return 0;
2468
2469 if (nr == 7 && !data->reg_temp[4][temp]) /* lcrit */
2470 return 0;
2471
2472 /* offset and type only apply to fixed sensors */
2473 if (nr > 7 && !(data->have_temp_fixed & BIT(temp)))
2474 return 0;
2475
2476 return attr->mode;
2477 }
2478
2479 SENSOR_TEMPLATE_2(temp_input, "temp%d_input", S_IRUGO, show_temp, NULL, 0, 0);
2480 SENSOR_TEMPLATE(temp_label, "temp%d_label", S_IRUGO, show_temp_label, NULL, 0);
2481 SENSOR_TEMPLATE_2(temp_max, "temp%d_max", S_IRUGO | S_IWUSR, show_temp,
2482 store_temp, 0, 1);
2483 SENSOR_TEMPLATE_2(temp_max_hyst, "temp%d_max_hyst", S_IRUGO | S_IWUSR,
2484 show_temp, store_temp, 0, 2);
2485 SENSOR_TEMPLATE_2(temp_crit, "temp%d_crit", S_IRUGO | S_IWUSR, show_temp,
2486 store_temp, 0, 3);
2487 SENSOR_TEMPLATE_2(temp_lcrit, "temp%d_lcrit", S_IRUGO | S_IWUSR, show_temp,
2488 store_temp, 0, 4);
2489 SENSOR_TEMPLATE(temp_offset, "temp%d_offset", S_IRUGO | S_IWUSR,
2490 show_temp_offset, store_temp_offset, 0);
2491 SENSOR_TEMPLATE(temp_type, "temp%d_type", S_IRUGO | S_IWUSR, show_temp_type,
2492 store_temp_type, 0);
2493 SENSOR_TEMPLATE(temp_alarm, "temp%d_alarm", S_IRUGO, show_temp_alarm, NULL, 0);
2494 SENSOR_TEMPLATE(temp_beep, "temp%d_beep", S_IRUGO | S_IWUSR, show_temp_beep,
2495 store_temp_beep, 0);
2496
2497 /*
2498 * nct6775_temp_is_visible uses the index into the following array
2499 * to determine if attributes should be created or not.
2500 * Any change in order or content must be matched.
2501 */
2502 static struct sensor_device_template *nct6775_attributes_temp_template[] = {
2503 &sensor_dev_template_temp_input,
2504 &sensor_dev_template_temp_label,
2505 &sensor_dev_template_temp_alarm, /* 2 */
2506 &sensor_dev_template_temp_beep, /* 3 */
2507 &sensor_dev_template_temp_max, /* 4 */
2508 &sensor_dev_template_temp_max_hyst, /* 5 */
2509 &sensor_dev_template_temp_crit, /* 6 */
2510 &sensor_dev_template_temp_lcrit, /* 7 */
2511 &sensor_dev_template_temp_offset, /* 8 */
2512 &sensor_dev_template_temp_type, /* 9 */
2513 NULL
2514 };
2515
2516 static const struct sensor_template_group nct6775_temp_template_group = {
2517 .templates = nct6775_attributes_temp_template,
2518 .is_visible = nct6775_temp_is_visible,
2519 .base = 1,
2520 };
2521
2522 static ssize_t
show_pwm_mode(struct device * dev,struct device_attribute * attr,char * buf)2523 show_pwm_mode(struct device *dev, struct device_attribute *attr, char *buf)
2524 {
2525 struct nct6775_data *data = nct6775_update_device(dev);
2526 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2527
2528 return sprintf(buf, "%d\n", data->pwm_mode[sattr->index]);
2529 }
2530
2531 static ssize_t
store_pwm_mode(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2532 store_pwm_mode(struct device *dev, struct device_attribute *attr,
2533 const char *buf, size_t count)
2534 {
2535 struct nct6775_data *data = dev_get_drvdata(dev);
2536 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2537 int nr = sattr->index;
2538 unsigned long val;
2539 int err;
2540 u8 reg;
2541
2542 err = kstrtoul(buf, 10, &val);
2543 if (err < 0)
2544 return err;
2545
2546 if (val > 1)
2547 return -EINVAL;
2548
2549 /* Setting DC mode (0) is not supported for all chips/channels */
2550 if (data->REG_PWM_MODE[nr] == 0) {
2551 if (!val)
2552 return -EINVAL;
2553 return count;
2554 }
2555
2556 mutex_lock(&data->update_lock);
2557 data->pwm_mode[nr] = val;
2558 reg = nct6775_read_value(data, data->REG_PWM_MODE[nr]);
2559 reg &= ~data->PWM_MODE_MASK[nr];
2560 if (!val)
2561 reg |= data->PWM_MODE_MASK[nr];
2562 nct6775_write_value(data, data->REG_PWM_MODE[nr], reg);
2563 mutex_unlock(&data->update_lock);
2564 return count;
2565 }
2566
2567 static ssize_t
show_pwm(struct device * dev,struct device_attribute * attr,char * buf)2568 show_pwm(struct device *dev, struct device_attribute *attr, char *buf)
2569 {
2570 struct nct6775_data *data = nct6775_update_device(dev);
2571 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2572 int nr = sattr->nr;
2573 int index = sattr->index;
2574 int pwm;
2575
2576 /*
2577 * For automatic fan control modes, show current pwm readings.
2578 * Otherwise, show the configured value.
2579 */
2580 if (index == 0 && data->pwm_enable[nr] > manual)
2581 pwm = nct6775_read_value(data, data->REG_PWM_READ[nr]);
2582 else
2583 pwm = data->pwm[index][nr];
2584
2585 return sprintf(buf, "%d\n", pwm);
2586 }
2587
2588 static ssize_t
store_pwm(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2589 store_pwm(struct device *dev, struct device_attribute *attr, const char *buf,
2590 size_t count)
2591 {
2592 struct nct6775_data *data = dev_get_drvdata(dev);
2593 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2594 int nr = sattr->nr;
2595 int index = sattr->index;
2596 unsigned long val;
2597 int minval[7] = { 0, 1, 1, data->pwm[2][nr], 0, 0, 0 };
2598 int maxval[7]
2599 = { 255, 255, data->pwm[3][nr] ? : 255, 255, 255, 255, 255 };
2600 int err;
2601 u8 reg;
2602
2603 err = kstrtoul(buf, 10, &val);
2604 if (err < 0)
2605 return err;
2606 val = clamp_val(val, minval[index], maxval[index]);
2607
2608 mutex_lock(&data->update_lock);
2609 data->pwm[index][nr] = val;
2610 nct6775_write_value(data, data->REG_PWM[index][nr], val);
2611 if (index == 2) { /* floor: disable if val == 0 */
2612 reg = nct6775_read_value(data, data->REG_TEMP_SEL[nr]);
2613 reg &= 0x7f;
2614 if (val)
2615 reg |= 0x80;
2616 nct6775_write_value(data, data->REG_TEMP_SEL[nr], reg);
2617 }
2618 mutex_unlock(&data->update_lock);
2619 return count;
2620 }
2621
2622 /* Returns 0 if OK, -EINVAL otherwise */
check_trip_points(struct nct6775_data * data,int nr)2623 static int check_trip_points(struct nct6775_data *data, int nr)
2624 {
2625 int i;
2626
2627 for (i = 0; i < data->auto_pwm_num - 1; i++) {
2628 if (data->auto_temp[nr][i] > data->auto_temp[nr][i + 1])
2629 return -EINVAL;
2630 }
2631 for (i = 0; i < data->auto_pwm_num - 1; i++) {
2632 if (data->auto_pwm[nr][i] > data->auto_pwm[nr][i + 1])
2633 return -EINVAL;
2634 }
2635 /* validate critical temperature and pwm if enabled (pwm > 0) */
2636 if (data->auto_pwm[nr][data->auto_pwm_num]) {
2637 if (data->auto_temp[nr][data->auto_pwm_num - 1] >
2638 data->auto_temp[nr][data->auto_pwm_num] ||
2639 data->auto_pwm[nr][data->auto_pwm_num - 1] >
2640 data->auto_pwm[nr][data->auto_pwm_num])
2641 return -EINVAL;
2642 }
2643 return 0;
2644 }
2645
pwm_update_registers(struct nct6775_data * data,int nr)2646 static void pwm_update_registers(struct nct6775_data *data, int nr)
2647 {
2648 u8 reg;
2649
2650 switch (data->pwm_enable[nr]) {
2651 case off:
2652 case manual:
2653 break;
2654 case speed_cruise:
2655 reg = nct6775_read_value(data, data->REG_FAN_MODE[nr]);
2656 reg = (reg & ~data->tolerance_mask) |
2657 (data->target_speed_tolerance[nr] & data->tolerance_mask);
2658 nct6775_write_value(data, data->REG_FAN_MODE[nr], reg);
2659 nct6775_write_value(data, data->REG_TARGET[nr],
2660 data->target_speed[nr] & 0xff);
2661 if (data->REG_TOLERANCE_H) {
2662 reg = (data->target_speed[nr] >> 8) & 0x0f;
2663 reg |= (data->target_speed_tolerance[nr] & 0x38) << 1;
2664 nct6775_write_value(data,
2665 data->REG_TOLERANCE_H[nr],
2666 reg);
2667 }
2668 break;
2669 case thermal_cruise:
2670 nct6775_write_value(data, data->REG_TARGET[nr],
2671 data->target_temp[nr]);
2672 /* fall through */
2673 default:
2674 reg = nct6775_read_value(data, data->REG_FAN_MODE[nr]);
2675 reg = (reg & ~data->tolerance_mask) |
2676 data->temp_tolerance[0][nr];
2677 nct6775_write_value(data, data->REG_FAN_MODE[nr], reg);
2678 break;
2679 }
2680 }
2681
2682 static ssize_t
show_pwm_enable(struct device * dev,struct device_attribute * attr,char * buf)2683 show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf)
2684 {
2685 struct nct6775_data *data = nct6775_update_device(dev);
2686 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2687
2688 return sprintf(buf, "%d\n", data->pwm_enable[sattr->index]);
2689 }
2690
2691 static ssize_t
store_pwm_enable(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2692 store_pwm_enable(struct device *dev, struct device_attribute *attr,
2693 const char *buf, size_t count)
2694 {
2695 struct nct6775_data *data = dev_get_drvdata(dev);
2696 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2697 int nr = sattr->index;
2698 unsigned long val;
2699 int err;
2700 u16 reg;
2701
2702 err = kstrtoul(buf, 10, &val);
2703 if (err < 0)
2704 return err;
2705
2706 if (val > sf4)
2707 return -EINVAL;
2708
2709 if (val == sf3 && data->kind != nct6775)
2710 return -EINVAL;
2711
2712 if (val == sf4 && check_trip_points(data, nr)) {
2713 dev_err(dev, "Inconsistent trip points, not switching to SmartFan IV mode\n");
2714 dev_err(dev, "Adjust trip points and try again\n");
2715 return -EINVAL;
2716 }
2717
2718 mutex_lock(&data->update_lock);
2719 data->pwm_enable[nr] = val;
2720 if (val == off) {
2721 /*
2722 * turn off pwm control: select manual mode, set pwm to maximum
2723 */
2724 data->pwm[0][nr] = 255;
2725 nct6775_write_value(data, data->REG_PWM[0][nr], 255);
2726 }
2727 pwm_update_registers(data, nr);
2728 reg = nct6775_read_value(data, data->REG_FAN_MODE[nr]);
2729 reg &= 0x0f;
2730 reg |= pwm_enable_to_reg(val) << 4;
2731 nct6775_write_value(data, data->REG_FAN_MODE[nr], reg);
2732 mutex_unlock(&data->update_lock);
2733 return count;
2734 }
2735
2736 static ssize_t
show_pwm_temp_sel_common(struct nct6775_data * data,char * buf,int src)2737 show_pwm_temp_sel_common(struct nct6775_data *data, char *buf, int src)
2738 {
2739 int i, sel = 0;
2740
2741 for (i = 0; i < NUM_TEMP; i++) {
2742 if (!(data->have_temp & BIT(i)))
2743 continue;
2744 if (src == data->temp_src[i]) {
2745 sel = i + 1;
2746 break;
2747 }
2748 }
2749
2750 return sprintf(buf, "%d\n", sel);
2751 }
2752
2753 static ssize_t
show_pwm_temp_sel(struct device * dev,struct device_attribute * attr,char * buf)2754 show_pwm_temp_sel(struct device *dev, struct device_attribute *attr, char *buf)
2755 {
2756 struct nct6775_data *data = nct6775_update_device(dev);
2757 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2758 int index = sattr->index;
2759
2760 return show_pwm_temp_sel_common(data, buf, data->pwm_temp_sel[index]);
2761 }
2762
2763 static ssize_t
store_pwm_temp_sel(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2764 store_pwm_temp_sel(struct device *dev, struct device_attribute *attr,
2765 const char *buf, size_t count)
2766 {
2767 struct nct6775_data *data = nct6775_update_device(dev);
2768 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2769 int nr = sattr->index;
2770 unsigned long val;
2771 int err, reg, src;
2772
2773 err = kstrtoul(buf, 10, &val);
2774 if (err < 0)
2775 return err;
2776 if (val == 0 || val > NUM_TEMP)
2777 return -EINVAL;
2778 if (!(data->have_temp & BIT(val - 1)) || !data->temp_src[val - 1])
2779 return -EINVAL;
2780
2781 mutex_lock(&data->update_lock);
2782 src = data->temp_src[val - 1];
2783 data->pwm_temp_sel[nr] = src;
2784 reg = nct6775_read_value(data, data->REG_TEMP_SEL[nr]);
2785 reg &= 0xe0;
2786 reg |= src;
2787 nct6775_write_value(data, data->REG_TEMP_SEL[nr], reg);
2788 mutex_unlock(&data->update_lock);
2789
2790 return count;
2791 }
2792
2793 static ssize_t
show_pwm_weight_temp_sel(struct device * dev,struct device_attribute * attr,char * buf)2794 show_pwm_weight_temp_sel(struct device *dev, struct device_attribute *attr,
2795 char *buf)
2796 {
2797 struct nct6775_data *data = nct6775_update_device(dev);
2798 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2799 int index = sattr->index;
2800
2801 return show_pwm_temp_sel_common(data, buf,
2802 data->pwm_weight_temp_sel[index]);
2803 }
2804
2805 static ssize_t
store_pwm_weight_temp_sel(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2806 store_pwm_weight_temp_sel(struct device *dev, struct device_attribute *attr,
2807 const char *buf, size_t count)
2808 {
2809 struct nct6775_data *data = nct6775_update_device(dev);
2810 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2811 int nr = sattr->index;
2812 unsigned long val;
2813 int err, reg, src;
2814
2815 err = kstrtoul(buf, 10, &val);
2816 if (err < 0)
2817 return err;
2818 if (val > NUM_TEMP)
2819 return -EINVAL;
2820 val = array_index_nospec(val, NUM_TEMP + 1);
2821 if (val && (!(data->have_temp & BIT(val - 1)) ||
2822 !data->temp_src[val - 1]))
2823 return -EINVAL;
2824
2825 mutex_lock(&data->update_lock);
2826 if (val) {
2827 src = data->temp_src[val - 1];
2828 data->pwm_weight_temp_sel[nr] = src;
2829 reg = nct6775_read_value(data, data->REG_WEIGHT_TEMP_SEL[nr]);
2830 reg &= 0xe0;
2831 reg |= (src | 0x80);
2832 nct6775_write_value(data, data->REG_WEIGHT_TEMP_SEL[nr], reg);
2833 } else {
2834 data->pwm_weight_temp_sel[nr] = 0;
2835 reg = nct6775_read_value(data, data->REG_WEIGHT_TEMP_SEL[nr]);
2836 reg &= 0x7f;
2837 nct6775_write_value(data, data->REG_WEIGHT_TEMP_SEL[nr], reg);
2838 }
2839 mutex_unlock(&data->update_lock);
2840
2841 return count;
2842 }
2843
2844 static ssize_t
show_target_temp(struct device * dev,struct device_attribute * attr,char * buf)2845 show_target_temp(struct device *dev, struct device_attribute *attr, char *buf)
2846 {
2847 struct nct6775_data *data = nct6775_update_device(dev);
2848 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2849
2850 return sprintf(buf, "%d\n", data->target_temp[sattr->index] * 1000);
2851 }
2852
2853 static ssize_t
store_target_temp(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2854 store_target_temp(struct device *dev, struct device_attribute *attr,
2855 const char *buf, size_t count)
2856 {
2857 struct nct6775_data *data = dev_get_drvdata(dev);
2858 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2859 int nr = sattr->index;
2860 unsigned long val;
2861 int err;
2862
2863 err = kstrtoul(buf, 10, &val);
2864 if (err < 0)
2865 return err;
2866
2867 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0,
2868 data->target_temp_mask);
2869
2870 mutex_lock(&data->update_lock);
2871 data->target_temp[nr] = val;
2872 pwm_update_registers(data, nr);
2873 mutex_unlock(&data->update_lock);
2874 return count;
2875 }
2876
2877 static ssize_t
show_target_speed(struct device * dev,struct device_attribute * attr,char * buf)2878 show_target_speed(struct device *dev, struct device_attribute *attr, char *buf)
2879 {
2880 struct nct6775_data *data = nct6775_update_device(dev);
2881 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2882 int nr = sattr->index;
2883
2884 return sprintf(buf, "%d\n",
2885 fan_from_reg16(data->target_speed[nr],
2886 data->fan_div[nr]));
2887 }
2888
2889 static ssize_t
store_target_speed(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2890 store_target_speed(struct device *dev, struct device_attribute *attr,
2891 const char *buf, size_t count)
2892 {
2893 struct nct6775_data *data = dev_get_drvdata(dev);
2894 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2895 int nr = sattr->index;
2896 unsigned long val;
2897 int err;
2898 u16 speed;
2899
2900 err = kstrtoul(buf, 10, &val);
2901 if (err < 0)
2902 return err;
2903
2904 val = clamp_val(val, 0, 1350000U);
2905 speed = fan_to_reg(val, data->fan_div[nr]);
2906
2907 mutex_lock(&data->update_lock);
2908 data->target_speed[nr] = speed;
2909 pwm_update_registers(data, nr);
2910 mutex_unlock(&data->update_lock);
2911 return count;
2912 }
2913
2914 static ssize_t
show_temp_tolerance(struct device * dev,struct device_attribute * attr,char * buf)2915 show_temp_tolerance(struct device *dev, struct device_attribute *attr,
2916 char *buf)
2917 {
2918 struct nct6775_data *data = nct6775_update_device(dev);
2919 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2920 int nr = sattr->nr;
2921 int index = sattr->index;
2922
2923 return sprintf(buf, "%d\n", data->temp_tolerance[index][nr] * 1000);
2924 }
2925
2926 static ssize_t
store_temp_tolerance(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2927 store_temp_tolerance(struct device *dev, struct device_attribute *attr,
2928 const char *buf, size_t count)
2929 {
2930 struct nct6775_data *data = dev_get_drvdata(dev);
2931 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
2932 int nr = sattr->nr;
2933 int index = sattr->index;
2934 unsigned long val;
2935 int err;
2936
2937 err = kstrtoul(buf, 10, &val);
2938 if (err < 0)
2939 return err;
2940
2941 /* Limit tolerance as needed */
2942 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, data->tolerance_mask);
2943
2944 mutex_lock(&data->update_lock);
2945 data->temp_tolerance[index][nr] = val;
2946 if (index)
2947 pwm_update_registers(data, nr);
2948 else
2949 nct6775_write_value(data,
2950 data->REG_CRITICAL_TEMP_TOLERANCE[nr],
2951 val);
2952 mutex_unlock(&data->update_lock);
2953 return count;
2954 }
2955
2956 /*
2957 * Fan speed tolerance is a tricky beast, since the associated register is
2958 * a tick counter, but the value is reported and configured as rpm.
2959 * Compute resulting low and high rpm values and report the difference.
2960 * A fan speed tolerance only makes sense if a fan target speed has been
2961 * configured, so only display values other than 0 if that is the case.
2962 */
2963 static ssize_t
show_speed_tolerance(struct device * dev,struct device_attribute * attr,char * buf)2964 show_speed_tolerance(struct device *dev, struct device_attribute *attr,
2965 char *buf)
2966 {
2967 struct nct6775_data *data = nct6775_update_device(dev);
2968 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2969 int nr = sattr->index;
2970 int target = data->target_speed[nr];
2971 int tolerance = 0;
2972
2973 if (target) {
2974 int low = target - data->target_speed_tolerance[nr];
2975 int high = target + data->target_speed_tolerance[nr];
2976
2977 if (low <= 0)
2978 low = 1;
2979 if (high > 0xffff)
2980 high = 0xffff;
2981 if (high < low)
2982 high = low;
2983
2984 tolerance = (fan_from_reg16(low, data->fan_div[nr])
2985 - fan_from_reg16(high, data->fan_div[nr])) / 2;
2986 }
2987
2988 return sprintf(buf, "%d\n", tolerance);
2989 }
2990
2991 static ssize_t
store_speed_tolerance(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2992 store_speed_tolerance(struct device *dev, struct device_attribute *attr,
2993 const char *buf, size_t count)
2994 {
2995 struct nct6775_data *data = dev_get_drvdata(dev);
2996 struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
2997 int nr = sattr->index;
2998 unsigned long val;
2999 int err;
3000 int low, high;
3001
3002 err = kstrtoul(buf, 10, &val);
3003 if (err < 0)
3004 return err;
3005
3006 high = fan_from_reg16(data->target_speed[nr],
3007 data->fan_div[nr]) + val;
3008 low = fan_from_reg16(data->target_speed[nr],
3009 data->fan_div[nr]) - val;
3010 if (low <= 0)
3011 low = 1;
3012 if (high < low)
3013 high = low;
3014
3015 val = (fan_to_reg(low, data->fan_div[nr]) -
3016 fan_to_reg(high, data->fan_div[nr])) / 2;
3017
3018 /* Limit tolerance as needed */
3019 val = clamp_val(val, 0, data->speed_tolerance_limit);
3020
3021 mutex_lock(&data->update_lock);
3022 data->target_speed_tolerance[nr] = val;
3023 pwm_update_registers(data, nr);
3024 mutex_unlock(&data->update_lock);
3025 return count;
3026 }
3027
3028 SENSOR_TEMPLATE_2(pwm, "pwm%d", S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0, 0);
3029 SENSOR_TEMPLATE(pwm_mode, "pwm%d_mode", S_IWUSR | S_IRUGO, show_pwm_mode,
3030 store_pwm_mode, 0);
3031 SENSOR_TEMPLATE(pwm_enable, "pwm%d_enable", S_IWUSR | S_IRUGO, show_pwm_enable,
3032 store_pwm_enable, 0);
3033 SENSOR_TEMPLATE(pwm_temp_sel, "pwm%d_temp_sel", S_IWUSR | S_IRUGO,
3034 show_pwm_temp_sel, store_pwm_temp_sel, 0);
3035 SENSOR_TEMPLATE(pwm_target_temp, "pwm%d_target_temp", S_IWUSR | S_IRUGO,
3036 show_target_temp, store_target_temp, 0);
3037 SENSOR_TEMPLATE(fan_target, "fan%d_target", S_IWUSR | S_IRUGO,
3038 show_target_speed, store_target_speed, 0);
3039 SENSOR_TEMPLATE(fan_tolerance, "fan%d_tolerance", S_IWUSR | S_IRUGO,
3040 show_speed_tolerance, store_speed_tolerance, 0);
3041
3042 /* Smart Fan registers */
3043
3044 static ssize_t
show_weight_temp(struct device * dev,struct device_attribute * attr,char * buf)3045 show_weight_temp(struct device *dev, struct device_attribute *attr, char *buf)
3046 {
3047 struct nct6775_data *data = nct6775_update_device(dev);
3048 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3049 int nr = sattr->nr;
3050 int index = sattr->index;
3051
3052 return sprintf(buf, "%d\n", data->weight_temp[index][nr] * 1000);
3053 }
3054
3055 static ssize_t
store_weight_temp(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)3056 store_weight_temp(struct device *dev, struct device_attribute *attr,
3057 const char *buf, size_t count)
3058 {
3059 struct nct6775_data *data = dev_get_drvdata(dev);
3060 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3061 int nr = sattr->nr;
3062 int index = sattr->index;
3063 unsigned long val;
3064 int err;
3065
3066 err = kstrtoul(buf, 10, &val);
3067 if (err < 0)
3068 return err;
3069
3070 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, 255);
3071
3072 mutex_lock(&data->update_lock);
3073 data->weight_temp[index][nr] = val;
3074 nct6775_write_value(data, data->REG_WEIGHT_TEMP[index][nr], val);
3075 mutex_unlock(&data->update_lock);
3076 return count;
3077 }
3078
3079 SENSOR_TEMPLATE(pwm_weight_temp_sel, "pwm%d_weight_temp_sel", S_IWUSR | S_IRUGO,
3080 show_pwm_weight_temp_sel, store_pwm_weight_temp_sel, 0);
3081 SENSOR_TEMPLATE_2(pwm_weight_temp_step, "pwm%d_weight_temp_step",
3082 S_IWUSR | S_IRUGO, show_weight_temp, store_weight_temp, 0, 0);
3083 SENSOR_TEMPLATE_2(pwm_weight_temp_step_tol, "pwm%d_weight_temp_step_tol",
3084 S_IWUSR | S_IRUGO, show_weight_temp, store_weight_temp, 0, 1);
3085 SENSOR_TEMPLATE_2(pwm_weight_temp_step_base, "pwm%d_weight_temp_step_base",
3086 S_IWUSR | S_IRUGO, show_weight_temp, store_weight_temp, 0, 2);
3087 SENSOR_TEMPLATE_2(pwm_weight_duty_step, "pwm%d_weight_duty_step",
3088 S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0, 5);
3089 SENSOR_TEMPLATE_2(pwm_weight_duty_base, "pwm%d_weight_duty_base",
3090 S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0, 6);
3091
3092 static ssize_t
show_fan_time(struct device * dev,struct device_attribute * attr,char * buf)3093 show_fan_time(struct device *dev, struct device_attribute *attr, char *buf)
3094 {
3095 struct nct6775_data *data = nct6775_update_device(dev);
3096 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3097 int nr = sattr->nr;
3098 int index = sattr->index;
3099
3100 return sprintf(buf, "%d\n",
3101 step_time_from_reg(data->fan_time[index][nr],
3102 data->pwm_mode[nr]));
3103 }
3104
3105 static ssize_t
store_fan_time(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)3106 store_fan_time(struct device *dev, struct device_attribute *attr,
3107 const char *buf, size_t count)
3108 {
3109 struct nct6775_data *data = dev_get_drvdata(dev);
3110 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3111 int nr = sattr->nr;
3112 int index = sattr->index;
3113 unsigned long val;
3114 int err;
3115
3116 err = kstrtoul(buf, 10, &val);
3117 if (err < 0)
3118 return err;
3119
3120 val = step_time_to_reg(val, data->pwm_mode[nr]);
3121 mutex_lock(&data->update_lock);
3122 data->fan_time[index][nr] = val;
3123 nct6775_write_value(data, data->REG_FAN_TIME[index][nr], val);
3124 mutex_unlock(&data->update_lock);
3125 return count;
3126 }
3127
3128 static ssize_t
show_auto_pwm(struct device * dev,struct device_attribute * attr,char * buf)3129 show_auto_pwm(struct device *dev, struct device_attribute *attr, char *buf)
3130 {
3131 struct nct6775_data *data = nct6775_update_device(dev);
3132 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3133
3134 return sprintf(buf, "%d\n", data->auto_pwm[sattr->nr][sattr->index]);
3135 }
3136
3137 static ssize_t
store_auto_pwm(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)3138 store_auto_pwm(struct device *dev, struct device_attribute *attr,
3139 const char *buf, size_t count)
3140 {
3141 struct nct6775_data *data = dev_get_drvdata(dev);
3142 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3143 int nr = sattr->nr;
3144 int point = sattr->index;
3145 unsigned long val;
3146 int err;
3147 u8 reg;
3148
3149 err = kstrtoul(buf, 10, &val);
3150 if (err < 0)
3151 return err;
3152 if (val > 255)
3153 return -EINVAL;
3154
3155 if (point == data->auto_pwm_num) {
3156 if (data->kind != nct6775 && !val)
3157 return -EINVAL;
3158 if (data->kind != nct6779 && val)
3159 val = 0xff;
3160 }
3161
3162 mutex_lock(&data->update_lock);
3163 data->auto_pwm[nr][point] = val;
3164 if (point < data->auto_pwm_num) {
3165 nct6775_write_value(data,
3166 NCT6775_AUTO_PWM(data, nr, point),
3167 data->auto_pwm[nr][point]);
3168 } else {
3169 switch (data->kind) {
3170 case nct6775:
3171 /* disable if needed (pwm == 0) */
3172 reg = nct6775_read_value(data,
3173 NCT6775_REG_CRITICAL_ENAB[nr]);
3174 if (val)
3175 reg |= 0x02;
3176 else
3177 reg &= ~0x02;
3178 nct6775_write_value(data, NCT6775_REG_CRITICAL_ENAB[nr],
3179 reg);
3180 break;
3181 case nct6776:
3182 break; /* always enabled, nothing to do */
3183 case nct6106:
3184 case nct6116:
3185 case nct6779:
3186 case nct6791:
3187 case nct6792:
3188 case nct6793:
3189 case nct6795:
3190 case nct6796:
3191 case nct6797:
3192 case nct6798:
3193 nct6775_write_value(data, data->REG_CRITICAL_PWM[nr],
3194 val);
3195 reg = nct6775_read_value(data,
3196 data->REG_CRITICAL_PWM_ENABLE[nr]);
3197 if (val == 255)
3198 reg &= ~data->CRITICAL_PWM_ENABLE_MASK;
3199 else
3200 reg |= data->CRITICAL_PWM_ENABLE_MASK;
3201 nct6775_write_value(data,
3202 data->REG_CRITICAL_PWM_ENABLE[nr],
3203 reg);
3204 break;
3205 }
3206 }
3207 mutex_unlock(&data->update_lock);
3208 return count;
3209 }
3210
3211 static ssize_t
show_auto_temp(struct device * dev,struct device_attribute * attr,char * buf)3212 show_auto_temp(struct device *dev, struct device_attribute *attr, char *buf)
3213 {
3214 struct nct6775_data *data = nct6775_update_device(dev);
3215 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3216 int nr = sattr->nr;
3217 int point = sattr->index;
3218
3219 /*
3220 * We don't know for sure if the temperature is signed or unsigned.
3221 * Assume it is unsigned.
3222 */
3223 return sprintf(buf, "%d\n", data->auto_temp[nr][point] * 1000);
3224 }
3225
3226 static ssize_t
store_auto_temp(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)3227 store_auto_temp(struct device *dev, struct device_attribute *attr,
3228 const char *buf, size_t count)
3229 {
3230 struct nct6775_data *data = dev_get_drvdata(dev);
3231 struct sensor_device_attribute_2 *sattr = to_sensor_dev_attr_2(attr);
3232 int nr = sattr->nr;
3233 int point = sattr->index;
3234 unsigned long val;
3235 int err;
3236
3237 err = kstrtoul(buf, 10, &val);
3238 if (err)
3239 return err;
3240 if (val > 255000)
3241 return -EINVAL;
3242
3243 mutex_lock(&data->update_lock);
3244 data->auto_temp[nr][point] = DIV_ROUND_CLOSEST(val, 1000);
3245 if (point < data->auto_pwm_num) {
3246 nct6775_write_value(data,
3247 NCT6775_AUTO_TEMP(data, nr, point),
3248 data->auto_temp[nr][point]);
3249 } else {
3250 nct6775_write_value(data, data->REG_CRITICAL_TEMP[nr],
3251 data->auto_temp[nr][point]);
3252 }
3253 mutex_unlock(&data->update_lock);
3254 return count;
3255 }
3256
nct6775_pwm_is_visible(struct kobject * kobj,struct attribute * attr,int index)3257 static umode_t nct6775_pwm_is_visible(struct kobject *kobj,
3258 struct attribute *attr, int index)
3259 {
3260 struct device *dev = container_of(kobj, struct device, kobj);
3261 struct nct6775_data *data = dev_get_drvdata(dev);
3262 int pwm = index / 36; /* pwm index */
3263 int nr = index % 36; /* attribute index */
3264
3265 if (!(data->has_pwm & BIT(pwm)))
3266 return 0;
3267
3268 if ((nr >= 14 && nr <= 18) || nr == 21) /* weight */
3269 if (!data->REG_WEIGHT_TEMP_SEL[pwm])
3270 return 0;
3271 if (nr == 19 && data->REG_PWM[3] == NULL) /* pwm_max */
3272 return 0;
3273 if (nr == 20 && data->REG_PWM[4] == NULL) /* pwm_step */
3274 return 0;
3275 if (nr == 21 && data->REG_PWM[6] == NULL) /* weight_duty_base */
3276 return 0;
3277
3278 if (nr >= 22 && nr <= 35) { /* auto point */
3279 int api = (nr - 22) / 2; /* auto point index */
3280
3281 if (api > data->auto_pwm_num)
3282 return 0;
3283 }
3284 return attr->mode;
3285 }
3286
3287 SENSOR_TEMPLATE_2(pwm_stop_time, "pwm%d_stop_time", S_IWUSR | S_IRUGO,
3288 show_fan_time, store_fan_time, 0, 0);
3289 SENSOR_TEMPLATE_2(pwm_step_up_time, "pwm%d_step_up_time", S_IWUSR | S_IRUGO,
3290 show_fan_time, store_fan_time, 0, 1);
3291 SENSOR_TEMPLATE_2(pwm_step_down_time, "pwm%d_step_down_time", S_IWUSR | S_IRUGO,
3292 show_fan_time, store_fan_time, 0, 2);
3293 SENSOR_TEMPLATE_2(pwm_start, "pwm%d_start", S_IWUSR | S_IRUGO, show_pwm,
3294 store_pwm, 0, 1);
3295 SENSOR_TEMPLATE_2(pwm_floor, "pwm%d_floor", S_IWUSR | S_IRUGO, show_pwm,
3296 store_pwm, 0, 2);
3297 SENSOR_TEMPLATE_2(pwm_temp_tolerance, "pwm%d_temp_tolerance", S_IWUSR | S_IRUGO,
3298 show_temp_tolerance, store_temp_tolerance, 0, 0);
3299 SENSOR_TEMPLATE_2(pwm_crit_temp_tolerance, "pwm%d_crit_temp_tolerance",
3300 S_IWUSR | S_IRUGO, show_temp_tolerance, store_temp_tolerance,
3301 0, 1);
3302
3303 SENSOR_TEMPLATE_2(pwm_max, "pwm%d_max", S_IWUSR | S_IRUGO, show_pwm, store_pwm,
3304 0, 3);
3305
3306 SENSOR_TEMPLATE_2(pwm_step, "pwm%d_step", S_IWUSR | S_IRUGO, show_pwm,
3307 store_pwm, 0, 4);
3308
3309 SENSOR_TEMPLATE_2(pwm_auto_point1_pwm, "pwm%d_auto_point1_pwm",
3310 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 0);
3311 SENSOR_TEMPLATE_2(pwm_auto_point1_temp, "pwm%d_auto_point1_temp",
3312 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 0);
3313
3314 SENSOR_TEMPLATE_2(pwm_auto_point2_pwm, "pwm%d_auto_point2_pwm",
3315 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 1);
3316 SENSOR_TEMPLATE_2(pwm_auto_point2_temp, "pwm%d_auto_point2_temp",
3317 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 1);
3318
3319 SENSOR_TEMPLATE_2(pwm_auto_point3_pwm, "pwm%d_auto_point3_pwm",
3320 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 2);
3321 SENSOR_TEMPLATE_2(pwm_auto_point3_temp, "pwm%d_auto_point3_temp",
3322 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 2);
3323
3324 SENSOR_TEMPLATE_2(pwm_auto_point4_pwm, "pwm%d_auto_point4_pwm",
3325 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 3);
3326 SENSOR_TEMPLATE_2(pwm_auto_point4_temp, "pwm%d_auto_point4_temp",
3327 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 3);
3328
3329 SENSOR_TEMPLATE_2(pwm_auto_point5_pwm, "pwm%d_auto_point5_pwm",
3330 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 4);
3331 SENSOR_TEMPLATE_2(pwm_auto_point5_temp, "pwm%d_auto_point5_temp",
3332 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 4);
3333
3334 SENSOR_TEMPLATE_2(pwm_auto_point6_pwm, "pwm%d_auto_point6_pwm",
3335 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 5);
3336 SENSOR_TEMPLATE_2(pwm_auto_point6_temp, "pwm%d_auto_point6_temp",
3337 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 5);
3338
3339 SENSOR_TEMPLATE_2(pwm_auto_point7_pwm, "pwm%d_auto_point7_pwm",
3340 S_IWUSR | S_IRUGO, show_auto_pwm, store_auto_pwm, 0, 6);
3341 SENSOR_TEMPLATE_2(pwm_auto_point7_temp, "pwm%d_auto_point7_temp",
3342 S_IWUSR | S_IRUGO, show_auto_temp, store_auto_temp, 0, 6);
3343
3344 /*
3345 * nct6775_pwm_is_visible uses the index into the following array
3346 * to determine if attributes should be created or not.
3347 * Any change in order or content must be matched.
3348 */
3349 static struct sensor_device_template *nct6775_attributes_pwm_template[] = {
3350 &sensor_dev_template_pwm,
3351 &sensor_dev_template_pwm_mode,
3352 &sensor_dev_template_pwm_enable,
3353 &sensor_dev_template_pwm_temp_sel,
3354 &sensor_dev_template_pwm_temp_tolerance,
3355 &sensor_dev_template_pwm_crit_temp_tolerance,
3356 &sensor_dev_template_pwm_target_temp,
3357 &sensor_dev_template_fan_target,
3358 &sensor_dev_template_fan_tolerance,
3359 &sensor_dev_template_pwm_stop_time,
3360 &sensor_dev_template_pwm_step_up_time,
3361 &sensor_dev_template_pwm_step_down_time,
3362 &sensor_dev_template_pwm_start,
3363 &sensor_dev_template_pwm_floor,
3364 &sensor_dev_template_pwm_weight_temp_sel, /* 14 */
3365 &sensor_dev_template_pwm_weight_temp_step,
3366 &sensor_dev_template_pwm_weight_temp_step_tol,
3367 &sensor_dev_template_pwm_weight_temp_step_base,
3368 &sensor_dev_template_pwm_weight_duty_step, /* 18 */
3369 &sensor_dev_template_pwm_max, /* 19 */
3370 &sensor_dev_template_pwm_step, /* 20 */
3371 &sensor_dev_template_pwm_weight_duty_base, /* 21 */
3372 &sensor_dev_template_pwm_auto_point1_pwm, /* 22 */
3373 &sensor_dev_template_pwm_auto_point1_temp,
3374 &sensor_dev_template_pwm_auto_point2_pwm,
3375 &sensor_dev_template_pwm_auto_point2_temp,
3376 &sensor_dev_template_pwm_auto_point3_pwm,
3377 &sensor_dev_template_pwm_auto_point3_temp,
3378 &sensor_dev_template_pwm_auto_point4_pwm,
3379 &sensor_dev_template_pwm_auto_point4_temp,
3380 &sensor_dev_template_pwm_auto_point5_pwm,
3381 &sensor_dev_template_pwm_auto_point5_temp,
3382 &sensor_dev_template_pwm_auto_point6_pwm,
3383 &sensor_dev_template_pwm_auto_point6_temp,
3384 &sensor_dev_template_pwm_auto_point7_pwm,
3385 &sensor_dev_template_pwm_auto_point7_temp, /* 35 */
3386
3387 NULL
3388 };
3389
3390 static const struct sensor_template_group nct6775_pwm_template_group = {
3391 .templates = nct6775_attributes_pwm_template,
3392 .is_visible = nct6775_pwm_is_visible,
3393 .base = 1,
3394 };
3395
3396 static ssize_t
cpu0_vid_show(struct device * dev,struct device_attribute * attr,char * buf)3397 cpu0_vid_show(struct device *dev, struct device_attribute *attr, char *buf)
3398 {
3399 struct nct6775_data *data = dev_get_drvdata(dev);
3400
3401 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
3402 }
3403
3404 static DEVICE_ATTR_RO(cpu0_vid);
3405
3406 /* Case open detection */
3407
3408 static ssize_t
clear_caseopen(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)3409 clear_caseopen(struct device *dev, struct device_attribute *attr,
3410 const char *buf, size_t count)
3411 {
3412 struct nct6775_data *data = dev_get_drvdata(dev);
3413 int nr = to_sensor_dev_attr(attr)->index - INTRUSION_ALARM_BASE;
3414 unsigned long val;
3415 u8 reg;
3416 int ret;
3417
3418 if (kstrtoul(buf, 10, &val) || val != 0)
3419 return -EINVAL;
3420
3421 mutex_lock(&data->update_lock);
3422
3423 /*
3424 * Use CR registers to clear caseopen status.
3425 * The CR registers are the same for all chips, and not all chips
3426 * support clearing the caseopen status through "regular" registers.
3427 */
3428 ret = superio_enter(data->sioreg);
3429 if (ret) {
3430 count = ret;
3431 goto error;
3432 }
3433
3434 superio_select(data->sioreg, NCT6775_LD_ACPI);
3435 reg = superio_inb(data->sioreg, NCT6775_REG_CR_CASEOPEN_CLR[nr]);
3436 reg |= NCT6775_CR_CASEOPEN_CLR_MASK[nr];
3437 superio_outb(data->sioreg, NCT6775_REG_CR_CASEOPEN_CLR[nr], reg);
3438 reg &= ~NCT6775_CR_CASEOPEN_CLR_MASK[nr];
3439 superio_outb(data->sioreg, NCT6775_REG_CR_CASEOPEN_CLR[nr], reg);
3440 superio_exit(data->sioreg);
3441
3442 data->valid = false; /* Force cache refresh */
3443 error:
3444 mutex_unlock(&data->update_lock);
3445 return count;
3446 }
3447
3448 static SENSOR_DEVICE_ATTR(intrusion0_alarm, S_IWUSR | S_IRUGO, show_alarm,
3449 clear_caseopen, INTRUSION_ALARM_BASE);
3450 static SENSOR_DEVICE_ATTR(intrusion1_alarm, S_IWUSR | S_IRUGO, show_alarm,
3451 clear_caseopen, INTRUSION_ALARM_BASE + 1);
3452 static SENSOR_DEVICE_ATTR(intrusion0_beep, S_IWUSR | S_IRUGO, show_beep,
3453 store_beep, INTRUSION_ALARM_BASE);
3454 static SENSOR_DEVICE_ATTR(intrusion1_beep, S_IWUSR | S_IRUGO, show_beep,
3455 store_beep, INTRUSION_ALARM_BASE + 1);
3456 static SENSOR_DEVICE_ATTR(beep_enable, S_IWUSR | S_IRUGO, show_beep,
3457 store_beep, BEEP_ENABLE_BASE);
3458
nct6775_other_is_visible(struct kobject * kobj,struct attribute * attr,int index)3459 static umode_t nct6775_other_is_visible(struct kobject *kobj,
3460 struct attribute *attr, int index)
3461 {
3462 struct device *dev = container_of(kobj, struct device, kobj);
3463 struct nct6775_data *data = dev_get_drvdata(dev);
3464
3465 if (index == 0 && !data->have_vid)
3466 return 0;
3467
3468 if (index == 1 || index == 2) {
3469 if (data->ALARM_BITS[INTRUSION_ALARM_BASE + index - 1] < 0)
3470 return 0;
3471 }
3472
3473 if (index == 3 || index == 4) {
3474 if (data->BEEP_BITS[INTRUSION_ALARM_BASE + index - 3] < 0)
3475 return 0;
3476 }
3477
3478 return attr->mode;
3479 }
3480
3481 /*
3482 * nct6775_other_is_visible uses the index into the following array
3483 * to determine if attributes should be created or not.
3484 * Any change in order or content must be matched.
3485 */
3486 static struct attribute *nct6775_attributes_other[] = {
3487 &dev_attr_cpu0_vid.attr, /* 0 */
3488 &sensor_dev_attr_intrusion0_alarm.dev_attr.attr, /* 1 */
3489 &sensor_dev_attr_intrusion1_alarm.dev_attr.attr, /* 2 */
3490 &sensor_dev_attr_intrusion0_beep.dev_attr.attr, /* 3 */
3491 &sensor_dev_attr_intrusion1_beep.dev_attr.attr, /* 4 */
3492 &sensor_dev_attr_beep_enable.dev_attr.attr, /* 5 */
3493
3494 NULL
3495 };
3496
3497 static const struct attribute_group nct6775_group_other = {
3498 .attrs = nct6775_attributes_other,
3499 .is_visible = nct6775_other_is_visible,
3500 };
3501
nct6775_init_device(struct nct6775_data * data)3502 static inline void nct6775_init_device(struct nct6775_data *data)
3503 {
3504 int i;
3505 u8 tmp, diode;
3506
3507 /* Start monitoring if needed */
3508 if (data->REG_CONFIG) {
3509 tmp = nct6775_read_value(data, data->REG_CONFIG);
3510 if (!(tmp & 0x01))
3511 nct6775_write_value(data, data->REG_CONFIG, tmp | 0x01);
3512 }
3513
3514 /* Enable temperature sensors if needed */
3515 for (i = 0; i < NUM_TEMP; i++) {
3516 if (!(data->have_temp & BIT(i)))
3517 continue;
3518 if (!data->reg_temp_config[i])
3519 continue;
3520 tmp = nct6775_read_value(data, data->reg_temp_config[i]);
3521 if (tmp & 0x01)
3522 nct6775_write_value(data, data->reg_temp_config[i],
3523 tmp & 0xfe);
3524 }
3525
3526 /* Enable VBAT monitoring if needed */
3527 tmp = nct6775_read_value(data, data->REG_VBAT);
3528 if (!(tmp & 0x01))
3529 nct6775_write_value(data, data->REG_VBAT, tmp | 0x01);
3530
3531 diode = nct6775_read_value(data, data->REG_DIODE);
3532
3533 for (i = 0; i < data->temp_fixed_num; i++) {
3534 if (!(data->have_temp_fixed & BIT(i)))
3535 continue;
3536 if ((tmp & (data->DIODE_MASK << i))) /* diode */
3537 data->temp_type[i]
3538 = 3 - ((diode >> i) & data->DIODE_MASK);
3539 else /* thermistor */
3540 data->temp_type[i] = 4;
3541 }
3542 }
3543
3544 static void
nct6775_check_fan_inputs(struct nct6775_data * data)3545 nct6775_check_fan_inputs(struct nct6775_data *data)
3546 {
3547 bool fan3pin = false, fan4pin = false, fan4min = false;
3548 bool fan5pin = false, fan6pin = false, fan7pin = false;
3549 bool pwm3pin = false, pwm4pin = false, pwm5pin = false;
3550 bool pwm6pin = false, pwm7pin = false;
3551 int sioreg = data->sioreg;
3552
3553 /* Store SIO_REG_ENABLE for use during resume */
3554 superio_select(sioreg, NCT6775_LD_HWM);
3555 data->sio_reg_enable = superio_inb(sioreg, SIO_REG_ENABLE);
3556
3557 /* fan4 and fan5 share some pins with the GPIO and serial flash */
3558 if (data->kind == nct6775) {
3559 int cr2c = superio_inb(sioreg, 0x2c);
3560
3561 fan3pin = cr2c & BIT(6);
3562 pwm3pin = cr2c & BIT(7);
3563
3564 /* On NCT6775, fan4 shares pins with the fdc interface */
3565 fan4pin = !(superio_inb(sioreg, 0x2A) & 0x80);
3566 } else if (data->kind == nct6776) {
3567 bool gpok = superio_inb(sioreg, 0x27) & 0x80;
3568 const char *board_vendor, *board_name;
3569
3570 board_vendor = dmi_get_system_info(DMI_BOARD_VENDOR);
3571 board_name = dmi_get_system_info(DMI_BOARD_NAME);
3572
3573 if (board_name && board_vendor &&
3574 !strcmp(board_vendor, "ASRock")) {
3575 /*
3576 * Auxiliary fan monitoring is not enabled on ASRock
3577 * Z77 Pro4-M if booted in UEFI Ultra-FastBoot mode.
3578 * Observed with BIOS version 2.00.
3579 */
3580 if (!strcmp(board_name, "Z77 Pro4-M")) {
3581 if ((data->sio_reg_enable & 0xe0) != 0xe0) {
3582 data->sio_reg_enable |= 0xe0;
3583 superio_outb(sioreg, SIO_REG_ENABLE,
3584 data->sio_reg_enable);
3585 }
3586 }
3587 }
3588
3589 if (data->sio_reg_enable & 0x80)
3590 fan3pin = gpok;
3591 else
3592 fan3pin = !(superio_inb(sioreg, 0x24) & 0x40);
3593
3594 if (data->sio_reg_enable & 0x40)
3595 fan4pin = gpok;
3596 else
3597 fan4pin = superio_inb(sioreg, 0x1C) & 0x01;
3598
3599 if (data->sio_reg_enable & 0x20)
3600 fan5pin = gpok;
3601 else
3602 fan5pin = superio_inb(sioreg, 0x1C) & 0x02;
3603
3604 fan4min = fan4pin;
3605 pwm3pin = fan3pin;
3606 } else if (data->kind == nct6106) {
3607 int cr24 = superio_inb(sioreg, 0x24);
3608
3609 fan3pin = !(cr24 & 0x80);
3610 pwm3pin = cr24 & 0x08;
3611 } else if (data->kind == nct6116) {
3612 int cr1a = superio_inb(sioreg, 0x1a);
3613 int cr1b = superio_inb(sioreg, 0x1b);
3614 int cr24 = superio_inb(sioreg, 0x24);
3615 int cr2a = superio_inb(sioreg, 0x2a);
3616 int cr2b = superio_inb(sioreg, 0x2b);
3617 int cr2f = superio_inb(sioreg, 0x2f);
3618
3619 fan3pin = !(cr2b & 0x10);
3620 fan4pin = (cr2b & 0x80) || // pin 1(2)
3621 (!(cr2f & 0x10) && (cr1a & 0x04)); // pin 65(66)
3622 fan5pin = (cr2b & 0x80) || // pin 126(127)
3623 (!(cr1b & 0x03) && (cr2a & 0x02)); // pin 94(96)
3624
3625 pwm3pin = fan3pin && (cr24 & 0x08);
3626 pwm4pin = fan4pin;
3627 pwm5pin = fan5pin;
3628 } else {
3629 /*
3630 * NCT6779D, NCT6791D, NCT6792D, NCT6793D, NCT6795D, NCT6796D,
3631 * NCT6797D, NCT6798D
3632 */
3633 int cr1a = superio_inb(sioreg, 0x1a);
3634 int cr1b = superio_inb(sioreg, 0x1b);
3635 int cr1c = superio_inb(sioreg, 0x1c);
3636 int cr1d = superio_inb(sioreg, 0x1d);
3637 int cr2a = superio_inb(sioreg, 0x2a);
3638 int cr2b = superio_inb(sioreg, 0x2b);
3639 int cr2d = superio_inb(sioreg, 0x2d);
3640 int cr2f = superio_inb(sioreg, 0x2f);
3641 bool dsw_en = cr2f & BIT(3);
3642 bool ddr4_en = cr2f & BIT(4);
3643 int cre0;
3644 int creb;
3645 int cred;
3646
3647 superio_select(sioreg, NCT6775_LD_12);
3648 cre0 = superio_inb(sioreg, 0xe0);
3649 creb = superio_inb(sioreg, 0xeb);
3650 cred = superio_inb(sioreg, 0xed);
3651
3652 fan3pin = !(cr1c & BIT(5));
3653 fan4pin = !(cr1c & BIT(6));
3654 fan5pin = !(cr1c & BIT(7));
3655
3656 pwm3pin = !(cr1c & BIT(0));
3657 pwm4pin = !(cr1c & BIT(1));
3658 pwm5pin = !(cr1c & BIT(2));
3659
3660 switch (data->kind) {
3661 case nct6791:
3662 fan6pin = cr2d & BIT(1);
3663 pwm6pin = cr2d & BIT(0);
3664 break;
3665 case nct6792:
3666 fan6pin = !dsw_en && (cr2d & BIT(1));
3667 pwm6pin = !dsw_en && (cr2d & BIT(0));
3668 break;
3669 case nct6793:
3670 fan5pin |= cr1b & BIT(5);
3671 fan5pin |= creb & BIT(5);
3672
3673 fan6pin = !dsw_en && (cr2d & BIT(1));
3674 fan6pin |= creb & BIT(3);
3675
3676 pwm5pin |= cr2d & BIT(7);
3677 pwm5pin |= (creb & BIT(4)) && !(cr2a & BIT(0));
3678
3679 pwm6pin = !dsw_en && (cr2d & BIT(0));
3680 pwm6pin |= creb & BIT(2);
3681 break;
3682 case nct6795:
3683 fan5pin |= cr1b & BIT(5);
3684 fan5pin |= creb & BIT(5);
3685
3686 fan6pin = (cr2a & BIT(4)) &&
3687 (!dsw_en || (cred & BIT(4)));
3688 fan6pin |= creb & BIT(3);
3689
3690 pwm5pin |= cr2d & BIT(7);
3691 pwm5pin |= (creb & BIT(4)) && !(cr2a & BIT(0));
3692
3693 pwm6pin = (cr2a & BIT(3)) && (cred & BIT(2));
3694 pwm6pin |= creb & BIT(2);
3695 break;
3696 case nct6796:
3697 fan5pin |= cr1b & BIT(5);
3698 fan5pin |= (cre0 & BIT(3)) && !(cr1b & BIT(0));
3699 fan5pin |= creb & BIT(5);
3700
3701 fan6pin = (cr2a & BIT(4)) &&
3702 (!dsw_en || (cred & BIT(4)));
3703 fan6pin |= creb & BIT(3);
3704
3705 fan7pin = !(cr2b & BIT(2));
3706
3707 pwm5pin |= cr2d & BIT(7);
3708 pwm5pin |= (cre0 & BIT(4)) && !(cr1b & BIT(0));
3709 pwm5pin |= (creb & BIT(4)) && !(cr2a & BIT(0));
3710
3711 pwm6pin = (cr2a & BIT(3)) && (cred & BIT(2));
3712 pwm6pin |= creb & BIT(2);
3713
3714 pwm7pin = !(cr1d & (BIT(2) | BIT(3)));
3715 break;
3716 case nct6797:
3717 fan5pin |= !ddr4_en && (cr1b & BIT(5));
3718 fan5pin |= creb & BIT(5);
3719
3720 fan6pin = cr2a & BIT(4);
3721 fan6pin |= creb & BIT(3);
3722
3723 fan7pin = cr1a & BIT(1);
3724
3725 pwm5pin |= (creb & BIT(4)) && !(cr2a & BIT(0));
3726 pwm5pin |= !ddr4_en && (cr2d & BIT(7));
3727
3728 pwm6pin = creb & BIT(2);
3729 pwm6pin |= cred & BIT(2);
3730
3731 pwm7pin = cr1d & BIT(4);
3732 break;
3733 case nct6798:
3734 fan6pin = !(cr1b & BIT(0)) && (cre0 & BIT(3));
3735 fan6pin |= cr2a & BIT(4);
3736 fan6pin |= creb & BIT(5);
3737
3738 fan7pin = cr1b & BIT(5);
3739 fan7pin |= !(cr2b & BIT(2));
3740 fan7pin |= creb & BIT(3);
3741
3742 pwm6pin = !(cr1b & BIT(0)) && (cre0 & BIT(4));
3743 pwm6pin |= !(cred & BIT(2)) && (cr2a & BIT(3));
3744 pwm6pin |= (creb & BIT(4)) && !(cr2a & BIT(0));
3745
3746 pwm7pin = !(cr1d & (BIT(2) | BIT(3)));
3747 pwm7pin |= cr2d & BIT(7);
3748 pwm7pin |= creb & BIT(2);
3749 break;
3750 default: /* NCT6779D */
3751 break;
3752 }
3753
3754 fan4min = fan4pin;
3755 }
3756
3757 /* fan 1 and 2 (0x03) are always present */
3758 data->has_fan = 0x03 | (fan3pin << 2) | (fan4pin << 3) |
3759 (fan5pin << 4) | (fan6pin << 5) | (fan7pin << 6);
3760 data->has_fan_min = 0x03 | (fan3pin << 2) | (fan4min << 3) |
3761 (fan5pin << 4) | (fan6pin << 5) | (fan7pin << 6);
3762 data->has_pwm = 0x03 | (pwm3pin << 2) | (pwm4pin << 3) |
3763 (pwm5pin << 4) | (pwm6pin << 5) | (pwm7pin << 6);
3764 }
3765
add_temp_sensors(struct nct6775_data * data,const u16 * regp,int * available,int * mask)3766 static void add_temp_sensors(struct nct6775_data *data, const u16 *regp,
3767 int *available, int *mask)
3768 {
3769 int i;
3770 u8 src;
3771
3772 for (i = 0; i < data->pwm_num && *available; i++) {
3773 int index;
3774
3775 if (!regp[i])
3776 continue;
3777 src = nct6775_read_value(data, regp[i]);
3778 src &= 0x1f;
3779 if (!src || (*mask & BIT(src)))
3780 continue;
3781 if (!(data->temp_mask & BIT(src)))
3782 continue;
3783
3784 index = __ffs(*available);
3785 nct6775_write_value(data, data->REG_TEMP_SOURCE[index], src);
3786 *available &= ~BIT(index);
3787 *mask |= BIT(src);
3788 }
3789 }
3790
nct6775_probe(struct platform_device * pdev)3791 static int nct6775_probe(struct platform_device *pdev)
3792 {
3793 struct device *dev = &pdev->dev;
3794 struct nct6775_sio_data *sio_data = dev_get_platdata(dev);
3795 struct nct6775_data *data;
3796 struct resource *res;
3797 int i, s, err = 0;
3798 int src, mask, available;
3799 const u16 *reg_temp, *reg_temp_over, *reg_temp_hyst, *reg_temp_config;
3800 const u16 *reg_temp_mon, *reg_temp_alternate, *reg_temp_crit;
3801 const u16 *reg_temp_crit_l = NULL, *reg_temp_crit_h = NULL;
3802 int num_reg_temp, num_reg_temp_mon;
3803 u8 cr2a;
3804 struct attribute_group *group;
3805 struct device *hwmon_dev;
3806 int num_attr_groups = 0;
3807
3808 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
3809 if (!devm_request_region(&pdev->dev, res->start, IOREGION_LENGTH,
3810 DRVNAME))
3811 return -EBUSY;
3812
3813 data = devm_kzalloc(&pdev->dev, sizeof(struct nct6775_data),
3814 GFP_KERNEL);
3815 if (!data)
3816 return -ENOMEM;
3817
3818 data->kind = sio_data->kind;
3819 data->sioreg = sio_data->sioreg;
3820 data->addr = res->start;
3821 mutex_init(&data->update_lock);
3822 data->name = nct6775_device_names[data->kind];
3823 data->bank = 0xff; /* Force initial bank selection */
3824 platform_set_drvdata(pdev, data);
3825
3826 switch (data->kind) {
3827 case nct6106:
3828 data->in_num = 9;
3829 data->pwm_num = 3;
3830 data->auto_pwm_num = 4;
3831 data->temp_fixed_num = 3;
3832 data->num_temp_alarms = 6;
3833 data->num_temp_beeps = 6;
3834
3835 data->fan_from_reg = fan_from_reg13;
3836 data->fan_from_reg_min = fan_from_reg13;
3837
3838 data->temp_label = nct6776_temp_label;
3839 data->temp_mask = NCT6776_TEMP_MASK;
3840 data->virt_temp_mask = NCT6776_VIRT_TEMP_MASK;
3841
3842 data->REG_VBAT = NCT6106_REG_VBAT;
3843 data->REG_DIODE = NCT6106_REG_DIODE;
3844 data->DIODE_MASK = NCT6106_DIODE_MASK;
3845 data->REG_VIN = NCT6106_REG_IN;
3846 data->REG_IN_MINMAX[0] = NCT6106_REG_IN_MIN;
3847 data->REG_IN_MINMAX[1] = NCT6106_REG_IN_MAX;
3848 data->REG_TARGET = NCT6106_REG_TARGET;
3849 data->REG_FAN = NCT6106_REG_FAN;
3850 data->REG_FAN_MODE = NCT6106_REG_FAN_MODE;
3851 data->REG_FAN_MIN = NCT6106_REG_FAN_MIN;
3852 data->REG_FAN_PULSES = NCT6106_REG_FAN_PULSES;
3853 data->FAN_PULSE_SHIFT = NCT6106_FAN_PULSE_SHIFT;
3854 data->REG_FAN_TIME[0] = NCT6106_REG_FAN_STOP_TIME;
3855 data->REG_FAN_TIME[1] = NCT6106_REG_FAN_STEP_UP_TIME;
3856 data->REG_FAN_TIME[2] = NCT6106_REG_FAN_STEP_DOWN_TIME;
3857 data->REG_TOLERANCE_H = NCT6106_REG_TOLERANCE_H;
3858 data->REG_PWM[0] = NCT6116_REG_PWM;
3859 data->REG_PWM[1] = NCT6106_REG_FAN_START_OUTPUT;
3860 data->REG_PWM[2] = NCT6106_REG_FAN_STOP_OUTPUT;
3861 data->REG_PWM[5] = NCT6106_REG_WEIGHT_DUTY_STEP;
3862 data->REG_PWM[6] = NCT6106_REG_WEIGHT_DUTY_BASE;
3863 data->REG_PWM_READ = NCT6106_REG_PWM_READ;
3864 data->REG_PWM_MODE = NCT6106_REG_PWM_MODE;
3865 data->PWM_MODE_MASK = NCT6106_PWM_MODE_MASK;
3866 data->REG_AUTO_TEMP = NCT6106_REG_AUTO_TEMP;
3867 data->REG_AUTO_PWM = NCT6106_REG_AUTO_PWM;
3868 data->REG_CRITICAL_TEMP = NCT6106_REG_CRITICAL_TEMP;
3869 data->REG_CRITICAL_TEMP_TOLERANCE
3870 = NCT6106_REG_CRITICAL_TEMP_TOLERANCE;
3871 data->REG_CRITICAL_PWM_ENABLE = NCT6106_REG_CRITICAL_PWM_ENABLE;
3872 data->CRITICAL_PWM_ENABLE_MASK
3873 = NCT6106_CRITICAL_PWM_ENABLE_MASK;
3874 data->REG_CRITICAL_PWM = NCT6106_REG_CRITICAL_PWM;
3875 data->REG_TEMP_OFFSET = NCT6106_REG_TEMP_OFFSET;
3876 data->REG_TEMP_SOURCE = NCT6106_REG_TEMP_SOURCE;
3877 data->REG_TEMP_SEL = NCT6116_REG_TEMP_SEL;
3878 data->REG_WEIGHT_TEMP_SEL = NCT6106_REG_WEIGHT_TEMP_SEL;
3879 data->REG_WEIGHT_TEMP[0] = NCT6106_REG_WEIGHT_TEMP_STEP;
3880 data->REG_WEIGHT_TEMP[1] = NCT6106_REG_WEIGHT_TEMP_STEP_TOL;
3881 data->REG_WEIGHT_TEMP[2] = NCT6106_REG_WEIGHT_TEMP_BASE;
3882 data->REG_ALARM = NCT6106_REG_ALARM;
3883 data->ALARM_BITS = NCT6106_ALARM_BITS;
3884 data->REG_BEEP = NCT6106_REG_BEEP;
3885 data->BEEP_BITS = NCT6106_BEEP_BITS;
3886
3887 reg_temp = NCT6106_REG_TEMP;
3888 reg_temp_mon = NCT6106_REG_TEMP_MON;
3889 num_reg_temp = ARRAY_SIZE(NCT6106_REG_TEMP);
3890 num_reg_temp_mon = ARRAY_SIZE(NCT6106_REG_TEMP_MON);
3891 reg_temp_over = NCT6106_REG_TEMP_OVER;
3892 reg_temp_hyst = NCT6106_REG_TEMP_HYST;
3893 reg_temp_config = NCT6106_REG_TEMP_CONFIG;
3894 reg_temp_alternate = NCT6106_REG_TEMP_ALTERNATE;
3895 reg_temp_crit = NCT6106_REG_TEMP_CRIT;
3896 reg_temp_crit_l = NCT6106_REG_TEMP_CRIT_L;
3897 reg_temp_crit_h = NCT6106_REG_TEMP_CRIT_H;
3898
3899 break;
3900 case nct6116:
3901 data->in_num = 9;
3902 data->pwm_num = 3;
3903 data->auto_pwm_num = 4;
3904 data->temp_fixed_num = 3;
3905 data->num_temp_alarms = 3;
3906 data->num_temp_beeps = 3;
3907
3908 data->fan_from_reg = fan_from_reg13;
3909 data->fan_from_reg_min = fan_from_reg13;
3910
3911 data->temp_label = nct6776_temp_label;
3912 data->temp_mask = NCT6776_TEMP_MASK;
3913 data->virt_temp_mask = NCT6776_VIRT_TEMP_MASK;
3914
3915 data->REG_VBAT = NCT6106_REG_VBAT;
3916 data->REG_DIODE = NCT6106_REG_DIODE;
3917 data->DIODE_MASK = NCT6106_DIODE_MASK;
3918 data->REG_VIN = NCT6106_REG_IN;
3919 data->REG_IN_MINMAX[0] = NCT6106_REG_IN_MIN;
3920 data->REG_IN_MINMAX[1] = NCT6106_REG_IN_MAX;
3921 data->REG_TARGET = NCT6116_REG_TARGET;
3922 data->REG_FAN = NCT6116_REG_FAN;
3923 data->REG_FAN_MODE = NCT6116_REG_FAN_MODE;
3924 data->REG_FAN_MIN = NCT6116_REG_FAN_MIN;
3925 data->REG_FAN_PULSES = NCT6116_REG_FAN_PULSES;
3926 data->FAN_PULSE_SHIFT = NCT6116_FAN_PULSE_SHIFT;
3927 data->REG_FAN_TIME[0] = NCT6116_REG_FAN_STOP_TIME;
3928 data->REG_FAN_TIME[1] = NCT6116_REG_FAN_STEP_UP_TIME;
3929 data->REG_FAN_TIME[2] = NCT6116_REG_FAN_STEP_DOWN_TIME;
3930 data->REG_TOLERANCE_H = NCT6116_REG_TOLERANCE_H;
3931 data->REG_PWM[0] = NCT6116_REG_PWM;
3932 data->REG_PWM[1] = NCT6116_REG_FAN_START_OUTPUT;
3933 data->REG_PWM[2] = NCT6116_REG_FAN_STOP_OUTPUT;
3934 data->REG_PWM[5] = NCT6106_REG_WEIGHT_DUTY_STEP;
3935 data->REG_PWM[6] = NCT6106_REG_WEIGHT_DUTY_BASE;
3936 data->REG_PWM_READ = NCT6106_REG_PWM_READ;
3937 data->REG_PWM_MODE = NCT6106_REG_PWM_MODE;
3938 data->PWM_MODE_MASK = NCT6106_PWM_MODE_MASK;
3939 data->REG_AUTO_TEMP = NCT6116_REG_AUTO_TEMP;
3940 data->REG_AUTO_PWM = NCT6116_REG_AUTO_PWM;
3941 data->REG_CRITICAL_TEMP = NCT6116_REG_CRITICAL_TEMP;
3942 data->REG_CRITICAL_TEMP_TOLERANCE
3943 = NCT6116_REG_CRITICAL_TEMP_TOLERANCE;
3944 data->REG_CRITICAL_PWM_ENABLE = NCT6116_REG_CRITICAL_PWM_ENABLE;
3945 data->CRITICAL_PWM_ENABLE_MASK
3946 = NCT6106_CRITICAL_PWM_ENABLE_MASK;
3947 data->REG_CRITICAL_PWM = NCT6116_REG_CRITICAL_PWM;
3948 data->REG_TEMP_OFFSET = NCT6106_REG_TEMP_OFFSET;
3949 data->REG_TEMP_SOURCE = NCT6116_REG_TEMP_SOURCE;
3950 data->REG_TEMP_SEL = NCT6116_REG_TEMP_SEL;
3951 data->REG_WEIGHT_TEMP_SEL = NCT6106_REG_WEIGHT_TEMP_SEL;
3952 data->REG_WEIGHT_TEMP[0] = NCT6106_REG_WEIGHT_TEMP_STEP;
3953 data->REG_WEIGHT_TEMP[1] = NCT6106_REG_WEIGHT_TEMP_STEP_TOL;
3954 data->REG_WEIGHT_TEMP[2] = NCT6106_REG_WEIGHT_TEMP_BASE;
3955 data->REG_ALARM = NCT6106_REG_ALARM;
3956 data->ALARM_BITS = NCT6116_ALARM_BITS;
3957 data->REG_BEEP = NCT6106_REG_BEEP;
3958 data->BEEP_BITS = NCT6116_BEEP_BITS;
3959
3960 reg_temp = NCT6106_REG_TEMP;
3961 reg_temp_mon = NCT6106_REG_TEMP_MON;
3962 num_reg_temp = ARRAY_SIZE(NCT6106_REG_TEMP);
3963 num_reg_temp_mon = ARRAY_SIZE(NCT6106_REG_TEMP_MON);
3964 reg_temp_over = NCT6106_REG_TEMP_OVER;
3965 reg_temp_hyst = NCT6106_REG_TEMP_HYST;
3966 reg_temp_config = NCT6106_REG_TEMP_CONFIG;
3967 reg_temp_alternate = NCT6106_REG_TEMP_ALTERNATE;
3968 reg_temp_crit = NCT6106_REG_TEMP_CRIT;
3969 reg_temp_crit_l = NCT6106_REG_TEMP_CRIT_L;
3970 reg_temp_crit_h = NCT6106_REG_TEMP_CRIT_H;
3971
3972 break;
3973 case nct6775:
3974 data->in_num = 9;
3975 data->pwm_num = 3;
3976 data->auto_pwm_num = 6;
3977 data->has_fan_div = true;
3978 data->temp_fixed_num = 3;
3979 data->num_temp_alarms = 3;
3980 data->num_temp_beeps = 3;
3981
3982 data->ALARM_BITS = NCT6775_ALARM_BITS;
3983 data->BEEP_BITS = NCT6775_BEEP_BITS;
3984
3985 data->fan_from_reg = fan_from_reg16;
3986 data->fan_from_reg_min = fan_from_reg8;
3987 data->target_temp_mask = 0x7f;
3988 data->tolerance_mask = 0x0f;
3989 data->speed_tolerance_limit = 15;
3990
3991 data->temp_label = nct6775_temp_label;
3992 data->temp_mask = NCT6775_TEMP_MASK;
3993 data->virt_temp_mask = NCT6775_VIRT_TEMP_MASK;
3994
3995 data->REG_CONFIG = NCT6775_REG_CONFIG;
3996 data->REG_VBAT = NCT6775_REG_VBAT;
3997 data->REG_DIODE = NCT6775_REG_DIODE;
3998 data->DIODE_MASK = NCT6775_DIODE_MASK;
3999 data->REG_VIN = NCT6775_REG_IN;
4000 data->REG_IN_MINMAX[0] = NCT6775_REG_IN_MIN;
4001 data->REG_IN_MINMAX[1] = NCT6775_REG_IN_MAX;
4002 data->REG_TARGET = NCT6775_REG_TARGET;
4003 data->REG_FAN = NCT6775_REG_FAN;
4004 data->REG_FAN_MODE = NCT6775_REG_FAN_MODE;
4005 data->REG_FAN_MIN = NCT6775_REG_FAN_MIN;
4006 data->REG_FAN_PULSES = NCT6775_REG_FAN_PULSES;
4007 data->FAN_PULSE_SHIFT = NCT6775_FAN_PULSE_SHIFT;
4008 data->REG_FAN_TIME[0] = NCT6775_REG_FAN_STOP_TIME;
4009 data->REG_FAN_TIME[1] = NCT6775_REG_FAN_STEP_UP_TIME;
4010 data->REG_FAN_TIME[2] = NCT6775_REG_FAN_STEP_DOWN_TIME;
4011 data->REG_PWM[0] = NCT6775_REG_PWM;
4012 data->REG_PWM[1] = NCT6775_REG_FAN_START_OUTPUT;
4013 data->REG_PWM[2] = NCT6775_REG_FAN_STOP_OUTPUT;
4014 data->REG_PWM[3] = NCT6775_REG_FAN_MAX_OUTPUT;
4015 data->REG_PWM[4] = NCT6775_REG_FAN_STEP_OUTPUT;
4016 data->REG_PWM[5] = NCT6775_REG_WEIGHT_DUTY_STEP;
4017 data->REG_PWM_READ = NCT6775_REG_PWM_READ;
4018 data->REG_PWM_MODE = NCT6775_REG_PWM_MODE;
4019 data->PWM_MODE_MASK = NCT6775_PWM_MODE_MASK;
4020 data->REG_AUTO_TEMP = NCT6775_REG_AUTO_TEMP;
4021 data->REG_AUTO_PWM = NCT6775_REG_AUTO_PWM;
4022 data->REG_CRITICAL_TEMP = NCT6775_REG_CRITICAL_TEMP;
4023 data->REG_CRITICAL_TEMP_TOLERANCE
4024 = NCT6775_REG_CRITICAL_TEMP_TOLERANCE;
4025 data->REG_TEMP_OFFSET = NCT6775_REG_TEMP_OFFSET;
4026 data->REG_TEMP_SOURCE = NCT6775_REG_TEMP_SOURCE;
4027 data->REG_TEMP_SEL = NCT6775_REG_TEMP_SEL;
4028 data->REG_WEIGHT_TEMP_SEL = NCT6775_REG_WEIGHT_TEMP_SEL;
4029 data->REG_WEIGHT_TEMP[0] = NCT6775_REG_WEIGHT_TEMP_STEP;
4030 data->REG_WEIGHT_TEMP[1] = NCT6775_REG_WEIGHT_TEMP_STEP_TOL;
4031 data->REG_WEIGHT_TEMP[2] = NCT6775_REG_WEIGHT_TEMP_BASE;
4032 data->REG_ALARM = NCT6775_REG_ALARM;
4033 data->REG_BEEP = NCT6775_REG_BEEP;
4034
4035 reg_temp = NCT6775_REG_TEMP;
4036 reg_temp_mon = NCT6775_REG_TEMP_MON;
4037 num_reg_temp = ARRAY_SIZE(NCT6775_REG_TEMP);
4038 num_reg_temp_mon = ARRAY_SIZE(NCT6775_REG_TEMP_MON);
4039 reg_temp_over = NCT6775_REG_TEMP_OVER;
4040 reg_temp_hyst = NCT6775_REG_TEMP_HYST;
4041 reg_temp_config = NCT6775_REG_TEMP_CONFIG;
4042 reg_temp_alternate = NCT6775_REG_TEMP_ALTERNATE;
4043 reg_temp_crit = NCT6775_REG_TEMP_CRIT;
4044
4045 break;
4046 case nct6776:
4047 data->in_num = 9;
4048 data->pwm_num = 3;
4049 data->auto_pwm_num = 4;
4050 data->has_fan_div = false;
4051 data->temp_fixed_num = 3;
4052 data->num_temp_alarms = 3;
4053 data->num_temp_beeps = 6;
4054
4055 data->ALARM_BITS = NCT6776_ALARM_BITS;
4056 data->BEEP_BITS = NCT6776_BEEP_BITS;
4057
4058 data->fan_from_reg = fan_from_reg13;
4059 data->fan_from_reg_min = fan_from_reg13;
4060 data->target_temp_mask = 0xff;
4061 data->tolerance_mask = 0x07;
4062 data->speed_tolerance_limit = 63;
4063
4064 data->temp_label = nct6776_temp_label;
4065 data->temp_mask = NCT6776_TEMP_MASK;
4066 data->virt_temp_mask = NCT6776_VIRT_TEMP_MASK;
4067
4068 data->REG_CONFIG = NCT6775_REG_CONFIG;
4069 data->REG_VBAT = NCT6775_REG_VBAT;
4070 data->REG_DIODE = NCT6775_REG_DIODE;
4071 data->DIODE_MASK = NCT6775_DIODE_MASK;
4072 data->REG_VIN = NCT6775_REG_IN;
4073 data->REG_IN_MINMAX[0] = NCT6775_REG_IN_MIN;
4074 data->REG_IN_MINMAX[1] = NCT6775_REG_IN_MAX;
4075 data->REG_TARGET = NCT6775_REG_TARGET;
4076 data->REG_FAN = NCT6775_REG_FAN;
4077 data->REG_FAN_MODE = NCT6775_REG_FAN_MODE;
4078 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
4079 data->REG_FAN_PULSES = NCT6776_REG_FAN_PULSES;
4080 data->FAN_PULSE_SHIFT = NCT6775_FAN_PULSE_SHIFT;
4081 data->REG_FAN_TIME[0] = NCT6775_REG_FAN_STOP_TIME;
4082 data->REG_FAN_TIME[1] = NCT6776_REG_FAN_STEP_UP_TIME;
4083 data->REG_FAN_TIME[2] = NCT6776_REG_FAN_STEP_DOWN_TIME;
4084 data->REG_TOLERANCE_H = NCT6776_REG_TOLERANCE_H;
4085 data->REG_PWM[0] = NCT6775_REG_PWM;
4086 data->REG_PWM[1] = NCT6775_REG_FAN_START_OUTPUT;
4087 data->REG_PWM[2] = NCT6775_REG_FAN_STOP_OUTPUT;
4088 data->REG_PWM[5] = NCT6775_REG_WEIGHT_DUTY_STEP;
4089 data->REG_PWM[6] = NCT6776_REG_WEIGHT_DUTY_BASE;
4090 data->REG_PWM_READ = NCT6775_REG_PWM_READ;
4091 data->REG_PWM_MODE = NCT6776_REG_PWM_MODE;
4092 data->PWM_MODE_MASK = NCT6776_PWM_MODE_MASK;
4093 data->REG_AUTO_TEMP = NCT6775_REG_AUTO_TEMP;
4094 data->REG_AUTO_PWM = NCT6775_REG_AUTO_PWM;
4095 data->REG_CRITICAL_TEMP = NCT6775_REG_CRITICAL_TEMP;
4096 data->REG_CRITICAL_TEMP_TOLERANCE
4097 = NCT6775_REG_CRITICAL_TEMP_TOLERANCE;
4098 data->REG_TEMP_OFFSET = NCT6775_REG_TEMP_OFFSET;
4099 data->REG_TEMP_SOURCE = NCT6775_REG_TEMP_SOURCE;
4100 data->REG_TEMP_SEL = NCT6775_REG_TEMP_SEL;
4101 data->REG_WEIGHT_TEMP_SEL = NCT6775_REG_WEIGHT_TEMP_SEL;
4102 data->REG_WEIGHT_TEMP[0] = NCT6775_REG_WEIGHT_TEMP_STEP;
4103 data->REG_WEIGHT_TEMP[1] = NCT6775_REG_WEIGHT_TEMP_STEP_TOL;
4104 data->REG_WEIGHT_TEMP[2] = NCT6775_REG_WEIGHT_TEMP_BASE;
4105 data->REG_ALARM = NCT6775_REG_ALARM;
4106 data->REG_BEEP = NCT6776_REG_BEEP;
4107
4108 reg_temp = NCT6775_REG_TEMP;
4109 reg_temp_mon = NCT6775_REG_TEMP_MON;
4110 num_reg_temp = ARRAY_SIZE(NCT6775_REG_TEMP);
4111 num_reg_temp_mon = ARRAY_SIZE(NCT6775_REG_TEMP_MON);
4112 reg_temp_over = NCT6775_REG_TEMP_OVER;
4113 reg_temp_hyst = NCT6775_REG_TEMP_HYST;
4114 reg_temp_config = NCT6776_REG_TEMP_CONFIG;
4115 reg_temp_alternate = NCT6776_REG_TEMP_ALTERNATE;
4116 reg_temp_crit = NCT6776_REG_TEMP_CRIT;
4117
4118 break;
4119 case nct6779:
4120 data->in_num = 15;
4121 data->pwm_num = 5;
4122 data->auto_pwm_num = 4;
4123 data->has_fan_div = false;
4124 data->temp_fixed_num = 6;
4125 data->num_temp_alarms = 2;
4126 data->num_temp_beeps = 2;
4127
4128 data->ALARM_BITS = NCT6779_ALARM_BITS;
4129 data->BEEP_BITS = NCT6779_BEEP_BITS;
4130
4131 data->fan_from_reg = fan_from_reg_rpm;
4132 data->fan_from_reg_min = fan_from_reg13;
4133 data->target_temp_mask = 0xff;
4134 data->tolerance_mask = 0x07;
4135 data->speed_tolerance_limit = 63;
4136
4137 data->temp_label = nct6779_temp_label;
4138 data->temp_mask = NCT6779_TEMP_MASK;
4139 data->virt_temp_mask = NCT6779_VIRT_TEMP_MASK;
4140
4141 data->REG_CONFIG = NCT6775_REG_CONFIG;
4142 data->REG_VBAT = NCT6775_REG_VBAT;
4143 data->REG_DIODE = NCT6775_REG_DIODE;
4144 data->DIODE_MASK = NCT6775_DIODE_MASK;
4145 data->REG_VIN = NCT6779_REG_IN;
4146 data->REG_IN_MINMAX[0] = NCT6775_REG_IN_MIN;
4147 data->REG_IN_MINMAX[1] = NCT6775_REG_IN_MAX;
4148 data->REG_TARGET = NCT6775_REG_TARGET;
4149 data->REG_FAN = NCT6779_REG_FAN;
4150 data->REG_FAN_MODE = NCT6775_REG_FAN_MODE;
4151 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
4152 data->REG_FAN_PULSES = NCT6779_REG_FAN_PULSES;
4153 data->FAN_PULSE_SHIFT = NCT6775_FAN_PULSE_SHIFT;
4154 data->REG_FAN_TIME[0] = NCT6775_REG_FAN_STOP_TIME;
4155 data->REG_FAN_TIME[1] = NCT6776_REG_FAN_STEP_UP_TIME;
4156 data->REG_FAN_TIME[2] = NCT6776_REG_FAN_STEP_DOWN_TIME;
4157 data->REG_TOLERANCE_H = NCT6776_REG_TOLERANCE_H;
4158 data->REG_PWM[0] = NCT6775_REG_PWM;
4159 data->REG_PWM[1] = NCT6775_REG_FAN_START_OUTPUT;
4160 data->REG_PWM[2] = NCT6775_REG_FAN_STOP_OUTPUT;
4161 data->REG_PWM[5] = NCT6775_REG_WEIGHT_DUTY_STEP;
4162 data->REG_PWM[6] = NCT6776_REG_WEIGHT_DUTY_BASE;
4163 data->REG_PWM_READ = NCT6775_REG_PWM_READ;
4164 data->REG_PWM_MODE = NCT6776_REG_PWM_MODE;
4165 data->PWM_MODE_MASK = NCT6776_PWM_MODE_MASK;
4166 data->REG_AUTO_TEMP = NCT6775_REG_AUTO_TEMP;
4167 data->REG_AUTO_PWM = NCT6775_REG_AUTO_PWM;
4168 data->REG_CRITICAL_TEMP = NCT6775_REG_CRITICAL_TEMP;
4169 data->REG_CRITICAL_TEMP_TOLERANCE
4170 = NCT6775_REG_CRITICAL_TEMP_TOLERANCE;
4171 data->REG_CRITICAL_PWM_ENABLE = NCT6779_REG_CRITICAL_PWM_ENABLE;
4172 data->CRITICAL_PWM_ENABLE_MASK
4173 = NCT6779_CRITICAL_PWM_ENABLE_MASK;
4174 data->REG_CRITICAL_PWM = NCT6779_REG_CRITICAL_PWM;
4175 data->REG_TEMP_OFFSET = NCT6779_REG_TEMP_OFFSET;
4176 data->REG_TEMP_SOURCE = NCT6775_REG_TEMP_SOURCE;
4177 data->REG_TEMP_SEL = NCT6775_REG_TEMP_SEL;
4178 data->REG_WEIGHT_TEMP_SEL = NCT6775_REG_WEIGHT_TEMP_SEL;
4179 data->REG_WEIGHT_TEMP[0] = NCT6775_REG_WEIGHT_TEMP_STEP;
4180 data->REG_WEIGHT_TEMP[1] = NCT6775_REG_WEIGHT_TEMP_STEP_TOL;
4181 data->REG_WEIGHT_TEMP[2] = NCT6775_REG_WEIGHT_TEMP_BASE;
4182 data->REG_ALARM = NCT6779_REG_ALARM;
4183 data->REG_BEEP = NCT6776_REG_BEEP;
4184
4185 reg_temp = NCT6779_REG_TEMP;
4186 reg_temp_mon = NCT6779_REG_TEMP_MON;
4187 num_reg_temp = ARRAY_SIZE(NCT6779_REG_TEMP);
4188 num_reg_temp_mon = ARRAY_SIZE(NCT6779_REG_TEMP_MON);
4189 reg_temp_over = NCT6779_REG_TEMP_OVER;
4190 reg_temp_hyst = NCT6779_REG_TEMP_HYST;
4191 reg_temp_config = NCT6779_REG_TEMP_CONFIG;
4192 reg_temp_alternate = NCT6779_REG_TEMP_ALTERNATE;
4193 reg_temp_crit = NCT6779_REG_TEMP_CRIT;
4194
4195 break;
4196 case nct6791:
4197 case nct6792:
4198 case nct6793:
4199 case nct6795:
4200 case nct6796:
4201 case nct6797:
4202 case nct6798:
4203 data->in_num = 15;
4204 data->pwm_num = (data->kind == nct6796 ||
4205 data->kind == nct6797 ||
4206 data->kind == nct6798) ? 7 : 6;
4207 data->auto_pwm_num = 4;
4208 data->has_fan_div = false;
4209 data->temp_fixed_num = 6;
4210 data->num_temp_alarms = 2;
4211 data->num_temp_beeps = 2;
4212
4213 data->ALARM_BITS = NCT6791_ALARM_BITS;
4214 data->BEEP_BITS = NCT6779_BEEP_BITS;
4215
4216 data->fan_from_reg = fan_from_reg_rpm;
4217 data->fan_from_reg_min = fan_from_reg13;
4218 data->target_temp_mask = 0xff;
4219 data->tolerance_mask = 0x07;
4220 data->speed_tolerance_limit = 63;
4221
4222 switch (data->kind) {
4223 default:
4224 case nct6791:
4225 data->temp_label = nct6779_temp_label;
4226 data->temp_mask = NCT6791_TEMP_MASK;
4227 data->virt_temp_mask = NCT6791_VIRT_TEMP_MASK;
4228 break;
4229 case nct6792:
4230 data->temp_label = nct6792_temp_label;
4231 data->temp_mask = NCT6792_TEMP_MASK;
4232 data->virt_temp_mask = NCT6792_VIRT_TEMP_MASK;
4233 break;
4234 case nct6793:
4235 data->temp_label = nct6793_temp_label;
4236 data->temp_mask = NCT6793_TEMP_MASK;
4237 data->virt_temp_mask = NCT6793_VIRT_TEMP_MASK;
4238 break;
4239 case nct6795:
4240 case nct6797:
4241 data->temp_label = nct6795_temp_label;
4242 data->temp_mask = NCT6795_TEMP_MASK;
4243 data->virt_temp_mask = NCT6795_VIRT_TEMP_MASK;
4244 break;
4245 case nct6796:
4246 data->temp_label = nct6796_temp_label;
4247 data->temp_mask = NCT6796_TEMP_MASK;
4248 data->virt_temp_mask = NCT6796_VIRT_TEMP_MASK;
4249 break;
4250 case nct6798:
4251 data->temp_label = nct6798_temp_label;
4252 data->temp_mask = NCT6798_TEMP_MASK;
4253 data->virt_temp_mask = NCT6798_VIRT_TEMP_MASK;
4254 break;
4255 }
4256
4257 data->REG_CONFIG = NCT6775_REG_CONFIG;
4258 data->REG_VBAT = NCT6775_REG_VBAT;
4259 data->REG_DIODE = NCT6775_REG_DIODE;
4260 data->DIODE_MASK = NCT6775_DIODE_MASK;
4261 data->REG_VIN = NCT6779_REG_IN;
4262 data->REG_IN_MINMAX[0] = NCT6775_REG_IN_MIN;
4263 data->REG_IN_MINMAX[1] = NCT6775_REG_IN_MAX;
4264 data->REG_TARGET = NCT6775_REG_TARGET;
4265 data->REG_FAN = NCT6779_REG_FAN;
4266 data->REG_FAN_MODE = NCT6775_REG_FAN_MODE;
4267 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN;
4268 data->REG_FAN_PULSES = NCT6779_REG_FAN_PULSES;
4269 data->FAN_PULSE_SHIFT = NCT6775_FAN_PULSE_SHIFT;
4270 data->REG_FAN_TIME[0] = NCT6775_REG_FAN_STOP_TIME;
4271 data->REG_FAN_TIME[1] = NCT6776_REG_FAN_STEP_UP_TIME;
4272 data->REG_FAN_TIME[2] = NCT6776_REG_FAN_STEP_DOWN_TIME;
4273 data->REG_TOLERANCE_H = NCT6776_REG_TOLERANCE_H;
4274 data->REG_PWM[0] = NCT6775_REG_PWM;
4275 data->REG_PWM[1] = NCT6775_REG_FAN_START_OUTPUT;
4276 data->REG_PWM[2] = NCT6775_REG_FAN_STOP_OUTPUT;
4277 data->REG_PWM[5] = NCT6791_REG_WEIGHT_DUTY_STEP;
4278 data->REG_PWM[6] = NCT6791_REG_WEIGHT_DUTY_BASE;
4279 data->REG_PWM_READ = NCT6775_REG_PWM_READ;
4280 data->REG_PWM_MODE = NCT6776_REG_PWM_MODE;
4281 data->PWM_MODE_MASK = NCT6776_PWM_MODE_MASK;
4282 data->REG_AUTO_TEMP = NCT6775_REG_AUTO_TEMP;
4283 data->REG_AUTO_PWM = NCT6775_REG_AUTO_PWM;
4284 data->REG_CRITICAL_TEMP = NCT6775_REG_CRITICAL_TEMP;
4285 data->REG_CRITICAL_TEMP_TOLERANCE
4286 = NCT6775_REG_CRITICAL_TEMP_TOLERANCE;
4287 data->REG_CRITICAL_PWM_ENABLE = NCT6779_REG_CRITICAL_PWM_ENABLE;
4288 data->CRITICAL_PWM_ENABLE_MASK
4289 = NCT6779_CRITICAL_PWM_ENABLE_MASK;
4290 data->REG_CRITICAL_PWM = NCT6779_REG_CRITICAL_PWM;
4291 data->REG_TEMP_OFFSET = NCT6779_REG_TEMP_OFFSET;
4292 data->REG_TEMP_SOURCE = NCT6775_REG_TEMP_SOURCE;
4293 data->REG_TEMP_SEL = NCT6775_REG_TEMP_SEL;
4294 data->REG_WEIGHT_TEMP_SEL = NCT6791_REG_WEIGHT_TEMP_SEL;
4295 data->REG_WEIGHT_TEMP[0] = NCT6791_REG_WEIGHT_TEMP_STEP;
4296 data->REG_WEIGHT_TEMP[1] = NCT6791_REG_WEIGHT_TEMP_STEP_TOL;
4297 data->REG_WEIGHT_TEMP[2] = NCT6791_REG_WEIGHT_TEMP_BASE;
4298 data->REG_ALARM = NCT6791_REG_ALARM;
4299 if (data->kind == nct6791)
4300 data->REG_BEEP = NCT6776_REG_BEEP;
4301 else
4302 data->REG_BEEP = NCT6792_REG_BEEP;
4303
4304 reg_temp = NCT6779_REG_TEMP;
4305 num_reg_temp = ARRAY_SIZE(NCT6779_REG_TEMP);
4306 if (data->kind == nct6791) {
4307 reg_temp_mon = NCT6779_REG_TEMP_MON;
4308 num_reg_temp_mon = ARRAY_SIZE(NCT6779_REG_TEMP_MON);
4309 } else {
4310 reg_temp_mon = NCT6792_REG_TEMP_MON;
4311 num_reg_temp_mon = ARRAY_SIZE(NCT6792_REG_TEMP_MON);
4312 }
4313 reg_temp_over = NCT6779_REG_TEMP_OVER;
4314 reg_temp_hyst = NCT6779_REG_TEMP_HYST;
4315 reg_temp_config = NCT6779_REG_TEMP_CONFIG;
4316 reg_temp_alternate = NCT6779_REG_TEMP_ALTERNATE;
4317 reg_temp_crit = NCT6779_REG_TEMP_CRIT;
4318
4319 break;
4320 default:
4321 return -ENODEV;
4322 }
4323 data->have_in = BIT(data->in_num) - 1;
4324 data->have_temp = 0;
4325
4326 /*
4327 * On some boards, not all available temperature sources are monitored,
4328 * even though some of the monitoring registers are unused.
4329 * Get list of unused monitoring registers, then detect if any fan
4330 * controls are configured to use unmonitored temperature sources.
4331 * If so, assign the unmonitored temperature sources to available
4332 * monitoring registers.
4333 */
4334 mask = 0;
4335 available = 0;
4336 for (i = 0; i < num_reg_temp; i++) {
4337 if (reg_temp[i] == 0)
4338 continue;
4339
4340 src = nct6775_read_value(data, data->REG_TEMP_SOURCE[i]) & 0x1f;
4341 if (!src || (mask & BIT(src)))
4342 available |= BIT(i);
4343
4344 mask |= BIT(src);
4345 }
4346
4347 /*
4348 * Now find unmonitored temperature registers and enable monitoring
4349 * if additional monitoring registers are available.
4350 */
4351 add_temp_sensors(data, data->REG_TEMP_SEL, &available, &mask);
4352 add_temp_sensors(data, data->REG_WEIGHT_TEMP_SEL, &available, &mask);
4353
4354 mask = 0;
4355 s = NUM_TEMP_FIXED; /* First dynamic temperature attribute */
4356 for (i = 0; i < num_reg_temp; i++) {
4357 if (reg_temp[i] == 0)
4358 continue;
4359
4360 src = nct6775_read_value(data, data->REG_TEMP_SOURCE[i]) & 0x1f;
4361 if (!src || (mask & BIT(src)))
4362 continue;
4363
4364 if (!(data->temp_mask & BIT(src))) {
4365 dev_info(dev,
4366 "Invalid temperature source %d at index %d, source register 0x%x, temp register 0x%x\n",
4367 src, i, data->REG_TEMP_SOURCE[i], reg_temp[i]);
4368 continue;
4369 }
4370
4371 mask |= BIT(src);
4372
4373 /* Use fixed index for SYSTIN(1), CPUTIN(2), AUXTIN(3) */
4374 if (src <= data->temp_fixed_num) {
4375 data->have_temp |= BIT(src - 1);
4376 data->have_temp_fixed |= BIT(src - 1);
4377 data->reg_temp[0][src - 1] = reg_temp[i];
4378 data->reg_temp[1][src - 1] = reg_temp_over[i];
4379 data->reg_temp[2][src - 1] = reg_temp_hyst[i];
4380 if (reg_temp_crit_h && reg_temp_crit_h[i])
4381 data->reg_temp[3][src - 1] = reg_temp_crit_h[i];
4382 else if (reg_temp_crit[src - 1])
4383 data->reg_temp[3][src - 1]
4384 = reg_temp_crit[src - 1];
4385 if (reg_temp_crit_l && reg_temp_crit_l[i])
4386 data->reg_temp[4][src - 1] = reg_temp_crit_l[i];
4387 data->reg_temp_config[src - 1] = reg_temp_config[i];
4388 data->temp_src[src - 1] = src;
4389 continue;
4390 }
4391
4392 if (s >= NUM_TEMP)
4393 continue;
4394
4395 /* Use dynamic index for other sources */
4396 data->have_temp |= BIT(s);
4397 data->reg_temp[0][s] = reg_temp[i];
4398 data->reg_temp[1][s] = reg_temp_over[i];
4399 data->reg_temp[2][s] = reg_temp_hyst[i];
4400 data->reg_temp_config[s] = reg_temp_config[i];
4401 if (reg_temp_crit_h && reg_temp_crit_h[i])
4402 data->reg_temp[3][s] = reg_temp_crit_h[i];
4403 else if (reg_temp_crit[src - 1])
4404 data->reg_temp[3][s] = reg_temp_crit[src - 1];
4405 if (reg_temp_crit_l && reg_temp_crit_l[i])
4406 data->reg_temp[4][s] = reg_temp_crit_l[i];
4407
4408 data->temp_src[s] = src;
4409 s++;
4410 }
4411
4412 /*
4413 * Repeat with temperatures used for fan control.
4414 * This set of registers does not support limits.
4415 */
4416 for (i = 0; i < num_reg_temp_mon; i++) {
4417 if (reg_temp_mon[i] == 0)
4418 continue;
4419
4420 src = nct6775_read_value(data, data->REG_TEMP_SEL[i]) & 0x1f;
4421 if (!src)
4422 continue;
4423
4424 if (!(data->temp_mask & BIT(src))) {
4425 dev_info(dev,
4426 "Invalid temperature source %d at index %d, source register 0x%x, temp register 0x%x\n",
4427 src, i, data->REG_TEMP_SEL[i],
4428 reg_temp_mon[i]);
4429 continue;
4430 }
4431
4432 /*
4433 * For virtual temperature sources, the 'virtual' temperature
4434 * for each fan reflects a different temperature, and there
4435 * are no duplicates.
4436 */
4437 if (!(data->virt_temp_mask & BIT(src))) {
4438 if (mask & BIT(src))
4439 continue;
4440 mask |= BIT(src);
4441 }
4442
4443 /* Use fixed index for SYSTIN(1), CPUTIN(2), AUXTIN(3) */
4444 if (src <= data->temp_fixed_num) {
4445 if (data->have_temp & BIT(src - 1))
4446 continue;
4447 data->have_temp |= BIT(src - 1);
4448 data->have_temp_fixed |= BIT(src - 1);
4449 data->reg_temp[0][src - 1] = reg_temp_mon[i];
4450 data->temp_src[src - 1] = src;
4451 continue;
4452 }
4453
4454 if (s >= NUM_TEMP)
4455 continue;
4456
4457 /* Use dynamic index for other sources */
4458 data->have_temp |= BIT(s);
4459 data->reg_temp[0][s] = reg_temp_mon[i];
4460 data->temp_src[s] = src;
4461 s++;
4462 }
4463
4464 #ifdef USE_ALTERNATE
4465 /*
4466 * Go through the list of alternate temp registers and enable
4467 * if possible.
4468 * The temperature is already monitored if the respective bit in <mask>
4469 * is set.
4470 */
4471 for (i = 0; i < 31; i++) {
4472 if (!(data->temp_mask & BIT(i + 1)))
4473 continue;
4474 if (!reg_temp_alternate[i])
4475 continue;
4476 if (mask & BIT(i + 1))
4477 continue;
4478 if (i < data->temp_fixed_num) {
4479 if (data->have_temp & BIT(i))
4480 continue;
4481 data->have_temp |= BIT(i);
4482 data->have_temp_fixed |= BIT(i);
4483 data->reg_temp[0][i] = reg_temp_alternate[i];
4484 if (i < num_reg_temp) {
4485 data->reg_temp[1][i] = reg_temp_over[i];
4486 data->reg_temp[2][i] = reg_temp_hyst[i];
4487 }
4488 data->temp_src[i] = i + 1;
4489 continue;
4490 }
4491
4492 if (s >= NUM_TEMP) /* Abort if no more space */
4493 break;
4494
4495 data->have_temp |= BIT(s);
4496 data->reg_temp[0][s] = reg_temp_alternate[i];
4497 data->temp_src[s] = i + 1;
4498 s++;
4499 }
4500 #endif /* USE_ALTERNATE */
4501
4502 /* Initialize the chip */
4503 nct6775_init_device(data);
4504
4505 err = superio_enter(sio_data->sioreg);
4506 if (err)
4507 return err;
4508
4509 cr2a = superio_inb(sio_data->sioreg, 0x2a);
4510 switch (data->kind) {
4511 case nct6775:
4512 data->have_vid = (cr2a & 0x40);
4513 break;
4514 case nct6776:
4515 data->have_vid = (cr2a & 0x60) == 0x40;
4516 break;
4517 case nct6106:
4518 case nct6116:
4519 case nct6779:
4520 case nct6791:
4521 case nct6792:
4522 case nct6793:
4523 case nct6795:
4524 case nct6796:
4525 case nct6797:
4526 case nct6798:
4527 break;
4528 }
4529
4530 /*
4531 * Read VID value
4532 * We can get the VID input values directly at logical device D 0xe3.
4533 */
4534 if (data->have_vid) {
4535 superio_select(sio_data->sioreg, NCT6775_LD_VID);
4536 data->vid = superio_inb(sio_data->sioreg, 0xe3);
4537 data->vrm = vid_which_vrm();
4538 }
4539
4540 if (fan_debounce) {
4541 u8 tmp;
4542
4543 superio_select(sio_data->sioreg, NCT6775_LD_HWM);
4544 tmp = superio_inb(sio_data->sioreg,
4545 NCT6775_REG_CR_FAN_DEBOUNCE);
4546 switch (data->kind) {
4547 case nct6106:
4548 case nct6116:
4549 tmp |= 0xe0;
4550 break;
4551 case nct6775:
4552 tmp |= 0x1e;
4553 break;
4554 case nct6776:
4555 case nct6779:
4556 tmp |= 0x3e;
4557 break;
4558 case nct6791:
4559 case nct6792:
4560 case nct6793:
4561 case nct6795:
4562 case nct6796:
4563 case nct6797:
4564 case nct6798:
4565 tmp |= 0x7e;
4566 break;
4567 }
4568 superio_outb(sio_data->sioreg, NCT6775_REG_CR_FAN_DEBOUNCE,
4569 tmp);
4570 dev_info(&pdev->dev, "Enabled fan debounce for chip %s\n",
4571 data->name);
4572 }
4573
4574 nct6775_check_fan_inputs(data);
4575
4576 superio_exit(sio_data->sioreg);
4577
4578 /* Read fan clock dividers immediately */
4579 nct6775_init_fan_common(dev, data);
4580
4581 /* Register sysfs hooks */
4582 group = nct6775_create_attr_group(dev, &nct6775_pwm_template_group,
4583 data->pwm_num);
4584 if (IS_ERR(group))
4585 return PTR_ERR(group);
4586
4587 data->groups[num_attr_groups++] = group;
4588
4589 group = nct6775_create_attr_group(dev, &nct6775_in_template_group,
4590 fls(data->have_in));
4591 if (IS_ERR(group))
4592 return PTR_ERR(group);
4593
4594 data->groups[num_attr_groups++] = group;
4595
4596 group = nct6775_create_attr_group(dev, &nct6775_fan_template_group,
4597 fls(data->has_fan));
4598 if (IS_ERR(group))
4599 return PTR_ERR(group);
4600
4601 data->groups[num_attr_groups++] = group;
4602
4603 group = nct6775_create_attr_group(dev, &nct6775_temp_template_group,
4604 fls(data->have_temp));
4605 if (IS_ERR(group))
4606 return PTR_ERR(group);
4607
4608 data->groups[num_attr_groups++] = group;
4609 data->groups[num_attr_groups++] = &nct6775_group_other;
4610
4611 hwmon_dev = devm_hwmon_device_register_with_groups(dev, data->name,
4612 data, data->groups);
4613 return PTR_ERR_OR_ZERO(hwmon_dev);
4614 }
4615
nct6791_enable_io_mapping(int sioaddr)4616 static void nct6791_enable_io_mapping(int sioaddr)
4617 {
4618 int val;
4619
4620 val = superio_inb(sioaddr, NCT6791_REG_HM_IO_SPACE_LOCK_ENABLE);
4621 if (val & 0x10) {
4622 pr_info("Enabling hardware monitor logical device mappings.\n");
4623 superio_outb(sioaddr, NCT6791_REG_HM_IO_SPACE_LOCK_ENABLE,
4624 val & ~0x10);
4625 }
4626 }
4627
nct6775_suspend(struct device * dev)4628 static int __maybe_unused nct6775_suspend(struct device *dev)
4629 {
4630 struct nct6775_data *data = nct6775_update_device(dev);
4631
4632 mutex_lock(&data->update_lock);
4633 data->vbat = nct6775_read_value(data, data->REG_VBAT);
4634 if (data->kind == nct6775) {
4635 data->fandiv1 = nct6775_read_value(data, NCT6775_REG_FANDIV1);
4636 data->fandiv2 = nct6775_read_value(data, NCT6775_REG_FANDIV2);
4637 }
4638 mutex_unlock(&data->update_lock);
4639
4640 return 0;
4641 }
4642
nct6775_resume(struct device * dev)4643 static int __maybe_unused nct6775_resume(struct device *dev)
4644 {
4645 struct nct6775_data *data = dev_get_drvdata(dev);
4646 int sioreg = data->sioreg;
4647 int i, j, err = 0;
4648 u8 reg;
4649
4650 mutex_lock(&data->update_lock);
4651 data->bank = 0xff; /* Force initial bank selection */
4652
4653 err = superio_enter(sioreg);
4654 if (err)
4655 goto abort;
4656
4657 superio_select(sioreg, NCT6775_LD_HWM);
4658 reg = superio_inb(sioreg, SIO_REG_ENABLE);
4659 if (reg != data->sio_reg_enable)
4660 superio_outb(sioreg, SIO_REG_ENABLE, data->sio_reg_enable);
4661
4662 if (data->kind == nct6791 || data->kind == nct6792 ||
4663 data->kind == nct6793 || data->kind == nct6795 ||
4664 data->kind == nct6796 || data->kind == nct6797 ||
4665 data->kind == nct6798)
4666 nct6791_enable_io_mapping(sioreg);
4667
4668 superio_exit(sioreg);
4669
4670 /* Restore limits */
4671 for (i = 0; i < data->in_num; i++) {
4672 if (!(data->have_in & BIT(i)))
4673 continue;
4674
4675 nct6775_write_value(data, data->REG_IN_MINMAX[0][i],
4676 data->in[i][1]);
4677 nct6775_write_value(data, data->REG_IN_MINMAX[1][i],
4678 data->in[i][2]);
4679 }
4680
4681 for (i = 0; i < ARRAY_SIZE(data->fan_min); i++) {
4682 if (!(data->has_fan_min & BIT(i)))
4683 continue;
4684
4685 nct6775_write_value(data, data->REG_FAN_MIN[i],
4686 data->fan_min[i]);
4687 }
4688
4689 for (i = 0; i < NUM_TEMP; i++) {
4690 if (!(data->have_temp & BIT(i)))
4691 continue;
4692
4693 for (j = 1; j < ARRAY_SIZE(data->reg_temp); j++)
4694 if (data->reg_temp[j][i])
4695 nct6775_write_temp(data, data->reg_temp[j][i],
4696 data->temp[j][i]);
4697 }
4698
4699 /* Restore other settings */
4700 nct6775_write_value(data, data->REG_VBAT, data->vbat);
4701 if (data->kind == nct6775) {
4702 nct6775_write_value(data, NCT6775_REG_FANDIV1, data->fandiv1);
4703 nct6775_write_value(data, NCT6775_REG_FANDIV2, data->fandiv2);
4704 }
4705
4706 abort:
4707 /* Force re-reading all values */
4708 data->valid = false;
4709 mutex_unlock(&data->update_lock);
4710
4711 return err;
4712 }
4713
4714 static SIMPLE_DEV_PM_OPS(nct6775_dev_pm_ops, nct6775_suspend, nct6775_resume);
4715
4716 static struct platform_driver nct6775_driver = {
4717 .driver = {
4718 .name = DRVNAME,
4719 .pm = &nct6775_dev_pm_ops,
4720 },
4721 .probe = nct6775_probe,
4722 };
4723
4724 /* nct6775_find() looks for a '627 in the Super-I/O config space */
nct6775_find(int sioaddr,struct nct6775_sio_data * sio_data)4725 static int __init nct6775_find(int sioaddr, struct nct6775_sio_data *sio_data)
4726 {
4727 u16 val;
4728 int err;
4729 int addr;
4730
4731 err = superio_enter(sioaddr);
4732 if (err)
4733 return err;
4734
4735 val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8) |
4736 superio_inb(sioaddr, SIO_REG_DEVID + 1);
4737 if (force_id && val != 0xffff)
4738 val = force_id;
4739
4740 switch (val & SIO_ID_MASK) {
4741 case SIO_NCT6106_ID:
4742 sio_data->kind = nct6106;
4743 break;
4744 case SIO_NCT6116_ID:
4745 sio_data->kind = nct6116;
4746 break;
4747 case SIO_NCT6775_ID:
4748 sio_data->kind = nct6775;
4749 break;
4750 case SIO_NCT6776_ID:
4751 sio_data->kind = nct6776;
4752 break;
4753 case SIO_NCT6779_ID:
4754 sio_data->kind = nct6779;
4755 break;
4756 case SIO_NCT6791_ID:
4757 sio_data->kind = nct6791;
4758 break;
4759 case SIO_NCT6792_ID:
4760 sio_data->kind = nct6792;
4761 break;
4762 case SIO_NCT6793_ID:
4763 sio_data->kind = nct6793;
4764 break;
4765 case SIO_NCT6795_ID:
4766 sio_data->kind = nct6795;
4767 break;
4768 case SIO_NCT6796_ID:
4769 sio_data->kind = nct6796;
4770 break;
4771 case SIO_NCT6797_ID:
4772 sio_data->kind = nct6797;
4773 break;
4774 case SIO_NCT6798_ID:
4775 sio_data->kind = nct6798;
4776 break;
4777 default:
4778 if (val != 0xffff)
4779 pr_debug("unsupported chip ID: 0x%04x\n", val);
4780 superio_exit(sioaddr);
4781 return -ENODEV;
4782 }
4783
4784 /* We have a known chip, find the HWM I/O address */
4785 superio_select(sioaddr, NCT6775_LD_HWM);
4786 val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8)
4787 | superio_inb(sioaddr, SIO_REG_ADDR + 1);
4788 addr = val & IOREGION_ALIGNMENT;
4789 if (addr == 0) {
4790 pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n");
4791 superio_exit(sioaddr);
4792 return -ENODEV;
4793 }
4794
4795 /* Activate logical device if needed */
4796 val = superio_inb(sioaddr, SIO_REG_ENABLE);
4797 if (!(val & 0x01)) {
4798 pr_warn("Forcibly enabling Super-I/O. Sensor is probably unusable.\n");
4799 superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01);
4800 }
4801
4802 if (sio_data->kind == nct6791 || sio_data->kind == nct6792 ||
4803 sio_data->kind == nct6793 || sio_data->kind == nct6795 ||
4804 sio_data->kind == nct6796 || sio_data->kind == nct6797 ||
4805 sio_data->kind == nct6798)
4806 nct6791_enable_io_mapping(sioaddr);
4807
4808 superio_exit(sioaddr);
4809 pr_info("Found %s or compatible chip at %#x:%#x\n",
4810 nct6775_sio_names[sio_data->kind], sioaddr, addr);
4811 sio_data->sioreg = sioaddr;
4812
4813 return addr;
4814 }
4815
4816 /*
4817 * when Super-I/O functions move to a separate file, the Super-I/O
4818 * bus will manage the lifetime of the device and this module will only keep
4819 * track of the nct6775 driver. But since we use platform_device_alloc(), we
4820 * must keep track of the device
4821 */
4822 static struct platform_device *pdev[2];
4823
sensors_nct6775_init(void)4824 static int __init sensors_nct6775_init(void)
4825 {
4826 int i, err;
4827 bool found = false;
4828 int address;
4829 struct resource res;
4830 struct nct6775_sio_data sio_data;
4831 int sioaddr[2] = { 0x2e, 0x4e };
4832
4833 err = platform_driver_register(&nct6775_driver);
4834 if (err)
4835 return err;
4836
4837 /*
4838 * initialize sio_data->kind and sio_data->sioreg.
4839 *
4840 * when Super-I/O functions move to a separate file, the Super-I/O
4841 * driver will probe 0x2e and 0x4e and auto-detect the presence of a
4842 * nct6775 hardware monitor, and call probe()
4843 */
4844 for (i = 0; i < ARRAY_SIZE(pdev); i++) {
4845 address = nct6775_find(sioaddr[i], &sio_data);
4846 if (address <= 0)
4847 continue;
4848
4849 found = true;
4850
4851 pdev[i] = platform_device_alloc(DRVNAME, address);
4852 if (!pdev[i]) {
4853 err = -ENOMEM;
4854 goto exit_device_unregister;
4855 }
4856
4857 err = platform_device_add_data(pdev[i], &sio_data,
4858 sizeof(struct nct6775_sio_data));
4859 if (err)
4860 goto exit_device_put;
4861
4862 memset(&res, 0, sizeof(res));
4863 res.name = DRVNAME;
4864 res.start = address + IOREGION_OFFSET;
4865 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1;
4866 res.flags = IORESOURCE_IO;
4867
4868 err = acpi_check_resource_conflict(&res);
4869 if (err) {
4870 platform_device_put(pdev[i]);
4871 pdev[i] = NULL;
4872 continue;
4873 }
4874
4875 err = platform_device_add_resources(pdev[i], &res, 1);
4876 if (err)
4877 goto exit_device_put;
4878
4879 /* platform_device_add calls probe() */
4880 err = platform_device_add(pdev[i]);
4881 if (err)
4882 goto exit_device_put;
4883 }
4884 if (!found) {
4885 err = -ENODEV;
4886 goto exit_unregister;
4887 }
4888
4889 return 0;
4890
4891 exit_device_put:
4892 platform_device_put(pdev[i]);
4893 exit_device_unregister:
4894 while (--i >= 0) {
4895 if (pdev[i])
4896 platform_device_unregister(pdev[i]);
4897 }
4898 exit_unregister:
4899 platform_driver_unregister(&nct6775_driver);
4900 return err;
4901 }
4902
sensors_nct6775_exit(void)4903 static void __exit sensors_nct6775_exit(void)
4904 {
4905 int i;
4906
4907 for (i = 0; i < ARRAY_SIZE(pdev); i++) {
4908 if (pdev[i])
4909 platform_device_unregister(pdev[i]);
4910 }
4911 platform_driver_unregister(&nct6775_driver);
4912 }
4913
4914 MODULE_AUTHOR("Guenter Roeck <linux@roeck-us.net>");
4915 MODULE_DESCRIPTION("Driver for NCT6775F and compatible chips");
4916 MODULE_LICENSE("GPL");
4917
4918 module_init(sensors_nct6775_init);
4919 module_exit(sensors_nct6775_exit);
4920
