xref: /openbmc/linux/drivers/hwmon/f71882fg.c (revision 0babf89c)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /***************************************************************************
3  *   Copyright (C) 2006 by Hans Edgington <hans@edgington.nl>              *
4  *   Copyright (C) 2007-2011 Hans de Goede <hdegoede@redhat.com>           *
5  *                                                                         *
6  ***************************************************************************/
7 
8 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
9 
10 #include <linux/module.h>
11 #include <linux/init.h>
12 #include <linux/slab.h>
13 #include <linux/jiffies.h>
14 #include <linux/platform_device.h>
15 #include <linux/hwmon.h>
16 #include <linux/hwmon-sysfs.h>
17 #include <linux/err.h>
18 #include <linux/mutex.h>
19 #include <linux/io.h>
20 #include <linux/acpi.h>
21 
22 #define DRVNAME "f71882fg"
23 
24 #define SIO_F71858FG_LD_HWM	0x02	/* Hardware monitor logical device */
25 #define SIO_F71882FG_LD_HWM	0x04	/* Hardware monitor logical device */
26 #define SIO_UNLOCK_KEY		0x87	/* Key to enable Super-I/O */
27 #define SIO_LOCK_KEY		0xAA	/* Key to disable Super-I/O */
28 
29 #define SIO_REG_LDSEL		0x07	/* Logical device select */
30 #define SIO_REG_DEVID		0x20	/* Device ID (2 bytes) */
31 #define SIO_REG_DEVREV		0x22	/* Device revision */
32 #define SIO_REG_MANID		0x23	/* Fintek ID (2 bytes) */
33 #define SIO_REG_ENABLE		0x30	/* Logical device enable */
34 #define SIO_REG_ADDR		0x60	/* Logical device address (2 bytes) */
35 
36 #define SIO_FINTEK_ID		0x1934	/* Manufacturers ID */
37 #define SIO_F71808E_ID		0x0901	/* Chipset ID */
38 #define SIO_F71808A_ID		0x1001	/* Chipset ID */
39 #define SIO_F71858_ID		0x0507  /* Chipset ID */
40 #define SIO_F71862_ID		0x0601	/* Chipset ID */
41 #define SIO_F71868_ID		0x1106	/* Chipset ID */
42 #define SIO_F71869_ID		0x0814	/* Chipset ID */
43 #define SIO_F71869A_ID		0x1007	/* Chipset ID */
44 #define SIO_F71882_ID		0x0541	/* Chipset ID */
45 #define SIO_F71889_ID		0x0723	/* Chipset ID */
46 #define SIO_F71889E_ID		0x0909	/* Chipset ID */
47 #define SIO_F71889A_ID		0x1005	/* Chipset ID */
48 #define SIO_F8000_ID		0x0581	/* Chipset ID */
49 #define SIO_F81768D_ID		0x1210	/* Chipset ID */
50 #define SIO_F81865_ID		0x0704	/* Chipset ID */
51 #define SIO_F81866_ID		0x1010	/* Chipset ID */
52 #define SIO_F71858AD_ID		0x0903	/* Chipset ID */
53 #define SIO_F81966_ID		0x1502	/* Chipset ID */
54 
55 #define REGION_LENGTH		8
56 #define ADDR_REG_OFFSET		5
57 #define DATA_REG_OFFSET		6
58 
59 #define F71882FG_REG_IN_STATUS		0x12 /* f7188x only */
60 #define F71882FG_REG_IN_BEEP		0x13 /* f7188x only */
61 #define F71882FG_REG_IN(nr)		(0x20  + (nr))
62 #define F71882FG_REG_IN1_HIGH		0x32 /* f7188x only */
63 
64 #define F81866_REG_IN_STATUS		0x16 /* F81866 only */
65 #define F81866_REG_IN_BEEP			0x17 /* F81866 only */
66 #define F81866_REG_IN1_HIGH		0x3a /* F81866 only */
67 
68 #define F71882FG_REG_FAN(nr)		(0xA0 + (16 * (nr)))
69 #define F71882FG_REG_FAN_TARGET(nr)	(0xA2 + (16 * (nr)))
70 #define F71882FG_REG_FAN_FULL_SPEED(nr)	(0xA4 + (16 * (nr)))
71 #define F71882FG_REG_FAN_STATUS		0x92
72 #define F71882FG_REG_FAN_BEEP		0x93
73 
74 #define F71882FG_REG_TEMP(nr)		(0x70 + 2 * (nr))
75 #define F71882FG_REG_TEMP_OVT(nr)	(0x80 + 2 * (nr))
76 #define F71882FG_REG_TEMP_HIGH(nr)	(0x81 + 2 * (nr))
77 #define F71882FG_REG_TEMP_STATUS	0x62
78 #define F71882FG_REG_TEMP_BEEP		0x63
79 #define F71882FG_REG_TEMP_CONFIG	0x69
80 #define F71882FG_REG_TEMP_HYST(nr)	(0x6C + (nr))
81 #define F71882FG_REG_TEMP_TYPE		0x6B
82 #define F71882FG_REG_TEMP_DIODE_OPEN	0x6F
83 
84 #define F71882FG_REG_PWM(nr)		(0xA3 + (16 * (nr)))
85 #define F71882FG_REG_PWM_TYPE		0x94
86 #define F71882FG_REG_PWM_ENABLE		0x96
87 
88 #define F71882FG_REG_FAN_HYST(nr)	(0x98 + (nr))
89 
90 #define F71882FG_REG_FAN_FAULT_T	0x9F
91 #define F71882FG_FAN_NEG_TEMP_EN	0x20
92 #define F71882FG_FAN_PROG_SEL		0x80
93 
94 #define F71882FG_REG_POINT_PWM(pwm, point)	(0xAA + (point) + (16 * (pwm)))
95 #define F71882FG_REG_POINT_TEMP(pwm, point)	(0xA6 + (point) + (16 * (pwm)))
96 #define F71882FG_REG_POINT_MAPPING(nr)		(0xAF + 16 * (nr))
97 
98 #define	F71882FG_REG_START		0x01
99 
100 #define F71882FG_MAX_INS		11
101 
102 #define FAN_MIN_DETECT			366 /* Lowest detectable fanspeed */
103 
104 static unsigned short force_id;
105 module_param(force_id, ushort, 0);
106 MODULE_PARM_DESC(force_id, "Override the detected device ID");
107 
108 enum chips { f71808e, f71808a, f71858fg, f71862fg, f71868a, f71869, f71869a,
109 	f71882fg, f71889fg, f71889ed, f71889a, f8000, f81768d, f81865f,
110 	f81866a};
111 
112 static const char *const f71882fg_names[] = {
113 	"f71808e",
114 	"f71808a",
115 	"f71858fg",
116 	"f71862fg",
117 	"f71868a",
118 	"f71869", /* Both f71869f and f71869e, reg. compatible and same id */
119 	"f71869a",
120 	"f71882fg",
121 	"f71889fg", /* f81801u too, same id */
122 	"f71889ed",
123 	"f71889a",
124 	"f8000",
125 	"f81768d",
126 	"f81865f",
127 	"f81866a",
128 };
129 
130 static const char f71882fg_has_in[][F71882FG_MAX_INS] = {
131 	[f71808e]	= { 1, 1, 1, 1, 1, 1, 0, 1, 1, 0, 0 },
132 	[f71808a]	= { 1, 1, 1, 1, 0, 0, 0, 1, 1, 0, 0 },
133 	[f71858fg]	= { 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0 },
134 	[f71862fg]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
135 	[f71868a]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 0 },
136 	[f71869]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
137 	[f71869a]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
138 	[f71882fg]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
139 	[f71889fg]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
140 	[f71889ed]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
141 	[f71889a]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0 },
142 	[f8000]		= { 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0 },
143 	[f81768d]	= { 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1 },
144 	[f81865f]	= { 1, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0 },
145 	[f81866a]	= { 1, 1, 1, 1, 1, 1, 1, 1, 0, 0, 0 },
146 };
147 
148 static const char f71882fg_has_in1_alarm[] = {
149 	[f71808e]	= 0,
150 	[f71808a]	= 0,
151 	[f71858fg]	= 0,
152 	[f71862fg]	= 0,
153 	[f71868a]	= 0,
154 	[f71869]	= 0,
155 	[f71869a]	= 0,
156 	[f71882fg]	= 1,
157 	[f71889fg]	= 1,
158 	[f71889ed]	= 1,
159 	[f71889a]	= 1,
160 	[f8000]		= 0,
161 	[f81768d]	= 1,
162 	[f81865f]	= 1,
163 	[f81866a]	= 1,
164 };
165 
166 static const char f71882fg_fan_has_beep[] = {
167 	[f71808e]	= 0,
168 	[f71808a]	= 0,
169 	[f71858fg]	= 0,
170 	[f71862fg]	= 1,
171 	[f71868a]	= 1,
172 	[f71869]	= 1,
173 	[f71869a]	= 1,
174 	[f71882fg]	= 1,
175 	[f71889fg]	= 1,
176 	[f71889ed]	= 1,
177 	[f71889a]	= 1,
178 	[f8000]		= 0,
179 	[f81768d]	= 1,
180 	[f81865f]	= 1,
181 	[f81866a]	= 1,
182 };
183 
184 static const char f71882fg_nr_fans[] = {
185 	[f71808e]	= 3,
186 	[f71808a]	= 2, /* +1 fan which is monitor + simple pwm only */
187 	[f71858fg]	= 3,
188 	[f71862fg]	= 3,
189 	[f71868a]	= 3,
190 	[f71869]	= 3,
191 	[f71869a]	= 3,
192 	[f71882fg]	= 4,
193 	[f71889fg]	= 3,
194 	[f71889ed]	= 3,
195 	[f71889a]	= 3,
196 	[f8000]		= 3, /* +1 fan which is monitor only */
197 	[f81768d]	= 3,
198 	[f81865f]	= 2,
199 	[f81866a]	= 3,
200 };
201 
202 static const char f71882fg_temp_has_beep[] = {
203 	[f71808e]	= 0,
204 	[f71808a]	= 1,
205 	[f71858fg]	= 0,
206 	[f71862fg]	= 1,
207 	[f71868a]	= 1,
208 	[f71869]	= 1,
209 	[f71869a]	= 1,
210 	[f71882fg]	= 1,
211 	[f71889fg]	= 1,
212 	[f71889ed]	= 1,
213 	[f71889a]	= 1,
214 	[f8000]		= 0,
215 	[f81768d]	= 1,
216 	[f81865f]	= 1,
217 	[f81866a]	= 1,
218 };
219 
220 static const char f71882fg_nr_temps[] = {
221 	[f71808e]	= 2,
222 	[f71808a]	= 2,
223 	[f71858fg]	= 3,
224 	[f71862fg]	= 3,
225 	[f71868a]	= 3,
226 	[f71869]	= 3,
227 	[f71869a]	= 3,
228 	[f71882fg]	= 3,
229 	[f71889fg]	= 3,
230 	[f71889ed]	= 3,
231 	[f71889a]	= 3,
232 	[f8000]		= 3,
233 	[f81768d]	= 3,
234 	[f81865f]	= 2,
235 	[f81866a]	= 3,
236 };
237 
238 static struct platform_device *f71882fg_pdev;
239 
240 struct f71882fg_sio_data {
241 	enum chips type;
242 };
243 
244 struct f71882fg_data {
245 	unsigned short addr;
246 	enum chips type;
247 	struct device *hwmon_dev;
248 
249 	struct mutex update_lock;
250 	int temp_start;			/* temp numbering start (0 or 1) */
251 	bool valid;			/* true if following fields are valid */
252 	char auto_point_temp_signed;
253 	unsigned long last_updated;	/* In jiffies */
254 	unsigned long last_limits;	/* In jiffies */
255 
256 	/* Register Values */
257 	u8	in[F71882FG_MAX_INS];
258 	u8	in1_max;
259 	u8	in_status;
260 	u8	in_beep;
261 	u16	fan[4];
262 	u16	fan_target[4];
263 	u16	fan_full_speed[4];
264 	u8	fan_status;
265 	u8	fan_beep;
266 	/*
267 	 * Note: all models have max 3 temperature channels, but on some
268 	 * they are addressed as 0-2 and on others as 1-3, so for coding
269 	 * convenience we reserve space for 4 channels
270 	 */
271 	u16	temp[4];
272 	u8	temp_ovt[4];
273 	u8	temp_high[4];
274 	u8	temp_hyst[2]; /* 2 hysts stored per reg */
275 	u8	temp_type[4];
276 	u8	temp_status;
277 	u8	temp_beep;
278 	u8	temp_diode_open;
279 	u8	temp_config;
280 	u8	pwm[4];
281 	u8	pwm_enable;
282 	u8	pwm_auto_point_hyst[2];
283 	u8	pwm_auto_point_mapping[4];
284 	u8	pwm_auto_point_pwm[4][5];
285 	s8	pwm_auto_point_temp[4][4];
286 };
287 
f71882fg_read8(struct f71882fg_data * data,u8 reg)288 static u8 f71882fg_read8(struct f71882fg_data *data, u8 reg)
289 {
290 	u8 val;
291 
292 	outb(reg, data->addr + ADDR_REG_OFFSET);
293 	val = inb(data->addr + DATA_REG_OFFSET);
294 
295 	return val;
296 }
297 
f71882fg_read16(struct f71882fg_data * data,u8 reg)298 static u16 f71882fg_read16(struct f71882fg_data *data, u8 reg)
299 {
300 	u16 val;
301 
302 	val  = f71882fg_read8(data, reg) << 8;
303 	val |= f71882fg_read8(data, reg + 1);
304 
305 	return val;
306 }
307 
fan_from_reg(u16 reg)308 static inline int fan_from_reg(u16 reg)
309 {
310 	return reg ? (1500000 / reg) : 0;
311 }
312 
fan_to_reg(int fan)313 static inline u16 fan_to_reg(int fan)
314 {
315 	return fan ? (1500000 / fan) : 0;
316 }
317 
f71882fg_write8(struct f71882fg_data * data,u8 reg,u8 val)318 static void f71882fg_write8(struct f71882fg_data *data, u8 reg, u8 val)
319 {
320 	outb(reg, data->addr + ADDR_REG_OFFSET);
321 	outb(val, data->addr + DATA_REG_OFFSET);
322 }
323 
f71882fg_write16(struct f71882fg_data * data,u8 reg,u16 val)324 static void f71882fg_write16(struct f71882fg_data *data, u8 reg, u16 val)
325 {
326 	f71882fg_write8(data, reg,     val >> 8);
327 	f71882fg_write8(data, reg + 1, val & 0xff);
328 }
329 
f71882fg_read_temp(struct f71882fg_data * data,int nr)330 static u16 f71882fg_read_temp(struct f71882fg_data *data, int nr)
331 {
332 	if (data->type == f71858fg)
333 		return f71882fg_read16(data, F71882FG_REG_TEMP(nr));
334 	else
335 		return f71882fg_read8(data, F71882FG_REG_TEMP(nr));
336 }
337 
f71882fg_update_device(struct device * dev)338 static struct f71882fg_data *f71882fg_update_device(struct device *dev)
339 {
340 	struct f71882fg_data *data = dev_get_drvdata(dev);
341 	int nr_fans = f71882fg_nr_fans[data->type];
342 	int nr_temps = f71882fg_nr_temps[data->type];
343 	int nr, reg, point;
344 
345 	mutex_lock(&data->update_lock);
346 
347 	/* Update once every 60 seconds */
348 	if (time_after(jiffies, data->last_limits + 60 * HZ) ||
349 			!data->valid) {
350 		if (f71882fg_has_in1_alarm[data->type]) {
351 			if (data->type == f81866a) {
352 				data->in1_max =
353 					f71882fg_read8(data,
354 						       F81866_REG_IN1_HIGH);
355 				data->in_beep =
356 					f71882fg_read8(data,
357 						       F81866_REG_IN_BEEP);
358 			} else {
359 				data->in1_max =
360 					f71882fg_read8(data,
361 						       F71882FG_REG_IN1_HIGH);
362 				data->in_beep =
363 					f71882fg_read8(data,
364 						       F71882FG_REG_IN_BEEP);
365 			}
366 		}
367 
368 		/* Get High & boundary temps*/
369 		for (nr = data->temp_start; nr < nr_temps + data->temp_start;
370 									nr++) {
371 			data->temp_ovt[nr] = f71882fg_read8(data,
372 						F71882FG_REG_TEMP_OVT(nr));
373 			data->temp_high[nr] = f71882fg_read8(data,
374 						F71882FG_REG_TEMP_HIGH(nr));
375 		}
376 
377 		if (data->type != f8000) {
378 			data->temp_hyst[0] = f71882fg_read8(data,
379 						F71882FG_REG_TEMP_HYST(0));
380 			data->temp_hyst[1] = f71882fg_read8(data,
381 						F71882FG_REG_TEMP_HYST(1));
382 		}
383 		/* All but the f71858fg / f8000 have this register */
384 		if ((data->type != f71858fg) && (data->type != f8000)) {
385 			reg  = f71882fg_read8(data, F71882FG_REG_TEMP_TYPE);
386 			data->temp_type[1] = (reg & 0x02) ? 2 : 4;
387 			data->temp_type[2] = (reg & 0x04) ? 2 : 4;
388 			data->temp_type[3] = (reg & 0x08) ? 2 : 4;
389 		}
390 
391 		if (f71882fg_fan_has_beep[data->type])
392 			data->fan_beep = f71882fg_read8(data,
393 						F71882FG_REG_FAN_BEEP);
394 
395 		if (f71882fg_temp_has_beep[data->type])
396 			data->temp_beep = f71882fg_read8(data,
397 						F71882FG_REG_TEMP_BEEP);
398 
399 		data->pwm_enable = f71882fg_read8(data,
400 						  F71882FG_REG_PWM_ENABLE);
401 		data->pwm_auto_point_hyst[0] =
402 			f71882fg_read8(data, F71882FG_REG_FAN_HYST(0));
403 		data->pwm_auto_point_hyst[1] =
404 			f71882fg_read8(data, F71882FG_REG_FAN_HYST(1));
405 
406 		for (nr = 0; nr < nr_fans; nr++) {
407 			data->pwm_auto_point_mapping[nr] =
408 			    f71882fg_read8(data,
409 					   F71882FG_REG_POINT_MAPPING(nr));
410 
411 			switch (data->type) {
412 			default:
413 				for (point = 0; point < 5; point++) {
414 					data->pwm_auto_point_pwm[nr][point] =
415 						f71882fg_read8(data,
416 							F71882FG_REG_POINT_PWM
417 							(nr, point));
418 				}
419 				for (point = 0; point < 4; point++) {
420 					data->pwm_auto_point_temp[nr][point] =
421 						f71882fg_read8(data,
422 							F71882FG_REG_POINT_TEMP
423 							(nr, point));
424 				}
425 				break;
426 			case f71808e:
427 			case f71869:
428 				data->pwm_auto_point_pwm[nr][0] =
429 					f71882fg_read8(data,
430 						F71882FG_REG_POINT_PWM(nr, 0));
431 				fallthrough;
432 			case f71862fg:
433 				data->pwm_auto_point_pwm[nr][1] =
434 					f71882fg_read8(data,
435 						F71882FG_REG_POINT_PWM
436 						(nr, 1));
437 				data->pwm_auto_point_pwm[nr][4] =
438 					f71882fg_read8(data,
439 						F71882FG_REG_POINT_PWM
440 						(nr, 4));
441 				data->pwm_auto_point_temp[nr][0] =
442 					f71882fg_read8(data,
443 						F71882FG_REG_POINT_TEMP
444 						(nr, 0));
445 				data->pwm_auto_point_temp[nr][3] =
446 					f71882fg_read8(data,
447 						F71882FG_REG_POINT_TEMP
448 						(nr, 3));
449 				break;
450 			}
451 		}
452 		data->last_limits = jiffies;
453 	}
454 
455 	/* Update every second */
456 	if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
457 		data->temp_status = f71882fg_read8(data,
458 						F71882FG_REG_TEMP_STATUS);
459 		data->temp_diode_open = f71882fg_read8(data,
460 						F71882FG_REG_TEMP_DIODE_OPEN);
461 		for (nr = data->temp_start; nr < nr_temps + data->temp_start;
462 									nr++)
463 			data->temp[nr] = f71882fg_read_temp(data, nr);
464 
465 		data->fan_status = f71882fg_read8(data,
466 						F71882FG_REG_FAN_STATUS);
467 		for (nr = 0; nr < nr_fans; nr++) {
468 			data->fan[nr] = f71882fg_read16(data,
469 						F71882FG_REG_FAN(nr));
470 			data->fan_target[nr] =
471 			    f71882fg_read16(data, F71882FG_REG_FAN_TARGET(nr));
472 			data->fan_full_speed[nr] =
473 			    f71882fg_read16(data,
474 					    F71882FG_REG_FAN_FULL_SPEED(nr));
475 			data->pwm[nr] =
476 			    f71882fg_read8(data, F71882FG_REG_PWM(nr));
477 		}
478 		/* Some models have 1 more fan with limited capabilities */
479 		if (data->type == f71808a) {
480 			data->fan[2] = f71882fg_read16(data,
481 						F71882FG_REG_FAN(2));
482 			data->pwm[2] = f71882fg_read8(data,
483 							F71882FG_REG_PWM(2));
484 		}
485 		if (data->type == f8000)
486 			data->fan[3] = f71882fg_read16(data,
487 						F71882FG_REG_FAN(3));
488 
489 		if (f71882fg_has_in1_alarm[data->type]) {
490 			if (data->type == f81866a)
491 				data->in_status = f71882fg_read8(data,
492 						F81866_REG_IN_STATUS);
493 
494 			else
495 				data->in_status = f71882fg_read8(data,
496 						F71882FG_REG_IN_STATUS);
497 		}
498 
499 		for (nr = 0; nr < F71882FG_MAX_INS; nr++)
500 			if (f71882fg_has_in[data->type][nr])
501 				data->in[nr] = f71882fg_read8(data,
502 							F71882FG_REG_IN(nr));
503 
504 		data->last_updated = jiffies;
505 		data->valid = true;
506 	}
507 
508 	mutex_unlock(&data->update_lock);
509 
510 	return data;
511 }
512 
name_show(struct device * dev,struct device_attribute * devattr,char * buf)513 static ssize_t name_show(struct device *dev, struct device_attribute *devattr,
514 	char *buf)
515 {
516 	struct f71882fg_data *data = dev_get_drvdata(dev);
517 	return sprintf(buf, "%s\n", f71882fg_names[data->type]);
518 }
519 
520 static DEVICE_ATTR_RO(name);
521 
show_temp(struct device * dev,struct device_attribute * devattr,char * buf)522 static ssize_t show_temp(struct device *dev, struct device_attribute *devattr,
523 	char *buf)
524 {
525 	struct f71882fg_data *data = f71882fg_update_device(dev);
526 	int nr = to_sensor_dev_attr_2(devattr)->index;
527 	int sign, temp;
528 
529 	if (data->type == f71858fg) {
530 		/* TEMP_TABLE_SEL 1 or 3 ? */
531 		if (data->temp_config & 1) {
532 			sign = data->temp[nr] & 0x0001;
533 			temp = (data->temp[nr] >> 5) & 0x7ff;
534 		} else {
535 			sign = data->temp[nr] & 0x8000;
536 			temp = (data->temp[nr] >> 5) & 0x3ff;
537 		}
538 		temp *= 125;
539 		if (sign)
540 			temp -= 128000;
541 	} else {
542 		temp = ((s8)data->temp[nr]) * 1000;
543 	}
544 
545 	return sprintf(buf, "%d\n", temp);
546 }
547 
show_temp_max(struct device * dev,struct device_attribute * devattr,char * buf)548 static ssize_t show_temp_max(struct device *dev, struct device_attribute
549 	*devattr, char *buf)
550 {
551 	struct f71882fg_data *data = f71882fg_update_device(dev);
552 	int nr = to_sensor_dev_attr_2(devattr)->index;
553 
554 	return sprintf(buf, "%d\n", data->temp_high[nr] * 1000);
555 }
556 
store_temp_max(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)557 static ssize_t store_temp_max(struct device *dev, struct device_attribute
558 	*devattr, const char *buf, size_t count)
559 {
560 	struct f71882fg_data *data = dev_get_drvdata(dev);
561 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
562 	long val;
563 
564 	err = kstrtol(buf, 10, &val);
565 	if (err)
566 		return err;
567 
568 	val /= 1000;
569 	val = clamp_val(val, 0, 255);
570 
571 	mutex_lock(&data->update_lock);
572 	f71882fg_write8(data, F71882FG_REG_TEMP_HIGH(nr), val);
573 	data->temp_high[nr] = val;
574 	mutex_unlock(&data->update_lock);
575 
576 	return count;
577 }
578 
show_temp_max_hyst(struct device * dev,struct device_attribute * devattr,char * buf)579 static ssize_t show_temp_max_hyst(struct device *dev, struct device_attribute
580 	*devattr, char *buf)
581 {
582 	struct f71882fg_data *data = f71882fg_update_device(dev);
583 	int nr = to_sensor_dev_attr_2(devattr)->index;
584 	int temp_max_hyst;
585 
586 	mutex_lock(&data->update_lock);
587 	if (nr & 1)
588 		temp_max_hyst = data->temp_hyst[nr / 2] >> 4;
589 	else
590 		temp_max_hyst = data->temp_hyst[nr / 2] & 0x0f;
591 	temp_max_hyst = (data->temp_high[nr] - temp_max_hyst) * 1000;
592 	mutex_unlock(&data->update_lock);
593 
594 	return sprintf(buf, "%d\n", temp_max_hyst);
595 }
596 
store_temp_max_hyst(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)597 static ssize_t store_temp_max_hyst(struct device *dev, struct device_attribute
598 	*devattr, const char *buf, size_t count)
599 {
600 	struct f71882fg_data *data = dev_get_drvdata(dev);
601 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
602 	ssize_t ret = count;
603 	u8 reg;
604 	long val;
605 
606 	err = kstrtol(buf, 10, &val);
607 	if (err)
608 		return err;
609 
610 	val /= 1000;
611 
612 	mutex_lock(&data->update_lock);
613 
614 	/* convert abs to relative and check */
615 	data->temp_high[nr] = f71882fg_read8(data, F71882FG_REG_TEMP_HIGH(nr));
616 	val = clamp_val(val, data->temp_high[nr] - 15, data->temp_high[nr]);
617 	val = data->temp_high[nr] - val;
618 
619 	/* convert value to register contents */
620 	reg = f71882fg_read8(data, F71882FG_REG_TEMP_HYST(nr / 2));
621 	if (nr & 1)
622 		reg = (reg & 0x0f) | (val << 4);
623 	else
624 		reg = (reg & 0xf0) | val;
625 	f71882fg_write8(data, F71882FG_REG_TEMP_HYST(nr / 2), reg);
626 	data->temp_hyst[nr / 2] = reg;
627 
628 	mutex_unlock(&data->update_lock);
629 	return ret;
630 }
631 
show_temp_alarm(struct device * dev,struct device_attribute * devattr,char * buf)632 static ssize_t show_temp_alarm(struct device *dev, struct device_attribute
633 	*devattr, char *buf)
634 {
635 	struct f71882fg_data *data = f71882fg_update_device(dev);
636 	int nr = to_sensor_dev_attr_2(devattr)->index;
637 
638 	if (data->temp_status & (1 << nr))
639 		return sprintf(buf, "1\n");
640 	else
641 		return sprintf(buf, "0\n");
642 }
643 
show_temp_crit(struct device * dev,struct device_attribute * devattr,char * buf)644 static ssize_t show_temp_crit(struct device *dev, struct device_attribute
645 	*devattr, char *buf)
646 {
647 	struct f71882fg_data *data = f71882fg_update_device(dev);
648 	int nr = to_sensor_dev_attr_2(devattr)->index;
649 
650 	return sprintf(buf, "%d\n", data->temp_ovt[nr] * 1000);
651 }
652 
store_temp_crit(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)653 static ssize_t store_temp_crit(struct device *dev, struct device_attribute
654 	*devattr, const char *buf, size_t count)
655 {
656 	struct f71882fg_data *data = dev_get_drvdata(dev);
657 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
658 	long val;
659 
660 	err = kstrtol(buf, 10, &val);
661 	if (err)
662 		return err;
663 
664 	val /= 1000;
665 	val = clamp_val(val, 0, 255);
666 
667 	mutex_lock(&data->update_lock);
668 	f71882fg_write8(data, F71882FG_REG_TEMP_OVT(nr), val);
669 	data->temp_ovt[nr] = val;
670 	mutex_unlock(&data->update_lock);
671 
672 	return count;
673 }
674 
show_temp_crit_hyst(struct device * dev,struct device_attribute * devattr,char * buf)675 static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute
676 	*devattr, char *buf)
677 {
678 	struct f71882fg_data *data = f71882fg_update_device(dev);
679 	int nr = to_sensor_dev_attr_2(devattr)->index;
680 	int temp_crit_hyst;
681 
682 	mutex_lock(&data->update_lock);
683 	if (nr & 1)
684 		temp_crit_hyst = data->temp_hyst[nr / 2] >> 4;
685 	else
686 		temp_crit_hyst = data->temp_hyst[nr / 2] & 0x0f;
687 	temp_crit_hyst = (data->temp_ovt[nr] - temp_crit_hyst) * 1000;
688 	mutex_unlock(&data->update_lock);
689 
690 	return sprintf(buf, "%d\n", temp_crit_hyst);
691 }
692 
show_temp_fault(struct device * dev,struct device_attribute * devattr,char * buf)693 static ssize_t show_temp_fault(struct device *dev, struct device_attribute
694 	*devattr, char *buf)
695 {
696 	struct f71882fg_data *data = f71882fg_update_device(dev);
697 	int nr = to_sensor_dev_attr_2(devattr)->index;
698 
699 	if (data->temp_diode_open & (1 << nr))
700 		return sprintf(buf, "1\n");
701 	else
702 		return sprintf(buf, "0\n");
703 }
704 
705 /*
706  * Temp attr for the f71858fg, the f71858fg is special as it has its
707  * temperature indexes start at 0 (the others start at 1)
708  */
709 static struct sensor_device_attribute_2 f71858fg_temp_attr[] = {
710 	SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 0),
711 	SENSOR_ATTR_2(temp1_max, S_IRUGO|S_IWUSR, show_temp_max,
712 		store_temp_max, 0, 0),
713 	SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
714 		store_temp_max_hyst, 0, 0),
715 	SENSOR_ATTR_2(temp1_max_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 0),
716 	SENSOR_ATTR_2(temp1_crit, S_IRUGO|S_IWUSR, show_temp_crit,
717 		store_temp_crit, 0, 0),
718 	SENSOR_ATTR_2(temp1_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
719 		0, 0),
720 	SENSOR_ATTR_2(temp1_crit_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 4),
721 	SENSOR_ATTR_2(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0, 0),
722 	SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 0, 1),
723 	SENSOR_ATTR_2(temp2_max, S_IRUGO|S_IWUSR, show_temp_max,
724 		store_temp_max, 0, 1),
725 	SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
726 		store_temp_max_hyst, 0, 1),
727 	SENSOR_ATTR_2(temp2_max_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 1),
728 	SENSOR_ATTR_2(temp2_crit, S_IRUGO|S_IWUSR, show_temp_crit,
729 		store_temp_crit, 0, 1),
730 	SENSOR_ATTR_2(temp2_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
731 		0, 1),
732 	SENSOR_ATTR_2(temp2_crit_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 5),
733 	SENSOR_ATTR_2(temp2_fault, S_IRUGO, show_temp_fault, NULL, 0, 1),
734 	SENSOR_ATTR_2(temp3_input, S_IRUGO, show_temp, NULL, 0, 2),
735 	SENSOR_ATTR_2(temp3_max, S_IRUGO|S_IWUSR, show_temp_max,
736 		store_temp_max, 0, 2),
737 	SENSOR_ATTR_2(temp3_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
738 		store_temp_max_hyst, 0, 2),
739 	SENSOR_ATTR_2(temp3_max_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 2),
740 	SENSOR_ATTR_2(temp3_crit, S_IRUGO|S_IWUSR, show_temp_crit,
741 		store_temp_crit, 0, 2),
742 	SENSOR_ATTR_2(temp3_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
743 		0, 2),
744 	SENSOR_ATTR_2(temp3_crit_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 6),
745 	SENSOR_ATTR_2(temp3_fault, S_IRUGO, show_temp_fault, NULL, 0, 2),
746 };
747 
show_temp_type(struct device * dev,struct device_attribute * devattr,char * buf)748 static ssize_t show_temp_type(struct device *dev, struct device_attribute
749 	*devattr, char *buf)
750 {
751 	struct f71882fg_data *data = f71882fg_update_device(dev);
752 	int nr = to_sensor_dev_attr_2(devattr)->index;
753 
754 	return sprintf(buf, "%d\n", data->temp_type[nr]);
755 }
756 
757 /* Temp attr for the standard models */
758 static struct sensor_device_attribute_2 fxxxx_temp_attr[3][9] = { {
759 	SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 1),
760 	SENSOR_ATTR_2(temp1_max, S_IRUGO|S_IWUSR, show_temp_max,
761 		store_temp_max, 0, 1),
762 	SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
763 		store_temp_max_hyst, 0, 1),
764 	/*
765 	 * Should really be temp1_max_alarm, but older versions did not handle
766 	 * the max and crit alarms separately and lm_sensors v2 depends on the
767 	 * presence of temp#_alarm files. The same goes for temp2/3 _alarm.
768 	 */
769 	SENSOR_ATTR_2(temp1_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 1),
770 	SENSOR_ATTR_2(temp1_crit, S_IRUGO|S_IWUSR, show_temp_crit,
771 		store_temp_crit, 0, 1),
772 	SENSOR_ATTR_2(temp1_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
773 		0, 1),
774 	SENSOR_ATTR_2(temp1_crit_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 5),
775 	SENSOR_ATTR_2(temp1_type, S_IRUGO, show_temp_type, NULL, 0, 1),
776 	SENSOR_ATTR_2(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0, 1),
777 }, {
778 	SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 0, 2),
779 	SENSOR_ATTR_2(temp2_max, S_IRUGO|S_IWUSR, show_temp_max,
780 		store_temp_max, 0, 2),
781 	SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
782 		store_temp_max_hyst, 0, 2),
783 	/* Should be temp2_max_alarm, see temp1_alarm note */
784 	SENSOR_ATTR_2(temp2_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 2),
785 	SENSOR_ATTR_2(temp2_crit, S_IRUGO|S_IWUSR, show_temp_crit,
786 		store_temp_crit, 0, 2),
787 	SENSOR_ATTR_2(temp2_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
788 		0, 2),
789 	SENSOR_ATTR_2(temp2_crit_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 6),
790 	SENSOR_ATTR_2(temp2_type, S_IRUGO, show_temp_type, NULL, 0, 2),
791 	SENSOR_ATTR_2(temp2_fault, S_IRUGO, show_temp_fault, NULL, 0, 2),
792 }, {
793 	SENSOR_ATTR_2(temp3_input, S_IRUGO, show_temp, NULL, 0, 3),
794 	SENSOR_ATTR_2(temp3_max, S_IRUGO|S_IWUSR, show_temp_max,
795 		store_temp_max, 0, 3),
796 	SENSOR_ATTR_2(temp3_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
797 		store_temp_max_hyst, 0, 3),
798 	/* Should be temp3_max_alarm, see temp1_alarm note */
799 	SENSOR_ATTR_2(temp3_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 3),
800 	SENSOR_ATTR_2(temp3_crit, S_IRUGO|S_IWUSR, show_temp_crit,
801 		store_temp_crit, 0, 3),
802 	SENSOR_ATTR_2(temp3_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
803 		0, 3),
804 	SENSOR_ATTR_2(temp3_crit_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 7),
805 	SENSOR_ATTR_2(temp3_type, S_IRUGO, show_temp_type, NULL, 0, 3),
806 	SENSOR_ATTR_2(temp3_fault, S_IRUGO, show_temp_fault, NULL, 0, 3),
807 } };
808 
show_temp_beep(struct device * dev,struct device_attribute * devattr,char * buf)809 static ssize_t show_temp_beep(struct device *dev, struct device_attribute
810 	*devattr, char *buf)
811 {
812 	struct f71882fg_data *data = f71882fg_update_device(dev);
813 	int nr = to_sensor_dev_attr_2(devattr)->index;
814 
815 	if (data->temp_beep & (1 << nr))
816 		return sprintf(buf, "1\n");
817 	else
818 		return sprintf(buf, "0\n");
819 }
820 
store_temp_beep(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)821 static ssize_t store_temp_beep(struct device *dev, struct device_attribute
822 	*devattr, const char *buf, size_t count)
823 {
824 	struct f71882fg_data *data = dev_get_drvdata(dev);
825 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
826 	unsigned long val;
827 
828 	err = kstrtoul(buf, 10, &val);
829 	if (err)
830 		return err;
831 
832 	mutex_lock(&data->update_lock);
833 	data->temp_beep = f71882fg_read8(data, F71882FG_REG_TEMP_BEEP);
834 	if (val)
835 		data->temp_beep |= 1 << nr;
836 	else
837 		data->temp_beep &= ~(1 << nr);
838 
839 	f71882fg_write8(data, F71882FG_REG_TEMP_BEEP, data->temp_beep);
840 	mutex_unlock(&data->update_lock);
841 
842 	return count;
843 }
844 
845 /* Temp attr for models which can beep on temp alarm */
846 static struct sensor_device_attribute_2 fxxxx_temp_beep_attr[3][2] = { {
847 	SENSOR_ATTR_2(temp1_max_beep, S_IRUGO|S_IWUSR, show_temp_beep,
848 		store_temp_beep, 0, 1),
849 	SENSOR_ATTR_2(temp1_crit_beep, S_IRUGO|S_IWUSR, show_temp_beep,
850 		store_temp_beep, 0, 5),
851 }, {
852 	SENSOR_ATTR_2(temp2_max_beep, S_IRUGO|S_IWUSR, show_temp_beep,
853 		store_temp_beep, 0, 2),
854 	SENSOR_ATTR_2(temp2_crit_beep, S_IRUGO|S_IWUSR, show_temp_beep,
855 		store_temp_beep, 0, 6),
856 }, {
857 	SENSOR_ATTR_2(temp3_max_beep, S_IRUGO|S_IWUSR, show_temp_beep,
858 		store_temp_beep, 0, 3),
859 	SENSOR_ATTR_2(temp3_crit_beep, S_IRUGO|S_IWUSR, show_temp_beep,
860 		store_temp_beep, 0, 7),
861 } };
862 
863 static struct sensor_device_attribute_2 f81866_temp_beep_attr[3][2] = { {
864 	SENSOR_ATTR_2(temp1_max_beep, S_IRUGO|S_IWUSR, show_temp_beep,
865 		store_temp_beep, 0, 0),
866 	SENSOR_ATTR_2(temp1_crit_beep, S_IRUGO|S_IWUSR, show_temp_beep,
867 		store_temp_beep, 0, 4),
868 }, {
869 	SENSOR_ATTR_2(temp2_max_beep, S_IRUGO|S_IWUSR, show_temp_beep,
870 		store_temp_beep, 0, 1),
871 	SENSOR_ATTR_2(temp2_crit_beep, S_IRUGO|S_IWUSR, show_temp_beep,
872 		store_temp_beep, 0, 5),
873 }, {
874 	SENSOR_ATTR_2(temp3_max_beep, S_IRUGO|S_IWUSR, show_temp_beep,
875 		store_temp_beep, 0, 2),
876 	SENSOR_ATTR_2(temp3_crit_beep, S_IRUGO|S_IWUSR, show_temp_beep,
877 		store_temp_beep, 0, 6),
878 } };
879 
880 /*
881  * Temp attr for the f8000
882  * Note on the f8000 temp_ovt (crit) is used as max, and temp_high (max)
883  * is used as hysteresis value to clear alarms
884  * Also like the f71858fg its temperature indexes start at 0
885  */
886 static struct sensor_device_attribute_2 f8000_temp_attr[] = {
887 	SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 0),
888 	SENSOR_ATTR_2(temp1_max, S_IRUGO|S_IWUSR, show_temp_crit,
889 		store_temp_crit, 0, 0),
890 	SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO|S_IWUSR, show_temp_max,
891 		store_temp_max, 0, 0),
892 	SENSOR_ATTR_2(temp1_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 4),
893 	SENSOR_ATTR_2(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0, 0),
894 	SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 0, 1),
895 	SENSOR_ATTR_2(temp2_max, S_IRUGO|S_IWUSR, show_temp_crit,
896 		store_temp_crit, 0, 1),
897 	SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO|S_IWUSR, show_temp_max,
898 		store_temp_max, 0, 1),
899 	SENSOR_ATTR_2(temp2_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 5),
900 	SENSOR_ATTR_2(temp2_fault, S_IRUGO, show_temp_fault, NULL, 0, 1),
901 	SENSOR_ATTR_2(temp3_input, S_IRUGO, show_temp, NULL, 0, 2),
902 	SENSOR_ATTR_2(temp3_max, S_IRUGO|S_IWUSR, show_temp_crit,
903 		store_temp_crit, 0, 2),
904 	SENSOR_ATTR_2(temp3_max_hyst, S_IRUGO|S_IWUSR, show_temp_max,
905 		store_temp_max, 0, 2),
906 	SENSOR_ATTR_2(temp3_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 6),
907 	SENSOR_ATTR_2(temp3_fault, S_IRUGO, show_temp_fault, NULL, 0, 2),
908 };
909 
show_in(struct device * dev,struct device_attribute * devattr,char * buf)910 static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
911 	char *buf)
912 {
913 	struct f71882fg_data *data = f71882fg_update_device(dev);
914 	int nr = to_sensor_dev_attr_2(devattr)->index;
915 
916 	return sprintf(buf, "%d\n", data->in[nr] * 8);
917 }
918 
919 /* in attr for all models */
920 static struct sensor_device_attribute_2 fxxxx_in_attr[] = {
921 	SENSOR_ATTR_2(in0_input, S_IRUGO, show_in, NULL, 0, 0),
922 	SENSOR_ATTR_2(in1_input, S_IRUGO, show_in, NULL, 0, 1),
923 	SENSOR_ATTR_2(in2_input, S_IRUGO, show_in, NULL, 0, 2),
924 	SENSOR_ATTR_2(in3_input, S_IRUGO, show_in, NULL, 0, 3),
925 	SENSOR_ATTR_2(in4_input, S_IRUGO, show_in, NULL, 0, 4),
926 	SENSOR_ATTR_2(in5_input, S_IRUGO, show_in, NULL, 0, 5),
927 	SENSOR_ATTR_2(in6_input, S_IRUGO, show_in, NULL, 0, 6),
928 	SENSOR_ATTR_2(in7_input, S_IRUGO, show_in, NULL, 0, 7),
929 	SENSOR_ATTR_2(in8_input, S_IRUGO, show_in, NULL, 0, 8),
930 	SENSOR_ATTR_2(in9_input, S_IRUGO, show_in, NULL, 0, 9),
931 	SENSOR_ATTR_2(in10_input, S_IRUGO, show_in, NULL, 0, 10),
932 };
933 
show_in_max(struct device * dev,struct device_attribute * devattr,char * buf)934 static ssize_t show_in_max(struct device *dev, struct device_attribute
935 	*devattr, char *buf)
936 {
937 	struct f71882fg_data *data = f71882fg_update_device(dev);
938 
939 	return sprintf(buf, "%d\n", data->in1_max * 8);
940 }
941 
store_in_max(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)942 static ssize_t store_in_max(struct device *dev, struct device_attribute
943 	*devattr, const char *buf, size_t count)
944 {
945 	struct f71882fg_data *data = dev_get_drvdata(dev);
946 	int err;
947 	long val;
948 
949 	err = kstrtol(buf, 10, &val);
950 	if (err)
951 		return err;
952 
953 	val /= 8;
954 	val = clamp_val(val, 0, 255);
955 
956 	mutex_lock(&data->update_lock);
957 	if (data->type == f81866a)
958 		f71882fg_write8(data, F81866_REG_IN1_HIGH, val);
959 	else
960 		f71882fg_write8(data, F71882FG_REG_IN1_HIGH, val);
961 	data->in1_max = val;
962 	mutex_unlock(&data->update_lock);
963 
964 	return count;
965 }
966 
show_in_beep(struct device * dev,struct device_attribute * devattr,char * buf)967 static ssize_t show_in_beep(struct device *dev, struct device_attribute
968 	*devattr, char *buf)
969 {
970 	struct f71882fg_data *data = f71882fg_update_device(dev);
971 	int nr = to_sensor_dev_attr_2(devattr)->index;
972 
973 	if (data->in_beep & (1 << nr))
974 		return sprintf(buf, "1\n");
975 	else
976 		return sprintf(buf, "0\n");
977 }
978 
store_in_beep(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)979 static ssize_t store_in_beep(struct device *dev, struct device_attribute
980 	*devattr, const char *buf, size_t count)
981 {
982 	struct f71882fg_data *data = dev_get_drvdata(dev);
983 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
984 	unsigned long val;
985 
986 	err = kstrtoul(buf, 10, &val);
987 	if (err)
988 		return err;
989 
990 	mutex_lock(&data->update_lock);
991 	if (data->type == f81866a)
992 		data->in_beep = f71882fg_read8(data, F81866_REG_IN_BEEP);
993 	else
994 		data->in_beep = f71882fg_read8(data, F71882FG_REG_IN_BEEP);
995 
996 	if (val)
997 		data->in_beep |= 1 << nr;
998 	else
999 		data->in_beep &= ~(1 << nr);
1000 
1001 	if (data->type == f81866a)
1002 		f71882fg_write8(data, F81866_REG_IN_BEEP, data->in_beep);
1003 	else
1004 		f71882fg_write8(data, F71882FG_REG_IN_BEEP, data->in_beep);
1005 	mutex_unlock(&data->update_lock);
1006 
1007 	return count;
1008 }
1009 
show_in_alarm(struct device * dev,struct device_attribute * devattr,char * buf)1010 static ssize_t show_in_alarm(struct device *dev, struct device_attribute
1011 	*devattr, char *buf)
1012 {
1013 	struct f71882fg_data *data = f71882fg_update_device(dev);
1014 	int nr = to_sensor_dev_attr_2(devattr)->index;
1015 
1016 	if (data->in_status & (1 << nr))
1017 		return sprintf(buf, "1\n");
1018 	else
1019 		return sprintf(buf, "0\n");
1020 }
1021 
1022 /* For models with in1 alarm capability */
1023 static struct sensor_device_attribute_2 fxxxx_in1_alarm_attr[] = {
1024 	SENSOR_ATTR_2(in1_max, S_IRUGO|S_IWUSR, show_in_max, store_in_max,
1025 		0, 1),
1026 	SENSOR_ATTR_2(in1_beep, S_IRUGO|S_IWUSR, show_in_beep, store_in_beep,
1027 		0, 1),
1028 	SENSOR_ATTR_2(in1_alarm, S_IRUGO, show_in_alarm, NULL, 0, 1),
1029 };
1030 
show_fan(struct device * dev,struct device_attribute * devattr,char * buf)1031 static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
1032 	char *buf)
1033 {
1034 	struct f71882fg_data *data = f71882fg_update_device(dev);
1035 	int nr = to_sensor_dev_attr_2(devattr)->index;
1036 	int speed = fan_from_reg(data->fan[nr]);
1037 
1038 	if (speed == FAN_MIN_DETECT)
1039 		speed = 0;
1040 
1041 	return sprintf(buf, "%d\n", speed);
1042 }
1043 
show_fan_full_speed(struct device * dev,struct device_attribute * devattr,char * buf)1044 static ssize_t show_fan_full_speed(struct device *dev,
1045 				   struct device_attribute *devattr, char *buf)
1046 {
1047 	struct f71882fg_data *data = f71882fg_update_device(dev);
1048 	int nr = to_sensor_dev_attr_2(devattr)->index;
1049 	int speed = fan_from_reg(data->fan_full_speed[nr]);
1050 	return sprintf(buf, "%d\n", speed);
1051 }
1052 
store_fan_full_speed(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1053 static ssize_t store_fan_full_speed(struct device *dev,
1054 				    struct device_attribute *devattr,
1055 				    const char *buf, size_t count)
1056 {
1057 	struct f71882fg_data *data = dev_get_drvdata(dev);
1058 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1059 	long val;
1060 
1061 	err = kstrtol(buf, 10, &val);
1062 	if (err)
1063 		return err;
1064 
1065 	val = clamp_val(val, 23, 1500000);
1066 	val = fan_to_reg(val);
1067 
1068 	mutex_lock(&data->update_lock);
1069 	f71882fg_write16(data, F71882FG_REG_FAN_FULL_SPEED(nr), val);
1070 	data->fan_full_speed[nr] = val;
1071 	mutex_unlock(&data->update_lock);
1072 
1073 	return count;
1074 }
1075 
show_fan_alarm(struct device * dev,struct device_attribute * devattr,char * buf)1076 static ssize_t show_fan_alarm(struct device *dev, struct device_attribute
1077 	*devattr, char *buf)
1078 {
1079 	struct f71882fg_data *data = f71882fg_update_device(dev);
1080 	int nr = to_sensor_dev_attr_2(devattr)->index;
1081 
1082 	if (data->fan_status & (1 << nr))
1083 		return sprintf(buf, "1\n");
1084 	else
1085 		return sprintf(buf, "0\n");
1086 }
1087 
show_pwm(struct device * dev,struct device_attribute * devattr,char * buf)1088 static ssize_t show_pwm(struct device *dev,
1089 			struct device_attribute *devattr, char *buf)
1090 {
1091 	struct f71882fg_data *data = f71882fg_update_device(dev);
1092 	int val, nr = to_sensor_dev_attr_2(devattr)->index;
1093 	mutex_lock(&data->update_lock);
1094 	if (data->pwm_enable & (1 << (2 * nr)))
1095 		/* PWM mode */
1096 		val = data->pwm[nr];
1097 	else {
1098 		/* RPM mode */
1099 		if (fan_from_reg(data->fan_full_speed[nr]))
1100 			val = 255 * fan_from_reg(data->fan_target[nr])
1101 				/ fan_from_reg(data->fan_full_speed[nr]);
1102 		else
1103 			val = 0;
1104 	}
1105 	mutex_unlock(&data->update_lock);
1106 	return sprintf(buf, "%d\n", val);
1107 }
1108 
store_pwm(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1109 static ssize_t store_pwm(struct device *dev,
1110 			 struct device_attribute *devattr, const char *buf,
1111 			 size_t count)
1112 {
1113 	struct f71882fg_data *data = dev_get_drvdata(dev);
1114 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1115 	long val;
1116 
1117 	err = kstrtol(buf, 10, &val);
1118 	if (err)
1119 		return err;
1120 
1121 	val = clamp_val(val, 0, 255);
1122 
1123 	mutex_lock(&data->update_lock);
1124 	data->pwm_enable = f71882fg_read8(data, F71882FG_REG_PWM_ENABLE);
1125 	if ((data->type == f8000 && ((data->pwm_enable >> 2 * nr) & 3) != 2) ||
1126 	    (data->type != f8000 && !((data->pwm_enable >> 2 * nr) & 2))) {
1127 		count = -EROFS;
1128 		goto leave;
1129 	}
1130 	if (data->pwm_enable & (1 << (2 * nr))) {
1131 		/* PWM mode */
1132 		f71882fg_write8(data, F71882FG_REG_PWM(nr), val);
1133 		data->pwm[nr] = val;
1134 	} else {
1135 		/* RPM mode */
1136 		int target, full_speed;
1137 		full_speed = f71882fg_read16(data,
1138 					     F71882FG_REG_FAN_FULL_SPEED(nr));
1139 		target = fan_to_reg(val * fan_from_reg(full_speed) / 255);
1140 		f71882fg_write16(data, F71882FG_REG_FAN_TARGET(nr), target);
1141 		data->fan_target[nr] = target;
1142 		data->fan_full_speed[nr] = full_speed;
1143 	}
1144 leave:
1145 	mutex_unlock(&data->update_lock);
1146 
1147 	return count;
1148 }
1149 
show_pwm_enable(struct device * dev,struct device_attribute * devattr,char * buf)1150 static ssize_t show_pwm_enable(struct device *dev,
1151 			       struct device_attribute *devattr, char *buf)
1152 {
1153 	int result = 0;
1154 	struct f71882fg_data *data = f71882fg_update_device(dev);
1155 	int nr = to_sensor_dev_attr_2(devattr)->index;
1156 
1157 	switch ((data->pwm_enable >> 2 * nr) & 3) {
1158 	case 0:
1159 	case 1:
1160 		result = 2; /* Normal auto mode */
1161 		break;
1162 	case 2:
1163 		result = 1; /* Manual mode */
1164 		break;
1165 	case 3:
1166 		if (data->type == f8000)
1167 			result = 3; /* Thermostat mode */
1168 		else
1169 			result = 1; /* Manual mode */
1170 		break;
1171 	}
1172 
1173 	return sprintf(buf, "%d\n", result);
1174 }
1175 
store_pwm_enable(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1176 static ssize_t store_pwm_enable(struct device *dev, struct device_attribute
1177 				*devattr, const char *buf, size_t count)
1178 {
1179 	struct f71882fg_data *data = dev_get_drvdata(dev);
1180 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1181 	long val;
1182 
1183 	err = kstrtol(buf, 10, &val);
1184 	if (err)
1185 		return err;
1186 
1187 	/* Special case for F8000 pwm channel 3 which only does auto mode */
1188 	if (data->type == f8000 && nr == 2 && val != 2)
1189 		return -EINVAL;
1190 
1191 	mutex_lock(&data->update_lock);
1192 	data->pwm_enable = f71882fg_read8(data, F71882FG_REG_PWM_ENABLE);
1193 	/* Special case for F8000 auto PWM mode / Thermostat mode */
1194 	if (data->type == f8000 && ((data->pwm_enable >> 2 * nr) & 1)) {
1195 		switch (val) {
1196 		case 2:
1197 			data->pwm_enable &= ~(2 << (2 * nr));
1198 			break;		/* Normal auto mode */
1199 		case 3:
1200 			data->pwm_enable |= 2 << (2 * nr);
1201 			break;		/* Thermostat mode */
1202 		default:
1203 			count = -EINVAL;
1204 			goto leave;
1205 		}
1206 	} else {
1207 		switch (val) {
1208 		case 1:
1209 			/* The f71858fg does not support manual RPM mode */
1210 			if (data->type == f71858fg &&
1211 			    ((data->pwm_enable >> (2 * nr)) & 1)) {
1212 				count = -EINVAL;
1213 				goto leave;
1214 			}
1215 			data->pwm_enable |= 2 << (2 * nr);
1216 			break;		/* Manual */
1217 		case 2:
1218 			data->pwm_enable &= ~(2 << (2 * nr));
1219 			break;		/* Normal auto mode */
1220 		default:
1221 			count = -EINVAL;
1222 			goto leave;
1223 		}
1224 	}
1225 	f71882fg_write8(data, F71882FG_REG_PWM_ENABLE, data->pwm_enable);
1226 leave:
1227 	mutex_unlock(&data->update_lock);
1228 
1229 	return count;
1230 }
1231 
show_pwm_interpolate(struct device * dev,struct device_attribute * devattr,char * buf)1232 static ssize_t show_pwm_interpolate(struct device *dev,
1233 				    struct device_attribute *devattr, char *buf)
1234 {
1235 	int result;
1236 	struct f71882fg_data *data = f71882fg_update_device(dev);
1237 	int nr = to_sensor_dev_attr_2(devattr)->index;
1238 
1239 	result = (data->pwm_auto_point_mapping[nr] >> 4) & 1;
1240 
1241 	return sprintf(buf, "%d\n", result);
1242 }
1243 
store_pwm_interpolate(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1244 static ssize_t store_pwm_interpolate(struct device *dev,
1245 				     struct device_attribute *devattr,
1246 				     const char *buf, size_t count)
1247 {
1248 	struct f71882fg_data *data = dev_get_drvdata(dev);
1249 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1250 	unsigned long val;
1251 
1252 	err = kstrtoul(buf, 10, &val);
1253 	if (err)
1254 		return err;
1255 
1256 	mutex_lock(&data->update_lock);
1257 	data->pwm_auto_point_mapping[nr] =
1258 		f71882fg_read8(data, F71882FG_REG_POINT_MAPPING(nr));
1259 	if (val)
1260 		val = data->pwm_auto_point_mapping[nr] | (1 << 4);
1261 	else
1262 		val = data->pwm_auto_point_mapping[nr] & (~(1 << 4));
1263 	f71882fg_write8(data, F71882FG_REG_POINT_MAPPING(nr), val);
1264 	data->pwm_auto_point_mapping[nr] = val;
1265 	mutex_unlock(&data->update_lock);
1266 
1267 	return count;
1268 }
1269 
1270 /* Fan / PWM attr common to all models */
1271 static struct sensor_device_attribute_2 fxxxx_fan_attr[4][6] = { {
1272 	SENSOR_ATTR_2(fan1_input, S_IRUGO, show_fan, NULL, 0, 0),
1273 	SENSOR_ATTR_2(fan1_full_speed, S_IRUGO|S_IWUSR,
1274 		      show_fan_full_speed,
1275 		      store_fan_full_speed, 0, 0),
1276 	SENSOR_ATTR_2(fan1_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 0),
1277 	SENSOR_ATTR_2(pwm1, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 0),
1278 	SENSOR_ATTR_2(pwm1_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
1279 		      store_pwm_enable, 0, 0),
1280 	SENSOR_ATTR_2(pwm1_interpolate, S_IRUGO|S_IWUSR,
1281 		      show_pwm_interpolate, store_pwm_interpolate, 0, 0),
1282 }, {
1283 	SENSOR_ATTR_2(fan2_input, S_IRUGO, show_fan, NULL, 0, 1),
1284 	SENSOR_ATTR_2(fan2_full_speed, S_IRUGO|S_IWUSR,
1285 		      show_fan_full_speed,
1286 		      store_fan_full_speed, 0, 1),
1287 	SENSOR_ATTR_2(fan2_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 1),
1288 	SENSOR_ATTR_2(pwm2, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 1),
1289 	SENSOR_ATTR_2(pwm2_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
1290 		      store_pwm_enable, 0, 1),
1291 	SENSOR_ATTR_2(pwm2_interpolate, S_IRUGO|S_IWUSR,
1292 		      show_pwm_interpolate, store_pwm_interpolate, 0, 1),
1293 }, {
1294 	SENSOR_ATTR_2(fan3_input, S_IRUGO, show_fan, NULL, 0, 2),
1295 	SENSOR_ATTR_2(fan3_full_speed, S_IRUGO|S_IWUSR,
1296 		      show_fan_full_speed,
1297 		      store_fan_full_speed, 0, 2),
1298 	SENSOR_ATTR_2(fan3_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 2),
1299 	SENSOR_ATTR_2(pwm3, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 2),
1300 	SENSOR_ATTR_2(pwm3_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
1301 		      store_pwm_enable, 0, 2),
1302 	SENSOR_ATTR_2(pwm3_interpolate, S_IRUGO|S_IWUSR,
1303 		      show_pwm_interpolate, store_pwm_interpolate, 0, 2),
1304 }, {
1305 	SENSOR_ATTR_2(fan4_input, S_IRUGO, show_fan, NULL, 0, 3),
1306 	SENSOR_ATTR_2(fan4_full_speed, S_IRUGO|S_IWUSR,
1307 		      show_fan_full_speed,
1308 		      store_fan_full_speed, 0, 3),
1309 	SENSOR_ATTR_2(fan4_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 3),
1310 	SENSOR_ATTR_2(pwm4, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 3),
1311 	SENSOR_ATTR_2(pwm4_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
1312 		      store_pwm_enable, 0, 3),
1313 	SENSOR_ATTR_2(pwm4_interpolate, S_IRUGO|S_IWUSR,
1314 		      show_pwm_interpolate, store_pwm_interpolate, 0, 3),
1315 } };
1316 
show_simple_pwm(struct device * dev,struct device_attribute * devattr,char * buf)1317 static ssize_t show_simple_pwm(struct device *dev,
1318 			       struct device_attribute *devattr, char *buf)
1319 {
1320 	struct f71882fg_data *data = f71882fg_update_device(dev);
1321 	int val, nr = to_sensor_dev_attr_2(devattr)->index;
1322 
1323 	val = data->pwm[nr];
1324 	return sprintf(buf, "%d\n", val);
1325 }
1326 
store_simple_pwm(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1327 static ssize_t store_simple_pwm(struct device *dev,
1328 				struct device_attribute *devattr,
1329 				const char *buf, size_t count)
1330 {
1331 	struct f71882fg_data *data = dev_get_drvdata(dev);
1332 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1333 	long val;
1334 
1335 	err = kstrtol(buf, 10, &val);
1336 	if (err)
1337 		return err;
1338 
1339 	val = clamp_val(val, 0, 255);
1340 
1341 	mutex_lock(&data->update_lock);
1342 	f71882fg_write8(data, F71882FG_REG_PWM(nr), val);
1343 	data->pwm[nr] = val;
1344 	mutex_unlock(&data->update_lock);
1345 
1346 	return count;
1347 }
1348 
1349 /* Attr for the third fan of the f71808a, which only has manual pwm */
1350 static struct sensor_device_attribute_2 f71808a_fan3_attr[] = {
1351 	SENSOR_ATTR_2(fan3_input, S_IRUGO, show_fan, NULL, 0, 2),
1352 	SENSOR_ATTR_2(fan3_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 2),
1353 	SENSOR_ATTR_2(pwm3, S_IRUGO|S_IWUSR,
1354 		      show_simple_pwm, store_simple_pwm, 0, 2),
1355 };
1356 
show_fan_beep(struct device * dev,struct device_attribute * devattr,char * buf)1357 static ssize_t show_fan_beep(struct device *dev, struct device_attribute
1358 	*devattr, char *buf)
1359 {
1360 	struct f71882fg_data *data = f71882fg_update_device(dev);
1361 	int nr = to_sensor_dev_attr_2(devattr)->index;
1362 
1363 	if (data->fan_beep & (1 << nr))
1364 		return sprintf(buf, "1\n");
1365 	else
1366 		return sprintf(buf, "0\n");
1367 }
1368 
store_fan_beep(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1369 static ssize_t store_fan_beep(struct device *dev, struct device_attribute
1370 	*devattr, const char *buf, size_t count)
1371 {
1372 	struct f71882fg_data *data = dev_get_drvdata(dev);
1373 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1374 	unsigned long val;
1375 
1376 	err = kstrtoul(buf, 10, &val);
1377 	if (err)
1378 		return err;
1379 
1380 	mutex_lock(&data->update_lock);
1381 	data->fan_beep = f71882fg_read8(data, F71882FG_REG_FAN_BEEP);
1382 	if (val)
1383 		data->fan_beep |= 1 << nr;
1384 	else
1385 		data->fan_beep &= ~(1 << nr);
1386 
1387 	f71882fg_write8(data, F71882FG_REG_FAN_BEEP, data->fan_beep);
1388 	mutex_unlock(&data->update_lock);
1389 
1390 	return count;
1391 }
1392 
1393 /* Attr for models which can beep on Fan alarm */
1394 static struct sensor_device_attribute_2 fxxxx_fan_beep_attr[] = {
1395 	SENSOR_ATTR_2(fan1_beep, S_IRUGO|S_IWUSR, show_fan_beep,
1396 		store_fan_beep, 0, 0),
1397 	SENSOR_ATTR_2(fan2_beep, S_IRUGO|S_IWUSR, show_fan_beep,
1398 		store_fan_beep, 0, 1),
1399 	SENSOR_ATTR_2(fan3_beep, S_IRUGO|S_IWUSR, show_fan_beep,
1400 		store_fan_beep, 0, 2),
1401 	SENSOR_ATTR_2(fan4_beep, S_IRUGO|S_IWUSR, show_fan_beep,
1402 		store_fan_beep, 0, 3),
1403 };
1404 
show_pwm_auto_point_channel(struct device * dev,struct device_attribute * devattr,char * buf)1405 static ssize_t show_pwm_auto_point_channel(struct device *dev,
1406 					   struct device_attribute *devattr,
1407 					   char *buf)
1408 {
1409 	int result;
1410 	struct f71882fg_data *data = f71882fg_update_device(dev);
1411 	int nr = to_sensor_dev_attr_2(devattr)->index;
1412 
1413 	result = 1 << ((data->pwm_auto_point_mapping[nr] & 3) -
1414 		       data->temp_start);
1415 
1416 	return sprintf(buf, "%d\n", result);
1417 }
1418 
store_pwm_auto_point_channel(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1419 static ssize_t store_pwm_auto_point_channel(struct device *dev,
1420 					    struct device_attribute *devattr,
1421 					    const char *buf, size_t count)
1422 {
1423 	struct f71882fg_data *data = dev_get_drvdata(dev);
1424 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1425 	long val;
1426 
1427 	err = kstrtol(buf, 10, &val);
1428 	if (err)
1429 		return err;
1430 
1431 	switch (val) {
1432 	case 1:
1433 		val = 0;
1434 		break;
1435 	case 2:
1436 		val = 1;
1437 		break;
1438 	case 4:
1439 		val = 2;
1440 		break;
1441 	default:
1442 		return -EINVAL;
1443 	}
1444 	val += data->temp_start;
1445 	mutex_lock(&data->update_lock);
1446 	data->pwm_auto_point_mapping[nr] =
1447 		f71882fg_read8(data, F71882FG_REG_POINT_MAPPING(nr));
1448 	val = (data->pwm_auto_point_mapping[nr] & 0xfc) | val;
1449 	f71882fg_write8(data, F71882FG_REG_POINT_MAPPING(nr), val);
1450 	data->pwm_auto_point_mapping[nr] = val;
1451 	mutex_unlock(&data->update_lock);
1452 
1453 	return count;
1454 }
1455 
show_pwm_auto_point_pwm(struct device * dev,struct device_attribute * devattr,char * buf)1456 static ssize_t show_pwm_auto_point_pwm(struct device *dev,
1457 				       struct device_attribute *devattr,
1458 				       char *buf)
1459 {
1460 	int result;
1461 	struct f71882fg_data *data = f71882fg_update_device(dev);
1462 	int pwm = to_sensor_dev_attr_2(devattr)->index;
1463 	int point = to_sensor_dev_attr_2(devattr)->nr;
1464 
1465 	mutex_lock(&data->update_lock);
1466 	if (data->pwm_enable & (1 << (2 * pwm))) {
1467 		/* PWM mode */
1468 		result = data->pwm_auto_point_pwm[pwm][point];
1469 	} else {
1470 		/* RPM mode */
1471 		result = 32 * 255 / (32 + data->pwm_auto_point_pwm[pwm][point]);
1472 	}
1473 	mutex_unlock(&data->update_lock);
1474 
1475 	return sprintf(buf, "%d\n", result);
1476 }
1477 
store_pwm_auto_point_pwm(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1478 static ssize_t store_pwm_auto_point_pwm(struct device *dev,
1479 					struct device_attribute *devattr,
1480 					const char *buf, size_t count)
1481 {
1482 	struct f71882fg_data *data = dev_get_drvdata(dev);
1483 	int err, pwm = to_sensor_dev_attr_2(devattr)->index;
1484 	int point = to_sensor_dev_attr_2(devattr)->nr;
1485 	long val;
1486 
1487 	err = kstrtol(buf, 10, &val);
1488 	if (err)
1489 		return err;
1490 
1491 	val = clamp_val(val, 0, 255);
1492 
1493 	mutex_lock(&data->update_lock);
1494 	data->pwm_enable = f71882fg_read8(data, F71882FG_REG_PWM_ENABLE);
1495 	if (data->pwm_enable & (1 << (2 * pwm))) {
1496 		/* PWM mode */
1497 	} else {
1498 		/* RPM mode */
1499 		if (val < 29)	/* Prevent negative numbers */
1500 			val = 255;
1501 		else
1502 			val = (255 - val) * 32 / val;
1503 	}
1504 	f71882fg_write8(data, F71882FG_REG_POINT_PWM(pwm, point), val);
1505 	data->pwm_auto_point_pwm[pwm][point] = val;
1506 	mutex_unlock(&data->update_lock);
1507 
1508 	return count;
1509 }
1510 
show_pwm_auto_point_temp(struct device * dev,struct device_attribute * devattr,char * buf)1511 static ssize_t show_pwm_auto_point_temp(struct device *dev,
1512 					struct device_attribute *devattr,
1513 					char *buf)
1514 {
1515 	int result;
1516 	struct f71882fg_data *data = f71882fg_update_device(dev);
1517 	int pwm = to_sensor_dev_attr_2(devattr)->index;
1518 	int point = to_sensor_dev_attr_2(devattr)->nr;
1519 
1520 	result = data->pwm_auto_point_temp[pwm][point];
1521 	return sprintf(buf, "%d\n", 1000 * result);
1522 }
1523 
store_pwm_auto_point_temp(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1524 static ssize_t store_pwm_auto_point_temp(struct device *dev,
1525 					 struct device_attribute *devattr,
1526 					 const char *buf, size_t count)
1527 {
1528 	struct f71882fg_data *data = dev_get_drvdata(dev);
1529 	int err, pwm = to_sensor_dev_attr_2(devattr)->index;
1530 	int point = to_sensor_dev_attr_2(devattr)->nr;
1531 	long val;
1532 
1533 	err = kstrtol(buf, 10, &val);
1534 	if (err)
1535 		return err;
1536 
1537 	val /= 1000;
1538 
1539 	if (data->auto_point_temp_signed)
1540 		val = clamp_val(val, -128, 127);
1541 	else
1542 		val = clamp_val(val, 0, 127);
1543 
1544 	mutex_lock(&data->update_lock);
1545 	f71882fg_write8(data, F71882FG_REG_POINT_TEMP(pwm, point), val);
1546 	data->pwm_auto_point_temp[pwm][point] = val;
1547 	mutex_unlock(&data->update_lock);
1548 
1549 	return count;
1550 }
1551 
show_pwm_auto_point_temp_hyst(struct device * dev,struct device_attribute * devattr,char * buf)1552 static ssize_t show_pwm_auto_point_temp_hyst(struct device *dev,
1553 					     struct device_attribute *devattr,
1554 					     char *buf)
1555 {
1556 	int result = 0;
1557 	struct f71882fg_data *data = f71882fg_update_device(dev);
1558 	int nr = to_sensor_dev_attr_2(devattr)->index;
1559 	int point = to_sensor_dev_attr_2(devattr)->nr;
1560 
1561 	mutex_lock(&data->update_lock);
1562 	if (nr & 1)
1563 		result = data->pwm_auto_point_hyst[nr / 2] >> 4;
1564 	else
1565 		result = data->pwm_auto_point_hyst[nr / 2] & 0x0f;
1566 	result = 1000 * (data->pwm_auto_point_temp[nr][point] - result);
1567 	mutex_unlock(&data->update_lock);
1568 
1569 	return sprintf(buf, "%d\n", result);
1570 }
1571 
store_pwm_auto_point_temp_hyst(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1572 static ssize_t store_pwm_auto_point_temp_hyst(struct device *dev,
1573 					      struct device_attribute *devattr,
1574 					      const char *buf, size_t count)
1575 {
1576 	struct f71882fg_data *data = dev_get_drvdata(dev);
1577 	int err, nr = to_sensor_dev_attr_2(devattr)->index;
1578 	int point = to_sensor_dev_attr_2(devattr)->nr;
1579 	u8 reg;
1580 	long val;
1581 
1582 	err = kstrtol(buf, 10, &val);
1583 	if (err)
1584 		return err;
1585 
1586 	val /= 1000;
1587 
1588 	mutex_lock(&data->update_lock);
1589 	data->pwm_auto_point_temp[nr][point] =
1590 		f71882fg_read8(data, F71882FG_REG_POINT_TEMP(nr, point));
1591 	val = clamp_val(val, data->pwm_auto_point_temp[nr][point] - 15,
1592 			data->pwm_auto_point_temp[nr][point]);
1593 	val = data->pwm_auto_point_temp[nr][point] - val;
1594 
1595 	reg = f71882fg_read8(data, F71882FG_REG_FAN_HYST(nr / 2));
1596 	if (nr & 1)
1597 		reg = (reg & 0x0f) | (val << 4);
1598 	else
1599 		reg = (reg & 0xf0) | val;
1600 
1601 	f71882fg_write8(data, F71882FG_REG_FAN_HYST(nr / 2), reg);
1602 	data->pwm_auto_point_hyst[nr / 2] = reg;
1603 	mutex_unlock(&data->update_lock);
1604 
1605 	return count;
1606 }
1607 
1608 /*
1609  * PWM attr for the f71862fg, fewer pwms and fewer zones per pwm than the
1610  * standard models
1611  */
1612 static struct sensor_device_attribute_2 f71862fg_auto_pwm_attr[3][7] = { {
1613 	SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
1614 		      show_pwm_auto_point_channel,
1615 		      store_pwm_auto_point_channel, 0, 0),
1616 	SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
1617 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1618 		      1, 0),
1619 	SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
1620 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1621 		      4, 0),
1622 	SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
1623 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1624 		      0, 0),
1625 	SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
1626 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1627 		      3, 0),
1628 	SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1629 		      show_pwm_auto_point_temp_hyst,
1630 		      store_pwm_auto_point_temp_hyst,
1631 		      0, 0),
1632 	SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
1633 		      show_pwm_auto_point_temp_hyst, NULL, 3, 0),
1634 }, {
1635 	SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
1636 		      show_pwm_auto_point_channel,
1637 		      store_pwm_auto_point_channel, 0, 1),
1638 	SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
1639 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1640 		      1, 1),
1641 	SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
1642 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1643 		      4, 1),
1644 	SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
1645 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1646 		      0, 1),
1647 	SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
1648 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1649 		      3, 1),
1650 	SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1651 		      show_pwm_auto_point_temp_hyst,
1652 		      store_pwm_auto_point_temp_hyst,
1653 		      0, 1),
1654 	SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
1655 		      show_pwm_auto_point_temp_hyst, NULL, 3, 1),
1656 }, {
1657 	SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
1658 		      show_pwm_auto_point_channel,
1659 		      store_pwm_auto_point_channel, 0, 2),
1660 	SENSOR_ATTR_2(pwm3_auto_point1_pwm, S_IRUGO|S_IWUSR,
1661 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1662 		      1, 2),
1663 	SENSOR_ATTR_2(pwm3_auto_point2_pwm, S_IRUGO|S_IWUSR,
1664 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1665 		      4, 2),
1666 	SENSOR_ATTR_2(pwm3_auto_point1_temp, S_IRUGO|S_IWUSR,
1667 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1668 		      0, 2),
1669 	SENSOR_ATTR_2(pwm3_auto_point2_temp, S_IRUGO|S_IWUSR,
1670 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1671 		      3, 2),
1672 	SENSOR_ATTR_2(pwm3_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1673 		      show_pwm_auto_point_temp_hyst,
1674 		      store_pwm_auto_point_temp_hyst,
1675 		      0, 2),
1676 	SENSOR_ATTR_2(pwm3_auto_point2_temp_hyst, S_IRUGO,
1677 		      show_pwm_auto_point_temp_hyst, NULL, 3, 2),
1678 } };
1679 
1680 /*
1681  * PWM attr for the f71808e/f71869, almost identical to the f71862fg, but the
1682  * pwm setting when the temperature is above the pwmX_auto_point1_temp can be
1683  * programmed instead of being hardcoded to 0xff
1684  */
1685 static struct sensor_device_attribute_2 f71869_auto_pwm_attr[3][8] = { {
1686 	SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
1687 		      show_pwm_auto_point_channel,
1688 		      store_pwm_auto_point_channel, 0, 0),
1689 	SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
1690 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1691 		      0, 0),
1692 	SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
1693 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1694 		      1, 0),
1695 	SENSOR_ATTR_2(pwm1_auto_point3_pwm, S_IRUGO|S_IWUSR,
1696 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1697 		      4, 0),
1698 	SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
1699 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1700 		      0, 0),
1701 	SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
1702 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1703 		      3, 0),
1704 	SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1705 		      show_pwm_auto_point_temp_hyst,
1706 		      store_pwm_auto_point_temp_hyst,
1707 		      0, 0),
1708 	SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
1709 		      show_pwm_auto_point_temp_hyst, NULL, 3, 0),
1710 }, {
1711 	SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
1712 		      show_pwm_auto_point_channel,
1713 		      store_pwm_auto_point_channel, 0, 1),
1714 	SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
1715 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1716 		      0, 1),
1717 	SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
1718 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1719 		      1, 1),
1720 	SENSOR_ATTR_2(pwm2_auto_point3_pwm, S_IRUGO|S_IWUSR,
1721 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1722 		      4, 1),
1723 	SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
1724 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1725 		      0, 1),
1726 	SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
1727 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1728 		      3, 1),
1729 	SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1730 		      show_pwm_auto_point_temp_hyst,
1731 		      store_pwm_auto_point_temp_hyst,
1732 		      0, 1),
1733 	SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
1734 		      show_pwm_auto_point_temp_hyst, NULL, 3, 1),
1735 }, {
1736 	SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
1737 		      show_pwm_auto_point_channel,
1738 		      store_pwm_auto_point_channel, 0, 2),
1739 	SENSOR_ATTR_2(pwm3_auto_point1_pwm, S_IRUGO|S_IWUSR,
1740 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1741 		      0, 2),
1742 	SENSOR_ATTR_2(pwm3_auto_point2_pwm, S_IRUGO|S_IWUSR,
1743 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1744 		      1, 2),
1745 	SENSOR_ATTR_2(pwm3_auto_point3_pwm, S_IRUGO|S_IWUSR,
1746 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1747 		      4, 2),
1748 	SENSOR_ATTR_2(pwm3_auto_point1_temp, S_IRUGO|S_IWUSR,
1749 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1750 		      0, 2),
1751 	SENSOR_ATTR_2(pwm3_auto_point2_temp, S_IRUGO|S_IWUSR,
1752 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1753 		      3, 2),
1754 	SENSOR_ATTR_2(pwm3_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1755 		      show_pwm_auto_point_temp_hyst,
1756 		      store_pwm_auto_point_temp_hyst,
1757 		      0, 2),
1758 	SENSOR_ATTR_2(pwm3_auto_point2_temp_hyst, S_IRUGO,
1759 		      show_pwm_auto_point_temp_hyst, NULL, 3, 2),
1760 } };
1761 
1762 /* PWM attr for the standard models */
1763 static struct sensor_device_attribute_2 fxxxx_auto_pwm_attr[4][14] = { {
1764 	SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
1765 		      show_pwm_auto_point_channel,
1766 		      store_pwm_auto_point_channel, 0, 0),
1767 	SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
1768 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1769 		      0, 0),
1770 	SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
1771 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1772 		      1, 0),
1773 	SENSOR_ATTR_2(pwm1_auto_point3_pwm, S_IRUGO|S_IWUSR,
1774 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1775 		      2, 0),
1776 	SENSOR_ATTR_2(pwm1_auto_point4_pwm, S_IRUGO|S_IWUSR,
1777 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1778 		      3, 0),
1779 	SENSOR_ATTR_2(pwm1_auto_point5_pwm, S_IRUGO|S_IWUSR,
1780 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1781 		      4, 0),
1782 	SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
1783 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1784 		      0, 0),
1785 	SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
1786 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1787 		      1, 0),
1788 	SENSOR_ATTR_2(pwm1_auto_point3_temp, S_IRUGO|S_IWUSR,
1789 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1790 		      2, 0),
1791 	SENSOR_ATTR_2(pwm1_auto_point4_temp, S_IRUGO|S_IWUSR,
1792 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1793 		      3, 0),
1794 	SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1795 		      show_pwm_auto_point_temp_hyst,
1796 		      store_pwm_auto_point_temp_hyst,
1797 		      0, 0),
1798 	SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
1799 		      show_pwm_auto_point_temp_hyst, NULL, 1, 0),
1800 	SENSOR_ATTR_2(pwm1_auto_point3_temp_hyst, S_IRUGO,
1801 		      show_pwm_auto_point_temp_hyst, NULL, 2, 0),
1802 	SENSOR_ATTR_2(pwm1_auto_point4_temp_hyst, S_IRUGO,
1803 		      show_pwm_auto_point_temp_hyst, NULL, 3, 0),
1804 }, {
1805 	SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
1806 		      show_pwm_auto_point_channel,
1807 		      store_pwm_auto_point_channel, 0, 1),
1808 	SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
1809 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1810 		      0, 1),
1811 	SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
1812 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1813 		      1, 1),
1814 	SENSOR_ATTR_2(pwm2_auto_point3_pwm, S_IRUGO|S_IWUSR,
1815 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1816 		      2, 1),
1817 	SENSOR_ATTR_2(pwm2_auto_point4_pwm, S_IRUGO|S_IWUSR,
1818 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1819 		      3, 1),
1820 	SENSOR_ATTR_2(pwm2_auto_point5_pwm, S_IRUGO|S_IWUSR,
1821 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1822 		      4, 1),
1823 	SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
1824 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1825 		      0, 1),
1826 	SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
1827 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1828 		      1, 1),
1829 	SENSOR_ATTR_2(pwm2_auto_point3_temp, S_IRUGO|S_IWUSR,
1830 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1831 		      2, 1),
1832 	SENSOR_ATTR_2(pwm2_auto_point4_temp, S_IRUGO|S_IWUSR,
1833 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1834 		      3, 1),
1835 	SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1836 		      show_pwm_auto_point_temp_hyst,
1837 		      store_pwm_auto_point_temp_hyst,
1838 		      0, 1),
1839 	SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
1840 		      show_pwm_auto_point_temp_hyst, NULL, 1, 1),
1841 	SENSOR_ATTR_2(pwm2_auto_point3_temp_hyst, S_IRUGO,
1842 		      show_pwm_auto_point_temp_hyst, NULL, 2, 1),
1843 	SENSOR_ATTR_2(pwm2_auto_point4_temp_hyst, S_IRUGO,
1844 		      show_pwm_auto_point_temp_hyst, NULL, 3, 1),
1845 }, {
1846 	SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
1847 		      show_pwm_auto_point_channel,
1848 		      store_pwm_auto_point_channel, 0, 2),
1849 	SENSOR_ATTR_2(pwm3_auto_point1_pwm, S_IRUGO|S_IWUSR,
1850 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1851 		      0, 2),
1852 	SENSOR_ATTR_2(pwm3_auto_point2_pwm, S_IRUGO|S_IWUSR,
1853 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1854 		      1, 2),
1855 	SENSOR_ATTR_2(pwm3_auto_point3_pwm, S_IRUGO|S_IWUSR,
1856 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1857 		      2, 2),
1858 	SENSOR_ATTR_2(pwm3_auto_point4_pwm, S_IRUGO|S_IWUSR,
1859 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1860 		      3, 2),
1861 	SENSOR_ATTR_2(pwm3_auto_point5_pwm, S_IRUGO|S_IWUSR,
1862 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1863 		      4, 2),
1864 	SENSOR_ATTR_2(pwm3_auto_point1_temp, S_IRUGO|S_IWUSR,
1865 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1866 		      0, 2),
1867 	SENSOR_ATTR_2(pwm3_auto_point2_temp, S_IRUGO|S_IWUSR,
1868 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1869 		      1, 2),
1870 	SENSOR_ATTR_2(pwm3_auto_point3_temp, S_IRUGO|S_IWUSR,
1871 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1872 		      2, 2),
1873 	SENSOR_ATTR_2(pwm3_auto_point4_temp, S_IRUGO|S_IWUSR,
1874 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1875 		      3, 2),
1876 	SENSOR_ATTR_2(pwm3_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1877 		      show_pwm_auto_point_temp_hyst,
1878 		      store_pwm_auto_point_temp_hyst,
1879 		      0, 2),
1880 	SENSOR_ATTR_2(pwm3_auto_point2_temp_hyst, S_IRUGO,
1881 		      show_pwm_auto_point_temp_hyst, NULL, 1, 2),
1882 	SENSOR_ATTR_2(pwm3_auto_point3_temp_hyst, S_IRUGO,
1883 		      show_pwm_auto_point_temp_hyst, NULL, 2, 2),
1884 	SENSOR_ATTR_2(pwm3_auto_point4_temp_hyst, S_IRUGO,
1885 		      show_pwm_auto_point_temp_hyst, NULL, 3, 2),
1886 }, {
1887 	SENSOR_ATTR_2(pwm4_auto_channels_temp, S_IRUGO|S_IWUSR,
1888 		      show_pwm_auto_point_channel,
1889 		      store_pwm_auto_point_channel, 0, 3),
1890 	SENSOR_ATTR_2(pwm4_auto_point1_pwm, S_IRUGO|S_IWUSR,
1891 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1892 		      0, 3),
1893 	SENSOR_ATTR_2(pwm4_auto_point2_pwm, S_IRUGO|S_IWUSR,
1894 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1895 		      1, 3),
1896 	SENSOR_ATTR_2(pwm4_auto_point3_pwm, S_IRUGO|S_IWUSR,
1897 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1898 		      2, 3),
1899 	SENSOR_ATTR_2(pwm4_auto_point4_pwm, S_IRUGO|S_IWUSR,
1900 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1901 		      3, 3),
1902 	SENSOR_ATTR_2(pwm4_auto_point5_pwm, S_IRUGO|S_IWUSR,
1903 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1904 		      4, 3),
1905 	SENSOR_ATTR_2(pwm4_auto_point1_temp, S_IRUGO|S_IWUSR,
1906 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1907 		      0, 3),
1908 	SENSOR_ATTR_2(pwm4_auto_point2_temp, S_IRUGO|S_IWUSR,
1909 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1910 		      1, 3),
1911 	SENSOR_ATTR_2(pwm4_auto_point3_temp, S_IRUGO|S_IWUSR,
1912 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1913 		      2, 3),
1914 	SENSOR_ATTR_2(pwm4_auto_point4_temp, S_IRUGO|S_IWUSR,
1915 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1916 		      3, 3),
1917 	SENSOR_ATTR_2(pwm4_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1918 		      show_pwm_auto_point_temp_hyst,
1919 		      store_pwm_auto_point_temp_hyst,
1920 		      0, 3),
1921 	SENSOR_ATTR_2(pwm4_auto_point2_temp_hyst, S_IRUGO,
1922 		      show_pwm_auto_point_temp_hyst, NULL, 1, 3),
1923 	SENSOR_ATTR_2(pwm4_auto_point3_temp_hyst, S_IRUGO,
1924 		      show_pwm_auto_point_temp_hyst, NULL, 2, 3),
1925 	SENSOR_ATTR_2(pwm4_auto_point4_temp_hyst, S_IRUGO,
1926 		      show_pwm_auto_point_temp_hyst, NULL, 3, 3),
1927 } };
1928 
1929 /* Fan attr specific to the f8000 (4th fan input can only measure speed) */
1930 static struct sensor_device_attribute_2 f8000_fan_attr[] = {
1931 	SENSOR_ATTR_2(fan4_input, S_IRUGO, show_fan, NULL, 0, 3),
1932 };
1933 
1934 /*
1935  * PWM attr for the f8000, zones mapped to temp instead of to pwm!
1936  * Also the register block at offset A0 maps to TEMP1 (so our temp2, as the
1937  * F8000 starts counting temps at 0), B0 maps the TEMP2 and C0 maps to TEMP0
1938  */
1939 static struct sensor_device_attribute_2 f8000_auto_pwm_attr[3][14] = { {
1940 	SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
1941 		      show_pwm_auto_point_channel,
1942 		      store_pwm_auto_point_channel, 0, 0),
1943 	SENSOR_ATTR_2(temp1_auto_point1_pwm, S_IRUGO|S_IWUSR,
1944 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1945 		      0, 2),
1946 	SENSOR_ATTR_2(temp1_auto_point2_pwm, S_IRUGO|S_IWUSR,
1947 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1948 		      1, 2),
1949 	SENSOR_ATTR_2(temp1_auto_point3_pwm, S_IRUGO|S_IWUSR,
1950 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1951 		      2, 2),
1952 	SENSOR_ATTR_2(temp1_auto_point4_pwm, S_IRUGO|S_IWUSR,
1953 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1954 		      3, 2),
1955 	SENSOR_ATTR_2(temp1_auto_point5_pwm, S_IRUGO|S_IWUSR,
1956 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1957 		      4, 2),
1958 	SENSOR_ATTR_2(temp1_auto_point1_temp, S_IRUGO|S_IWUSR,
1959 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1960 		      0, 2),
1961 	SENSOR_ATTR_2(temp1_auto_point2_temp, S_IRUGO|S_IWUSR,
1962 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1963 		      1, 2),
1964 	SENSOR_ATTR_2(temp1_auto_point3_temp, S_IRUGO|S_IWUSR,
1965 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1966 		      2, 2),
1967 	SENSOR_ATTR_2(temp1_auto_point4_temp, S_IRUGO|S_IWUSR,
1968 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
1969 		      3, 2),
1970 	SENSOR_ATTR_2(temp1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
1971 		      show_pwm_auto_point_temp_hyst,
1972 		      store_pwm_auto_point_temp_hyst,
1973 		      0, 2),
1974 	SENSOR_ATTR_2(temp1_auto_point2_temp_hyst, S_IRUGO,
1975 		      show_pwm_auto_point_temp_hyst, NULL, 1, 2),
1976 	SENSOR_ATTR_2(temp1_auto_point3_temp_hyst, S_IRUGO,
1977 		      show_pwm_auto_point_temp_hyst, NULL, 2, 2),
1978 	SENSOR_ATTR_2(temp1_auto_point4_temp_hyst, S_IRUGO,
1979 		      show_pwm_auto_point_temp_hyst, NULL, 3, 2),
1980 }, {
1981 	SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
1982 		      show_pwm_auto_point_channel,
1983 		      store_pwm_auto_point_channel, 0, 1),
1984 	SENSOR_ATTR_2(temp2_auto_point1_pwm, S_IRUGO|S_IWUSR,
1985 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1986 		      0, 0),
1987 	SENSOR_ATTR_2(temp2_auto_point2_pwm, S_IRUGO|S_IWUSR,
1988 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1989 		      1, 0),
1990 	SENSOR_ATTR_2(temp2_auto_point3_pwm, S_IRUGO|S_IWUSR,
1991 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1992 		      2, 0),
1993 	SENSOR_ATTR_2(temp2_auto_point4_pwm, S_IRUGO|S_IWUSR,
1994 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1995 		      3, 0),
1996 	SENSOR_ATTR_2(temp2_auto_point5_pwm, S_IRUGO|S_IWUSR,
1997 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
1998 		      4, 0),
1999 	SENSOR_ATTR_2(temp2_auto_point1_temp, S_IRUGO|S_IWUSR,
2000 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2001 		      0, 0),
2002 	SENSOR_ATTR_2(temp2_auto_point2_temp, S_IRUGO|S_IWUSR,
2003 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2004 		      1, 0),
2005 	SENSOR_ATTR_2(temp2_auto_point3_temp, S_IRUGO|S_IWUSR,
2006 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2007 		      2, 0),
2008 	SENSOR_ATTR_2(temp2_auto_point4_temp, S_IRUGO|S_IWUSR,
2009 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2010 		      3, 0),
2011 	SENSOR_ATTR_2(temp2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
2012 		      show_pwm_auto_point_temp_hyst,
2013 		      store_pwm_auto_point_temp_hyst,
2014 		      0, 0),
2015 	SENSOR_ATTR_2(temp2_auto_point2_temp_hyst, S_IRUGO,
2016 		      show_pwm_auto_point_temp_hyst, NULL, 1, 0),
2017 	SENSOR_ATTR_2(temp2_auto_point3_temp_hyst, S_IRUGO,
2018 		      show_pwm_auto_point_temp_hyst, NULL, 2, 0),
2019 	SENSOR_ATTR_2(temp2_auto_point4_temp_hyst, S_IRUGO,
2020 		      show_pwm_auto_point_temp_hyst, NULL, 3, 0),
2021 }, {
2022 	SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
2023 		      show_pwm_auto_point_channel,
2024 		      store_pwm_auto_point_channel, 0, 2),
2025 	SENSOR_ATTR_2(temp3_auto_point1_pwm, S_IRUGO|S_IWUSR,
2026 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
2027 		      0, 1),
2028 	SENSOR_ATTR_2(temp3_auto_point2_pwm, S_IRUGO|S_IWUSR,
2029 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
2030 		      1, 1),
2031 	SENSOR_ATTR_2(temp3_auto_point3_pwm, S_IRUGO|S_IWUSR,
2032 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
2033 		      2, 1),
2034 	SENSOR_ATTR_2(temp3_auto_point4_pwm, S_IRUGO|S_IWUSR,
2035 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
2036 		      3, 1),
2037 	SENSOR_ATTR_2(temp3_auto_point5_pwm, S_IRUGO|S_IWUSR,
2038 		      show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
2039 		      4, 1),
2040 	SENSOR_ATTR_2(temp3_auto_point1_temp, S_IRUGO|S_IWUSR,
2041 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2042 		      0, 1),
2043 	SENSOR_ATTR_2(temp3_auto_point2_temp, S_IRUGO|S_IWUSR,
2044 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2045 		      1, 1),
2046 	SENSOR_ATTR_2(temp3_auto_point3_temp, S_IRUGO|S_IWUSR,
2047 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2048 		      2, 1),
2049 	SENSOR_ATTR_2(temp3_auto_point4_temp, S_IRUGO|S_IWUSR,
2050 		      show_pwm_auto_point_temp, store_pwm_auto_point_temp,
2051 		      3, 1),
2052 	SENSOR_ATTR_2(temp3_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
2053 		      show_pwm_auto_point_temp_hyst,
2054 		      store_pwm_auto_point_temp_hyst,
2055 		      0, 1),
2056 	SENSOR_ATTR_2(temp3_auto_point2_temp_hyst, S_IRUGO,
2057 		      show_pwm_auto_point_temp_hyst, NULL, 1, 1),
2058 	SENSOR_ATTR_2(temp3_auto_point3_temp_hyst, S_IRUGO,
2059 		      show_pwm_auto_point_temp_hyst, NULL, 2, 1),
2060 	SENSOR_ATTR_2(temp3_auto_point4_temp_hyst, S_IRUGO,
2061 		      show_pwm_auto_point_temp_hyst, NULL, 3, 1),
2062 } };
2063 
2064 /* Super I/O functions */
superio_inb(int base,int reg)2065 static inline int superio_inb(int base, int reg)
2066 {
2067 	outb(reg, base);
2068 	return inb(base + 1);
2069 }
2070 
superio_inw(int base,int reg)2071 static int superio_inw(int base, int reg)
2072 {
2073 	int val;
2074 	val  = superio_inb(base, reg) << 8;
2075 	val |= superio_inb(base, reg + 1);
2076 	return val;
2077 }
2078 
superio_enter(int base)2079 static inline int superio_enter(int base)
2080 {
2081 	/* Don't step on other drivers' I/O space by accident */
2082 	if (!request_muxed_region(base, 2, DRVNAME)) {
2083 		pr_err("I/O address 0x%04x already in use\n", base);
2084 		return -EBUSY;
2085 	}
2086 
2087 	/* according to the datasheet the key must be send twice! */
2088 	outb(SIO_UNLOCK_KEY, base);
2089 	outb(SIO_UNLOCK_KEY, base);
2090 
2091 	return 0;
2092 }
2093 
superio_select(int base,int ld)2094 static inline void superio_select(int base, int ld)
2095 {
2096 	outb(SIO_REG_LDSEL, base);
2097 	outb(ld, base + 1);
2098 }
2099 
superio_exit(int base)2100 static inline void superio_exit(int base)
2101 {
2102 	outb(SIO_LOCK_KEY, base);
2103 	release_region(base, 2);
2104 }
2105 
f71882fg_create_sysfs_files(struct platform_device * pdev,struct sensor_device_attribute_2 * attr,int count)2106 static int f71882fg_create_sysfs_files(struct platform_device *pdev,
2107 	struct sensor_device_attribute_2 *attr, int count)
2108 {
2109 	int err, i;
2110 
2111 	for (i = 0; i < count; i++) {
2112 		err = device_create_file(&pdev->dev, &attr[i].dev_attr);
2113 		if (err)
2114 			return err;
2115 	}
2116 	return 0;
2117 }
2118 
f71882fg_remove_sysfs_files(struct platform_device * pdev,struct sensor_device_attribute_2 * attr,int count)2119 static void f71882fg_remove_sysfs_files(struct platform_device *pdev,
2120 	struct sensor_device_attribute_2 *attr, int count)
2121 {
2122 	int i;
2123 
2124 	for (i = 0; i < count; i++)
2125 		device_remove_file(&pdev->dev, &attr[i].dev_attr);
2126 }
2127 
f71882fg_create_fan_sysfs_files(struct platform_device * pdev,int idx)2128 static int f71882fg_create_fan_sysfs_files(
2129 	struct platform_device *pdev, int idx)
2130 {
2131 	struct f71882fg_data *data = platform_get_drvdata(pdev);
2132 	int err;
2133 
2134 	/* Sanity check the pwm setting */
2135 	err = 0;
2136 	switch (data->type) {
2137 	case f71858fg:
2138 		if (((data->pwm_enable >> (idx * 2)) & 3) == 3)
2139 			err = 1;
2140 		break;
2141 	case f71862fg:
2142 		if (((data->pwm_enable >> (idx * 2)) & 1) != 1)
2143 			err = 1;
2144 		break;
2145 	case f8000:
2146 		if (idx == 2)
2147 			err = data->pwm_enable & 0x20;
2148 		break;
2149 	default:
2150 		break;
2151 	}
2152 	if (err) {
2153 		dev_err(&pdev->dev,
2154 			"Invalid (reserved) pwm settings: 0x%02x, "
2155 			"skipping fan %d\n",
2156 			(data->pwm_enable >> (idx * 2)) & 3, idx + 1);
2157 		return 0; /* This is a non fatal condition */
2158 	}
2159 
2160 	err = f71882fg_create_sysfs_files(pdev, &fxxxx_fan_attr[idx][0],
2161 					  ARRAY_SIZE(fxxxx_fan_attr[0]));
2162 	if (err)
2163 		return err;
2164 
2165 	if (f71882fg_fan_has_beep[data->type]) {
2166 		err = f71882fg_create_sysfs_files(pdev,
2167 						  &fxxxx_fan_beep_attr[idx],
2168 						  1);
2169 		if (err)
2170 			return err;
2171 	}
2172 
2173 	dev_info(&pdev->dev, "Fan: %d is in %s mode\n", idx + 1,
2174 		 (data->pwm_enable & (1 << (2 * idx))) ? "duty-cycle" : "RPM");
2175 
2176 	/* Check for unsupported auto pwm settings */
2177 	switch (data->type) {
2178 	case f71808e:
2179 	case f71808a:
2180 	case f71869:
2181 	case f71869a:
2182 	case f71889fg:
2183 	case f71889ed:
2184 	case f71889a:
2185 		data->pwm_auto_point_mapping[idx] =
2186 			f71882fg_read8(data, F71882FG_REG_POINT_MAPPING(idx));
2187 		if ((data->pwm_auto_point_mapping[idx] & 0x80) ||
2188 		    (data->pwm_auto_point_mapping[idx] & 3) == 0) {
2189 			dev_warn(&pdev->dev,
2190 				 "Auto pwm controlled by raw digital "
2191 				 "data, disabling pwm auto_point "
2192 				 "sysfs attributes for fan %d\n", idx + 1);
2193 			return 0; /* This is a non fatal condition */
2194 		}
2195 		break;
2196 	default:
2197 		break;
2198 	}
2199 
2200 	switch (data->type) {
2201 	case f71862fg:
2202 		err = f71882fg_create_sysfs_files(pdev,
2203 					&f71862fg_auto_pwm_attr[idx][0],
2204 					ARRAY_SIZE(f71862fg_auto_pwm_attr[0]));
2205 		break;
2206 	case f71808e:
2207 	case f71869:
2208 		err = f71882fg_create_sysfs_files(pdev,
2209 					&f71869_auto_pwm_attr[idx][0],
2210 					ARRAY_SIZE(f71869_auto_pwm_attr[0]));
2211 		break;
2212 	case f8000:
2213 		err = f71882fg_create_sysfs_files(pdev,
2214 					&f8000_auto_pwm_attr[idx][0],
2215 					ARRAY_SIZE(f8000_auto_pwm_attr[0]));
2216 		break;
2217 	default:
2218 		err = f71882fg_create_sysfs_files(pdev,
2219 					&fxxxx_auto_pwm_attr[idx][0],
2220 					ARRAY_SIZE(fxxxx_auto_pwm_attr[0]));
2221 	}
2222 
2223 	return err;
2224 }
2225 
f71882fg_remove(struct platform_device * pdev)2226 static int f71882fg_remove(struct platform_device *pdev)
2227 {
2228 	struct f71882fg_data *data = platform_get_drvdata(pdev);
2229 	int nr_fans = f71882fg_nr_fans[data->type];
2230 	int nr_temps = f71882fg_nr_temps[data->type];
2231 	int i;
2232 	u8 start_reg = f71882fg_read8(data, F71882FG_REG_START);
2233 
2234 	if (data->hwmon_dev)
2235 		hwmon_device_unregister(data->hwmon_dev);
2236 
2237 	device_remove_file(&pdev->dev, &dev_attr_name);
2238 
2239 	if (start_reg & 0x01) {
2240 		switch (data->type) {
2241 		case f71858fg:
2242 			if (data->temp_config & 0x10)
2243 				f71882fg_remove_sysfs_files(pdev,
2244 					f8000_temp_attr,
2245 					ARRAY_SIZE(f8000_temp_attr));
2246 			else
2247 				f71882fg_remove_sysfs_files(pdev,
2248 					f71858fg_temp_attr,
2249 					ARRAY_SIZE(f71858fg_temp_attr));
2250 			break;
2251 		case f8000:
2252 			f71882fg_remove_sysfs_files(pdev,
2253 					f8000_temp_attr,
2254 					ARRAY_SIZE(f8000_temp_attr));
2255 			break;
2256 		case f81866a:
2257 			f71882fg_remove_sysfs_files(pdev,
2258 					f71858fg_temp_attr,
2259 					ARRAY_SIZE(f71858fg_temp_attr));
2260 			break;
2261 		default:
2262 			f71882fg_remove_sysfs_files(pdev,
2263 				&fxxxx_temp_attr[0][0],
2264 				ARRAY_SIZE(fxxxx_temp_attr[0]) * nr_temps);
2265 		}
2266 		if (f71882fg_temp_has_beep[data->type]) {
2267 			if (data->type == f81866a)
2268 				f71882fg_remove_sysfs_files(pdev,
2269 					&f81866_temp_beep_attr[0][0],
2270 					ARRAY_SIZE(f81866_temp_beep_attr[0])
2271 						* nr_temps);
2272 			else
2273 				f71882fg_remove_sysfs_files(pdev,
2274 					&fxxxx_temp_beep_attr[0][0],
2275 					ARRAY_SIZE(fxxxx_temp_beep_attr[0])
2276 						* nr_temps);
2277 		}
2278 
2279 		for (i = 0; i < F71882FG_MAX_INS; i++) {
2280 			if (f71882fg_has_in[data->type][i]) {
2281 				device_remove_file(&pdev->dev,
2282 						&fxxxx_in_attr[i].dev_attr);
2283 			}
2284 		}
2285 		if (f71882fg_has_in1_alarm[data->type]) {
2286 			f71882fg_remove_sysfs_files(pdev,
2287 					fxxxx_in1_alarm_attr,
2288 					ARRAY_SIZE(fxxxx_in1_alarm_attr));
2289 		}
2290 	}
2291 
2292 	if (start_reg & 0x02) {
2293 		f71882fg_remove_sysfs_files(pdev, &fxxxx_fan_attr[0][0],
2294 				ARRAY_SIZE(fxxxx_fan_attr[0]) * nr_fans);
2295 
2296 		if (f71882fg_fan_has_beep[data->type]) {
2297 			f71882fg_remove_sysfs_files(pdev,
2298 					fxxxx_fan_beep_attr, nr_fans);
2299 		}
2300 
2301 		switch (data->type) {
2302 		case f71808a:
2303 			f71882fg_remove_sysfs_files(pdev,
2304 				&fxxxx_auto_pwm_attr[0][0],
2305 				ARRAY_SIZE(fxxxx_auto_pwm_attr[0]) * nr_fans);
2306 			f71882fg_remove_sysfs_files(pdev,
2307 					f71808a_fan3_attr,
2308 					ARRAY_SIZE(f71808a_fan3_attr));
2309 			break;
2310 		case f71862fg:
2311 			f71882fg_remove_sysfs_files(pdev,
2312 				&f71862fg_auto_pwm_attr[0][0],
2313 				ARRAY_SIZE(f71862fg_auto_pwm_attr[0]) *
2314 					nr_fans);
2315 			break;
2316 		case f71808e:
2317 		case f71869:
2318 			f71882fg_remove_sysfs_files(pdev,
2319 				&f71869_auto_pwm_attr[0][0],
2320 				ARRAY_SIZE(f71869_auto_pwm_attr[0]) * nr_fans);
2321 			break;
2322 		case f8000:
2323 			f71882fg_remove_sysfs_files(pdev,
2324 					f8000_fan_attr,
2325 					ARRAY_SIZE(f8000_fan_attr));
2326 			f71882fg_remove_sysfs_files(pdev,
2327 				&f8000_auto_pwm_attr[0][0],
2328 				ARRAY_SIZE(f8000_auto_pwm_attr[0]) * nr_fans);
2329 			break;
2330 		default:
2331 			f71882fg_remove_sysfs_files(pdev,
2332 				&fxxxx_auto_pwm_attr[0][0],
2333 				ARRAY_SIZE(fxxxx_auto_pwm_attr[0]) * nr_fans);
2334 		}
2335 	}
2336 	return 0;
2337 }
2338 
f71882fg_probe(struct platform_device * pdev)2339 static int f71882fg_probe(struct platform_device *pdev)
2340 {
2341 	struct f71882fg_data *data;
2342 	struct f71882fg_sio_data *sio_data = dev_get_platdata(&pdev->dev);
2343 	int nr_fans = f71882fg_nr_fans[sio_data->type];
2344 	int nr_temps = f71882fg_nr_temps[sio_data->type];
2345 	int err, i;
2346 	int size;
2347 	u8 start_reg, reg;
2348 
2349 	data = devm_kzalloc(&pdev->dev, sizeof(struct f71882fg_data),
2350 			    GFP_KERNEL);
2351 	if (!data)
2352 		return -ENOMEM;
2353 
2354 	data->addr = platform_get_resource(pdev, IORESOURCE_IO, 0)->start;
2355 	data->type = sio_data->type;
2356 	data->temp_start =
2357 	    (data->type == f71858fg || data->type == f8000 ||
2358 		data->type == f81866a) ? 0 : 1;
2359 	mutex_init(&data->update_lock);
2360 	platform_set_drvdata(pdev, data);
2361 
2362 	start_reg = f71882fg_read8(data, F71882FG_REG_START);
2363 	if (start_reg & 0x04) {
2364 		dev_warn(&pdev->dev, "Hardware monitor is powered down\n");
2365 		return -ENODEV;
2366 	}
2367 	if (!(start_reg & 0x03)) {
2368 		dev_warn(&pdev->dev, "Hardware monitoring not activated\n");
2369 		return -ENODEV;
2370 	}
2371 
2372 	/* Register sysfs interface files */
2373 	err = device_create_file(&pdev->dev, &dev_attr_name);
2374 	if (err)
2375 		goto exit_unregister_sysfs;
2376 
2377 	if (start_reg & 0x01) {
2378 		switch (data->type) {
2379 		case f71858fg:
2380 			data->temp_config =
2381 				f71882fg_read8(data, F71882FG_REG_TEMP_CONFIG);
2382 			if (data->temp_config & 0x10)
2383 				/*
2384 				 * The f71858fg temperature alarms behave as
2385 				 * the f8000 alarms in this mode
2386 				 */
2387 				err = f71882fg_create_sysfs_files(pdev,
2388 					f8000_temp_attr,
2389 					ARRAY_SIZE(f8000_temp_attr));
2390 			else
2391 				err = f71882fg_create_sysfs_files(pdev,
2392 					f71858fg_temp_attr,
2393 					ARRAY_SIZE(f71858fg_temp_attr));
2394 			break;
2395 		case f8000:
2396 			err = f71882fg_create_sysfs_files(pdev,
2397 					f8000_temp_attr,
2398 					ARRAY_SIZE(f8000_temp_attr));
2399 			break;
2400 		case f81866a:
2401 			err = f71882fg_create_sysfs_files(pdev,
2402 					f71858fg_temp_attr,
2403 					ARRAY_SIZE(f71858fg_temp_attr));
2404 			break;
2405 		default:
2406 			err = f71882fg_create_sysfs_files(pdev,
2407 				&fxxxx_temp_attr[0][0],
2408 				ARRAY_SIZE(fxxxx_temp_attr[0]) * nr_temps);
2409 		}
2410 		if (err)
2411 			goto exit_unregister_sysfs;
2412 
2413 		if (f71882fg_temp_has_beep[data->type]) {
2414 			if (data->type == f81866a) {
2415 				size = ARRAY_SIZE(f81866_temp_beep_attr[0]);
2416 				err = f71882fg_create_sysfs_files(pdev,
2417 						&f81866_temp_beep_attr[0][0],
2418 						size * nr_temps);
2419 
2420 			} else {
2421 				size = ARRAY_SIZE(fxxxx_temp_beep_attr[0]);
2422 				err = f71882fg_create_sysfs_files(pdev,
2423 						&fxxxx_temp_beep_attr[0][0],
2424 						size * nr_temps);
2425 			}
2426 			if (err)
2427 				goto exit_unregister_sysfs;
2428 		}
2429 
2430 		for (i = 0; i < F71882FG_MAX_INS; i++) {
2431 			if (f71882fg_has_in[data->type][i]) {
2432 				err = device_create_file(&pdev->dev,
2433 						&fxxxx_in_attr[i].dev_attr);
2434 				if (err)
2435 					goto exit_unregister_sysfs;
2436 			}
2437 		}
2438 		if (f71882fg_has_in1_alarm[data->type]) {
2439 			err = f71882fg_create_sysfs_files(pdev,
2440 					fxxxx_in1_alarm_attr,
2441 					ARRAY_SIZE(fxxxx_in1_alarm_attr));
2442 			if (err)
2443 				goto exit_unregister_sysfs;
2444 		}
2445 	}
2446 
2447 	if (start_reg & 0x02) {
2448 		switch (data->type) {
2449 		case f71808e:
2450 		case f71808a:
2451 		case f71869:
2452 		case f71869a:
2453 			/* These always have signed auto point temps */
2454 			data->auto_point_temp_signed = 1;
2455 			fallthrough;	/* to select correct fan/pwm reg bank! */
2456 		case f71889fg:
2457 		case f71889ed:
2458 		case f71889a:
2459 			reg = f71882fg_read8(data, F71882FG_REG_FAN_FAULT_T);
2460 			if (reg & F71882FG_FAN_NEG_TEMP_EN)
2461 				data->auto_point_temp_signed = 1;
2462 			/* Ensure banked pwm registers point to right bank */
2463 			reg &= ~F71882FG_FAN_PROG_SEL;
2464 			f71882fg_write8(data, F71882FG_REG_FAN_FAULT_T, reg);
2465 			break;
2466 		default:
2467 			break;
2468 		}
2469 
2470 		data->pwm_enable =
2471 			f71882fg_read8(data, F71882FG_REG_PWM_ENABLE);
2472 
2473 		for (i = 0; i < nr_fans; i++) {
2474 			err = f71882fg_create_fan_sysfs_files(pdev, i);
2475 			if (err)
2476 				goto exit_unregister_sysfs;
2477 		}
2478 
2479 		/* Some types have 1 extra fan with limited functionality */
2480 		switch (data->type) {
2481 		case f71808a:
2482 			err = f71882fg_create_sysfs_files(pdev,
2483 					f71808a_fan3_attr,
2484 					ARRAY_SIZE(f71808a_fan3_attr));
2485 			break;
2486 		case f8000:
2487 			err = f71882fg_create_sysfs_files(pdev,
2488 					f8000_fan_attr,
2489 					ARRAY_SIZE(f8000_fan_attr));
2490 			break;
2491 		default:
2492 			break;
2493 		}
2494 		if (err)
2495 			goto exit_unregister_sysfs;
2496 	}
2497 
2498 	data->hwmon_dev = hwmon_device_register(&pdev->dev);
2499 	if (IS_ERR(data->hwmon_dev)) {
2500 		err = PTR_ERR(data->hwmon_dev);
2501 		data->hwmon_dev = NULL;
2502 		goto exit_unregister_sysfs;
2503 	}
2504 
2505 	return 0;
2506 
2507 exit_unregister_sysfs:
2508 	f71882fg_remove(pdev); /* Will unregister the sysfs files for us */
2509 	return err; /* f71882fg_remove() also frees our data */
2510 }
2511 
f71882fg_find(int sioaddr,struct f71882fg_sio_data * sio_data)2512 static int __init f71882fg_find(int sioaddr, struct f71882fg_sio_data *sio_data)
2513 {
2514 	u16 devid;
2515 	unsigned short address;
2516 	int err = superio_enter(sioaddr);
2517 	if (err)
2518 		return err;
2519 
2520 	devid = superio_inw(sioaddr, SIO_REG_MANID);
2521 	if (devid != SIO_FINTEK_ID) {
2522 		pr_debug("Not a Fintek device\n");
2523 		err = -ENODEV;
2524 		goto exit;
2525 	}
2526 
2527 	devid = force_id ? force_id : superio_inw(sioaddr, SIO_REG_DEVID);
2528 	switch (devid) {
2529 	case SIO_F71808E_ID:
2530 		sio_data->type = f71808e;
2531 		break;
2532 	case SIO_F71808A_ID:
2533 		sio_data->type = f71808a;
2534 		break;
2535 	case SIO_F71858_ID:
2536 	case SIO_F71858AD_ID:
2537 		sio_data->type = f71858fg;
2538 		break;
2539 	case SIO_F71862_ID:
2540 		sio_data->type = f71862fg;
2541 		break;
2542 	case SIO_F71868_ID:
2543 		sio_data->type = f71868a;
2544 		break;
2545 	case SIO_F71869_ID:
2546 		sio_data->type = f71869;
2547 		break;
2548 	case SIO_F71869A_ID:
2549 		sio_data->type = f71869a;
2550 		break;
2551 	case SIO_F71882_ID:
2552 		sio_data->type = f71882fg;
2553 		break;
2554 	case SIO_F71889_ID:
2555 		sio_data->type = f71889fg;
2556 		break;
2557 	case SIO_F71889E_ID:
2558 		sio_data->type = f71889ed;
2559 		break;
2560 	case SIO_F71889A_ID:
2561 		sio_data->type = f71889a;
2562 		break;
2563 	case SIO_F8000_ID:
2564 		sio_data->type = f8000;
2565 		break;
2566 	case SIO_F81768D_ID:
2567 		sio_data->type = f81768d;
2568 		break;
2569 	case SIO_F81865_ID:
2570 		sio_data->type = f81865f;
2571 		break;
2572 	case SIO_F81866_ID:
2573 	case SIO_F81966_ID:
2574 		sio_data->type = f81866a;
2575 		break;
2576 	default:
2577 		pr_info("Unsupported Fintek device: %04x\n",
2578 			(unsigned int)devid);
2579 		err = -ENODEV;
2580 		goto exit;
2581 	}
2582 
2583 	if (sio_data->type == f71858fg)
2584 		superio_select(sioaddr, SIO_F71858FG_LD_HWM);
2585 	else
2586 		superio_select(sioaddr, SIO_F71882FG_LD_HWM);
2587 
2588 	if (!(superio_inb(sioaddr, SIO_REG_ENABLE) & 0x01)) {
2589 		pr_warn("Device not activated\n");
2590 		err = -ENODEV;
2591 		goto exit;
2592 	}
2593 
2594 	address = superio_inw(sioaddr, SIO_REG_ADDR);
2595 	if (address == 0) {
2596 		pr_warn("Base address not set\n");
2597 		err = -ENODEV;
2598 		goto exit;
2599 	}
2600 	address &= ~(REGION_LENGTH - 1);	/* Ignore 3 LSB */
2601 
2602 	err = address;
2603 	pr_info("Found %s chip at %#x, revision %d\n",
2604 		f71882fg_names[sio_data->type],	(unsigned int)address,
2605 		(int)superio_inb(sioaddr, SIO_REG_DEVREV));
2606 exit:
2607 	superio_exit(sioaddr);
2608 	return err;
2609 }
2610 
f71882fg_device_add(int address,const struct f71882fg_sio_data * sio_data)2611 static int __init f71882fg_device_add(int address,
2612 				      const struct f71882fg_sio_data *sio_data)
2613 {
2614 	struct resource res = {
2615 		.start	= address,
2616 		.end	= address + REGION_LENGTH - 1,
2617 		.flags	= IORESOURCE_IO,
2618 	};
2619 	int err;
2620 
2621 	f71882fg_pdev = platform_device_alloc(DRVNAME, address);
2622 	if (!f71882fg_pdev)
2623 		return -ENOMEM;
2624 
2625 	res.name = f71882fg_pdev->name;
2626 	err = acpi_check_resource_conflict(&res);
2627 	if (err)
2628 		goto exit_device_put;
2629 
2630 	err = platform_device_add_resources(f71882fg_pdev, &res, 1);
2631 	if (err) {
2632 		pr_err("Device resource addition failed\n");
2633 		goto exit_device_put;
2634 	}
2635 
2636 	err = platform_device_add_data(f71882fg_pdev, sio_data,
2637 				       sizeof(struct f71882fg_sio_data));
2638 	if (err) {
2639 		pr_err("Platform data allocation failed\n");
2640 		goto exit_device_put;
2641 	}
2642 
2643 	err = platform_device_add(f71882fg_pdev);
2644 	if (err) {
2645 		pr_err("Device addition failed\n");
2646 		goto exit_device_put;
2647 	}
2648 
2649 	return 0;
2650 
2651 exit_device_put:
2652 	platform_device_put(f71882fg_pdev);
2653 
2654 	return err;
2655 }
2656 
2657 static struct platform_driver f71882fg_driver = {
2658 	.driver = {
2659 		.name	= DRVNAME,
2660 	},
2661 	.probe		= f71882fg_probe,
2662 	.remove		= f71882fg_remove,
2663 };
2664 
f71882fg_init(void)2665 static int __init f71882fg_init(void)
2666 {
2667 	int err;
2668 	int address;
2669 	struct f71882fg_sio_data sio_data;
2670 
2671 	memset(&sio_data, 0, sizeof(sio_data));
2672 
2673 	address = f71882fg_find(0x2e, &sio_data);
2674 	if (address < 0)
2675 		address = f71882fg_find(0x4e, &sio_data);
2676 	if (address < 0)
2677 		return address;
2678 
2679 	err = platform_driver_register(&f71882fg_driver);
2680 	if (err)
2681 		return err;
2682 
2683 	err = f71882fg_device_add(address, &sio_data);
2684 	if (err)
2685 		goto exit_driver;
2686 
2687 	return 0;
2688 
2689 exit_driver:
2690 	platform_driver_unregister(&f71882fg_driver);
2691 	return err;
2692 }
2693 
f71882fg_exit(void)2694 static void __exit f71882fg_exit(void)
2695 {
2696 	platform_device_unregister(f71882fg_pdev);
2697 	platform_driver_unregister(&f71882fg_driver);
2698 }
2699 
2700 MODULE_DESCRIPTION("F71882FG Hardware Monitoring Driver");
2701 MODULE_AUTHOR("Hans Edgington, Hans de Goede <hdegoede@redhat.com>");
2702 MODULE_LICENSE("GPL");
2703 
2704 module_init(f71882fg_init);
2705 module_exit(f71882fg_exit);
2706