1 /*
2  * dme1737.c - Driver for the SMSC DME1737, Asus A8000, SMSC SCH311x, SCH5027,
3  *             and SCH5127 Super-I/O chips integrated hardware monitoring
4  *             features.
5  * Copyright (c) 2007, 2008, 2009, 2010 Juerg Haefliger <juergh@gmail.com>
6  *
7  * This driver is an I2C/ISA hybrid, meaning that it uses the I2C bus to access
8  * the chip registers if a DME1737, A8000, or SCH5027 is found and the ISA bus
9  * if a SCH311x or SCH5127 chip is found. Both types of chips have very
10  * similar hardware monitoring capabilities but differ in the way they can be
11  * accessed.
12  *
13  * This program is free software; you can redistribute it and/or modify
14  * it under the terms of the GNU General Public License as published by
15  * the Free Software Foundation; either version 2 of the License, or
16  * (at your option) any later version.
17  *
18  * This program is distributed in the hope that it will be useful,
19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21  * GNU General Public License for more details.
22  *
23  * You should have received a copy of the GNU General Public License
24  * along with this program; if not, write to the Free Software
25  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26  */
27 
28 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
29 
30 #include <linux/module.h>
31 #include <linux/init.h>
32 #include <linux/slab.h>
33 #include <linux/jiffies.h>
34 #include <linux/i2c.h>
35 #include <linux/platform_device.h>
36 #include <linux/hwmon.h>
37 #include <linux/hwmon-sysfs.h>
38 #include <linux/hwmon-vid.h>
39 #include <linux/err.h>
40 #include <linux/mutex.h>
41 #include <linux/acpi.h>
42 #include <linux/io.h>
43 
44 /* ISA device, if found */
45 static struct platform_device *pdev;
46 
47 /* Module load parameters */
48 static bool force_start;
49 module_param(force_start, bool, 0);
50 MODULE_PARM_DESC(force_start, "Force the chip to start monitoring inputs");
51 
52 static unsigned short force_id;
53 module_param(force_id, ushort, 0);
54 MODULE_PARM_DESC(force_id, "Override the detected device ID");
55 
56 static bool probe_all_addr;
57 module_param(probe_all_addr, bool, 0);
58 MODULE_PARM_DESC(probe_all_addr,
59 		 "Include probing of non-standard LPC addresses");
60 
61 /* Addresses to scan */
62 static const unsigned short normal_i2c[] = {0x2c, 0x2d, 0x2e, I2C_CLIENT_END};
63 
64 enum chips { dme1737, sch5027, sch311x, sch5127 };
65 
66 #define	DO_REPORT "Please report to the driver maintainer."
67 
68 /* ---------------------------------------------------------------------
69  * Registers
70  *
71  * The sensors are defined as follows:
72  *
73  * Voltages                          Temperatures
74  * --------                          ------------
75  * in0   +5VTR (+5V stdby)           temp1   Remote diode 1
76  * in1   Vccp  (proc core)           temp2   Internal temp
77  * in2   VCC   (internal +3.3V)      temp3   Remote diode 2
78  * in3   +5V
79  * in4   +12V
80  * in5   VTR   (+3.3V stby)
81  * in6   Vbat
82  * in7   Vtrip (sch5127 only)
83  *
84  * --------------------------------------------------------------------- */
85 
86 /* Voltages (in) numbered 0-7 (ix) */
87 #define DME1737_REG_IN(ix)		((ix) < 5 ? 0x20 + (ix) : \
88 					 (ix) < 7 ? 0x94 + (ix) : \
89 						    0x1f)
90 #define DME1737_REG_IN_MIN(ix)		((ix) < 5 ? 0x44 + (ix) * 2 \
91 						  : 0x91 + (ix) * 2)
92 #define DME1737_REG_IN_MAX(ix)		((ix) < 5 ? 0x45 + (ix) * 2 \
93 						  : 0x92 + (ix) * 2)
94 
95 /* Temperatures (temp) numbered 0-2 (ix) */
96 #define DME1737_REG_TEMP(ix)		(0x25 + (ix))
97 #define DME1737_REG_TEMP_MIN(ix)	(0x4e + (ix) * 2)
98 #define DME1737_REG_TEMP_MAX(ix)	(0x4f + (ix) * 2)
99 #define DME1737_REG_TEMP_OFFSET(ix)	((ix) == 0 ? 0x1f \
100 						   : 0x1c + (ix))
101 
102 /*
103  * Voltage and temperature LSBs
104  * The LSBs (4 bits each) are stored in 5 registers with the following layouts:
105  *    IN_TEMP_LSB(0) = [in5, in6]
106  *    IN_TEMP_LSB(1) = [temp3, temp1]
107  *    IN_TEMP_LSB(2) = [in4, temp2]
108  *    IN_TEMP_LSB(3) = [in3, in0]
109  *    IN_TEMP_LSB(4) = [in2, in1]
110  *    IN_TEMP_LSB(5) = [res, in7]
111  */
112 #define DME1737_REG_IN_TEMP_LSB(ix)	(0x84 + (ix))
113 static const u8 DME1737_REG_IN_LSB[] = {3, 4, 4, 3, 2, 0, 0, 5};
114 static const u8 DME1737_REG_IN_LSB_SHL[] = {4, 4, 0, 0, 0, 0, 4, 4};
115 static const u8 DME1737_REG_TEMP_LSB[] = {1, 2, 1};
116 static const u8 DME1737_REG_TEMP_LSB_SHL[] = {4, 4, 0};
117 
118 /* Fans numbered 0-5 (ix) */
119 #define DME1737_REG_FAN(ix)		((ix) < 4 ? 0x28 + (ix) * 2 \
120 						  : 0xa1 + (ix) * 2)
121 #define DME1737_REG_FAN_MIN(ix)		((ix) < 4 ? 0x54 + (ix) * 2 \
122 						  : 0xa5 + (ix) * 2)
123 #define DME1737_REG_FAN_OPT(ix)		((ix) < 4 ? 0x90 + (ix) \
124 						  : 0xb2 + (ix))
125 #define DME1737_REG_FAN_MAX(ix)		(0xb4 + (ix)) /* only for fan[4-5] */
126 
127 /* PWMs numbered 0-2, 4-5 (ix) */
128 #define DME1737_REG_PWM(ix)		((ix) < 3 ? 0x30 + (ix) \
129 						  : 0xa1 + (ix))
130 #define DME1737_REG_PWM_CONFIG(ix)	(0x5c + (ix)) /* only for pwm[0-2] */
131 #define DME1737_REG_PWM_MIN(ix)		(0x64 + (ix)) /* only for pwm[0-2] */
132 #define DME1737_REG_PWM_FREQ(ix)	((ix) < 3 ? 0x5f + (ix) \
133 						  : 0xa3 + (ix))
134 /*
135  * The layout of the ramp rate registers is different from the other pwm
136  * registers. The bits for the 3 PWMs are stored in 2 registers:
137  *    PWM_RR(0) = [OFF3, OFF2,  OFF1,  RES,   RR1E, RR1-2, RR1-1, RR1-0]
138  *    PWM_RR(1) = [RR2E, RR2-2, RR2-1, RR2-0, RR3E, RR3-2, RR3-1, RR3-0]
139  */
140 #define DME1737_REG_PWM_RR(ix)		(0x62 + (ix)) /* only for pwm[0-2] */
141 
142 /* Thermal zones 0-2 */
143 #define DME1737_REG_ZONE_LOW(ix)	(0x67 + (ix))
144 #define DME1737_REG_ZONE_ABS(ix)	(0x6a + (ix))
145 /*
146  * The layout of the hysteresis registers is different from the other zone
147  * registers. The bits for the 3 zones are stored in 2 registers:
148  *    ZONE_HYST(0) = [H1-3,  H1-2,  H1-1, H1-0, H2-3, H2-2, H2-1, H2-0]
149  *    ZONE_HYST(1) = [H3-3,  H3-2,  H3-1, H3-0, RES,  RES,  RES,  RES]
150  */
151 #define DME1737_REG_ZONE_HYST(ix)	(0x6d + (ix))
152 
153 /*
154  * Alarm registers and bit mapping
155  * The 3 8-bit alarm registers will be concatenated to a single 32-bit
156  * alarm value [0, ALARM3, ALARM2, ALARM1].
157  */
158 #define DME1737_REG_ALARM1		0x41
159 #define DME1737_REG_ALARM2		0x42
160 #define DME1737_REG_ALARM3		0x83
161 static const u8 DME1737_BIT_ALARM_IN[] = {0, 1, 2, 3, 8, 16, 17, 18};
162 static const u8 DME1737_BIT_ALARM_TEMP[] = {4, 5, 6};
163 static const u8 DME1737_BIT_ALARM_FAN[] = {10, 11, 12, 13, 22, 23};
164 
165 /* Miscellaneous registers */
166 #define DME1737_REG_DEVICE		0x3d
167 #define DME1737_REG_COMPANY		0x3e
168 #define DME1737_REG_VERSTEP		0x3f
169 #define DME1737_REG_CONFIG		0x40
170 #define DME1737_REG_CONFIG2		0x7f
171 #define DME1737_REG_VID			0x43
172 #define DME1737_REG_TACH_PWM		0x81
173 
174 /* ---------------------------------------------------------------------
175  * Misc defines
176  * --------------------------------------------------------------------- */
177 
178 /* Chip identification */
179 #define DME1737_COMPANY_SMSC	0x5c
180 #define DME1737_VERSTEP		0x88
181 #define DME1737_VERSTEP_MASK	0xf8
182 #define SCH311X_DEVICE		0x8c
183 #define SCH5027_VERSTEP		0x69
184 #define SCH5127_DEVICE		0x8e
185 
186 /* Device ID values (global configuration register index 0x20) */
187 #define DME1737_ID_1	0x77
188 #define DME1737_ID_2	0x78
189 #define SCH3112_ID	0x7c
190 #define SCH3114_ID	0x7d
191 #define SCH3116_ID	0x7f
192 #define SCH5027_ID	0x89
193 #define SCH5127_ID	0x86
194 
195 /* Length of ISA address segment */
196 #define DME1737_EXTENT	2
197 
198 /* chip-dependent features */
199 #define HAS_TEMP_OFFSET		(1 << 0)		/* bit 0 */
200 #define HAS_VID			(1 << 1)		/* bit 1 */
201 #define HAS_ZONE3		(1 << 2)		/* bit 2 */
202 #define HAS_ZONE_HYST		(1 << 3)		/* bit 3 */
203 #define HAS_PWM_MIN		(1 << 4)		/* bit 4 */
204 #define HAS_FAN(ix)		(1 << ((ix) + 5))	/* bits 5-10 */
205 #define HAS_PWM(ix)		(1 << ((ix) + 11))	/* bits 11-16 */
206 #define HAS_IN7			(1 << 17)		/* bit 17 */
207 
208 /* ---------------------------------------------------------------------
209  * Data structures and manipulation thereof
210  * --------------------------------------------------------------------- */
211 
212 struct dme1737_data {
213 	struct i2c_client *client;	/* for I2C devices only */
214 	struct device *hwmon_dev;
215 	const char *name;
216 	unsigned int addr;		/* for ISA devices only */
217 
218 	struct mutex update_lock;
219 	int valid;			/* !=0 if following fields are valid */
220 	unsigned long last_update;	/* in jiffies */
221 	unsigned long last_vbat;	/* in jiffies */
222 	enum chips type;
223 	const int *in_nominal;		/* pointer to IN_NOMINAL array */
224 
225 	u8 vid;
226 	u8 pwm_rr_en;
227 	u32 has_features;
228 
229 	/* Register values */
230 	u16 in[8];
231 	u8  in_min[8];
232 	u8  in_max[8];
233 	s16 temp[3];
234 	s8  temp_min[3];
235 	s8  temp_max[3];
236 	s8  temp_offset[3];
237 	u8  config;
238 	u8  config2;
239 	u8  vrm;
240 	u16 fan[6];
241 	u16 fan_min[6];
242 	u8  fan_max[2];
243 	u8  fan_opt[6];
244 	u8  pwm[6];
245 	u8  pwm_min[3];
246 	u8  pwm_config[3];
247 	u8  pwm_acz[3];
248 	u8  pwm_freq[6];
249 	u8  pwm_rr[2];
250 	s8  zone_low[3];
251 	s8  zone_abs[3];
252 	u8  zone_hyst[2];
253 	u32 alarms;
254 };
255 
256 /* Nominal voltage values */
257 static const int IN_NOMINAL_DME1737[] = {5000, 2250, 3300, 5000, 12000, 3300,
258 					 3300};
259 static const int IN_NOMINAL_SCH311x[] = {2500, 1500, 3300, 5000, 12000, 3300,
260 					 3300};
261 static const int IN_NOMINAL_SCH5027[] = {5000, 2250, 3300, 1125, 1125, 3300,
262 					 3300};
263 static const int IN_NOMINAL_SCH5127[] = {2500, 2250, 3300, 1125, 1125, 3300,
264 					 3300, 1500};
265 #define IN_NOMINAL(type)	((type) == sch311x ? IN_NOMINAL_SCH311x : \
266 				 (type) == sch5027 ? IN_NOMINAL_SCH5027 : \
267 				 (type) == sch5127 ? IN_NOMINAL_SCH5127 : \
268 				 IN_NOMINAL_DME1737)
269 
270 /*
271  * Voltage input
272  * Voltage inputs have 16 bits resolution, limit values have 8 bits
273  * resolution.
274  */
IN_FROM_REG(int reg,int nominal,int res)275 static inline int IN_FROM_REG(int reg, int nominal, int res)
276 {
277 	return (reg * nominal + (3 << (res - 3))) / (3 << (res - 2));
278 }
279 
IN_TO_REG(long val,int nominal)280 static inline int IN_TO_REG(long val, int nominal)
281 {
282 	val = clamp_val(val, 0, 255 * nominal / 192);
283 	return DIV_ROUND_CLOSEST(val * 192, nominal);
284 }
285 
286 /*
287  * Temperature input
288  * The register values represent temperatures in 2's complement notation from
289  * -127 degrees C to +127 degrees C. Temp inputs have 16 bits resolution, limit
290  * values have 8 bits resolution.
291  */
TEMP_FROM_REG(int reg,int res)292 static inline int TEMP_FROM_REG(int reg, int res)
293 {
294 	return (reg * 1000) >> (res - 8);
295 }
296 
TEMP_TO_REG(long val)297 static inline int TEMP_TO_REG(long val)
298 {
299 	val = clamp_val(val, -128000, 127000);
300 	return DIV_ROUND_CLOSEST(val, 1000);
301 }
302 
303 /* Temperature range */
304 static const int TEMP_RANGE[] = {2000, 2500, 3333, 4000, 5000, 6666, 8000,
305 				 10000, 13333, 16000, 20000, 26666, 32000,
306 				 40000, 53333, 80000};
307 
TEMP_RANGE_FROM_REG(int reg)308 static inline int TEMP_RANGE_FROM_REG(int reg)
309 {
310 	return TEMP_RANGE[(reg >> 4) & 0x0f];
311 }
312 
TEMP_RANGE_TO_REG(long val,int reg)313 static int TEMP_RANGE_TO_REG(long val, int reg)
314 {
315 	int i;
316 
317 	for (i = 15; i > 0; i--) {
318 		if (val > (TEMP_RANGE[i] + TEMP_RANGE[i - 1] + 1) / 2)
319 			break;
320 	}
321 
322 	return (reg & 0x0f) | (i << 4);
323 }
324 
325 /*
326  * Temperature hysteresis
327  * Register layout:
328  *    reg[0] = [H1-3, H1-2, H1-1, H1-0, H2-3, H2-2, H2-1, H2-0]
329  *    reg[1] = [H3-3, H3-2, H3-1, H3-0, xxxx, xxxx, xxxx, xxxx]
330  */
TEMP_HYST_FROM_REG(int reg,int ix)331 static inline int TEMP_HYST_FROM_REG(int reg, int ix)
332 {
333 	return (((ix == 1) ? reg : reg >> 4) & 0x0f) * 1000;
334 }
335 
TEMP_HYST_TO_REG(int temp,long hyst,int ix,int reg)336 static inline int TEMP_HYST_TO_REG(int temp, long hyst, int ix, int reg)
337 {
338 	hyst = clamp_val(hyst, temp - 15000, temp);
339 	hyst = DIV_ROUND_CLOSEST(temp - hyst, 1000);
340 
341 	return (ix == 1) ? (reg & 0xf0) | hyst : (reg & 0x0f) | (hyst << 4);
342 }
343 
344 /* Fan input RPM */
FAN_FROM_REG(int reg,int tpc)345 static inline int FAN_FROM_REG(int reg, int tpc)
346 {
347 	if (tpc)
348 		return tpc * reg;
349 	else
350 		return (reg == 0 || reg == 0xffff) ? 0 : 90000 * 60 / reg;
351 }
352 
FAN_TO_REG(long val,int tpc)353 static inline int FAN_TO_REG(long val, int tpc)
354 {
355 	if (tpc) {
356 		return clamp_val(val / tpc, 0, 0xffff);
357 	} else {
358 		return (val <= 0) ? 0xffff :
359 			clamp_val(90000 * 60 / val, 0, 0xfffe);
360 	}
361 }
362 
363 /*
364  * Fan TPC (tach pulse count)
365  * Converts a register value to a TPC multiplier or returns 0 if the tachometer
366  * is configured in legacy (non-tpc) mode
367  */
FAN_TPC_FROM_REG(int reg)368 static inline int FAN_TPC_FROM_REG(int reg)
369 {
370 	return (reg & 0x20) ? 0 : 60 >> (reg & 0x03);
371 }
372 
373 /*
374  * Fan type
375  * The type of a fan is expressed in number of pulses-per-revolution that it
376  * emits
377  */
FAN_TYPE_FROM_REG(int reg)378 static inline int FAN_TYPE_FROM_REG(int reg)
379 {
380 	int edge = (reg >> 1) & 0x03;
381 
382 	return (edge > 0) ? 1 << (edge - 1) : 0;
383 }
384 
FAN_TYPE_TO_REG(long val,int reg)385 static inline int FAN_TYPE_TO_REG(long val, int reg)
386 {
387 	int edge = (val == 4) ? 3 : val;
388 
389 	return (reg & 0xf9) | (edge << 1);
390 }
391 
392 /* Fan max RPM */
393 static const int FAN_MAX[] = {0x54, 0x38, 0x2a, 0x21, 0x1c, 0x18, 0x15, 0x12,
394 			      0x11, 0x0f, 0x0e};
395 
FAN_MAX_FROM_REG(int reg)396 static int FAN_MAX_FROM_REG(int reg)
397 {
398 	int i;
399 
400 	for (i = 10; i > 0; i--) {
401 		if (reg == FAN_MAX[i])
402 			break;
403 	}
404 
405 	return 1000 + i * 500;
406 }
407 
FAN_MAX_TO_REG(long val)408 static int FAN_MAX_TO_REG(long val)
409 {
410 	int i;
411 
412 	for (i = 10; i > 0; i--) {
413 		if (val > (1000 + (i - 1) * 500))
414 			break;
415 	}
416 
417 	return FAN_MAX[i];
418 }
419 
420 /*
421  * PWM enable
422  * Register to enable mapping:
423  * 000:  2  fan on zone 1 auto
424  * 001:  2  fan on zone 2 auto
425  * 010:  2  fan on zone 3 auto
426  * 011:  0  fan full on
427  * 100: -1  fan disabled
428  * 101:  2  fan on hottest of zones 2,3 auto
429  * 110:  2  fan on hottest of zones 1,2,3 auto
430  * 111:  1  fan in manual mode
431  */
PWM_EN_FROM_REG(int reg)432 static inline int PWM_EN_FROM_REG(int reg)
433 {
434 	static const int en[] = {2, 2, 2, 0, -1, 2, 2, 1};
435 
436 	return en[(reg >> 5) & 0x07];
437 }
438 
PWM_EN_TO_REG(int val,int reg)439 static inline int PWM_EN_TO_REG(int val, int reg)
440 {
441 	int en = (val == 1) ? 7 : 3;
442 
443 	return (reg & 0x1f) | ((en & 0x07) << 5);
444 }
445 
446 /*
447  * PWM auto channels zone
448  * Register to auto channels zone mapping (ACZ is a bitfield with bit x
449  * corresponding to zone x+1):
450  * 000: 001  fan on zone 1 auto
451  * 001: 010  fan on zone 2 auto
452  * 010: 100  fan on zone 3 auto
453  * 011: 000  fan full on
454  * 100: 000  fan disabled
455  * 101: 110  fan on hottest of zones 2,3 auto
456  * 110: 111  fan on hottest of zones 1,2,3 auto
457  * 111: 000  fan in manual mode
458  */
PWM_ACZ_FROM_REG(int reg)459 static inline int PWM_ACZ_FROM_REG(int reg)
460 {
461 	static const int acz[] = {1, 2, 4, 0, 0, 6, 7, 0};
462 
463 	return acz[(reg >> 5) & 0x07];
464 }
465 
PWM_ACZ_TO_REG(long val,int reg)466 static inline int PWM_ACZ_TO_REG(long val, int reg)
467 {
468 	int acz = (val == 4) ? 2 : val - 1;
469 
470 	return (reg & 0x1f) | ((acz & 0x07) << 5);
471 }
472 
473 /* PWM frequency */
474 static const int PWM_FREQ[] = {11, 15, 22, 29, 35, 44, 59, 88,
475 			       15000, 20000, 30000, 25000, 0, 0, 0, 0};
476 
PWM_FREQ_FROM_REG(int reg)477 static inline int PWM_FREQ_FROM_REG(int reg)
478 {
479 	return PWM_FREQ[reg & 0x0f];
480 }
481 
PWM_FREQ_TO_REG(long val,int reg)482 static int PWM_FREQ_TO_REG(long val, int reg)
483 {
484 	int i;
485 
486 	/* the first two cases are special - stupid chip design! */
487 	if (val > 27500) {
488 		i = 10;
489 	} else if (val > 22500) {
490 		i = 11;
491 	} else {
492 		for (i = 9; i > 0; i--) {
493 			if (val > (PWM_FREQ[i] + PWM_FREQ[i - 1] + 1) / 2)
494 				break;
495 		}
496 	}
497 
498 	return (reg & 0xf0) | i;
499 }
500 
501 /*
502  * PWM ramp rate
503  * Register layout:
504  *    reg[0] = [OFF3,  OFF2,  OFF1,  RES,   RR1-E, RR1-2, RR1-1, RR1-0]
505  *    reg[1] = [RR2-E, RR2-2, RR2-1, RR2-0, RR3-E, RR3-2, RR3-1, RR3-0]
506  */
507 static const u8 PWM_RR[] = {206, 104, 69, 41, 26, 18, 10, 5};
508 
PWM_RR_FROM_REG(int reg,int ix)509 static inline int PWM_RR_FROM_REG(int reg, int ix)
510 {
511 	int rr = (ix == 1) ? reg >> 4 : reg;
512 
513 	return (rr & 0x08) ? PWM_RR[rr & 0x07] : 0;
514 }
515 
PWM_RR_TO_REG(long val,int ix,int reg)516 static int PWM_RR_TO_REG(long val, int ix, int reg)
517 {
518 	int i;
519 
520 	for (i = 0; i < 7; i++) {
521 		if (val > (PWM_RR[i] + PWM_RR[i + 1] + 1) / 2)
522 			break;
523 	}
524 
525 	return (ix == 1) ? (reg & 0x8f) | (i << 4) : (reg & 0xf8) | i;
526 }
527 
528 /* PWM ramp rate enable */
PWM_RR_EN_FROM_REG(int reg,int ix)529 static inline int PWM_RR_EN_FROM_REG(int reg, int ix)
530 {
531 	return PWM_RR_FROM_REG(reg, ix) ? 1 : 0;
532 }
533 
PWM_RR_EN_TO_REG(long val,int ix,int reg)534 static inline int PWM_RR_EN_TO_REG(long val, int ix, int reg)
535 {
536 	int en = (ix == 1) ? 0x80 : 0x08;
537 
538 	return val ? reg | en : reg & ~en;
539 }
540 
541 /*
542  * PWM min/off
543  * The PWM min/off bits are part of the PMW ramp rate register 0 (see above for
544  * the register layout).
545  */
PWM_OFF_FROM_REG(int reg,int ix)546 static inline int PWM_OFF_FROM_REG(int reg, int ix)
547 {
548 	return (reg >> (ix + 5)) & 0x01;
549 }
550 
PWM_OFF_TO_REG(int val,int ix,int reg)551 static inline int PWM_OFF_TO_REG(int val, int ix, int reg)
552 {
553 	return (reg & ~(1 << (ix + 5))) | ((val & 0x01) << (ix + 5));
554 }
555 
556 /* ---------------------------------------------------------------------
557  * Device I/O access
558  *
559  * ISA access is performed through an index/data register pair and needs to
560  * be protected by a mutex during runtime (not required for initialization).
561  * We use data->update_lock for this and need to ensure that we acquire it
562  * before calling dme1737_read or dme1737_write.
563  * --------------------------------------------------------------------- */
564 
dme1737_read(const struct dme1737_data * data,u8 reg)565 static u8 dme1737_read(const struct dme1737_data *data, u8 reg)
566 {
567 	struct i2c_client *client = data->client;
568 	s32 val;
569 
570 	if (client) { /* I2C device */
571 		val = i2c_smbus_read_byte_data(client, reg);
572 
573 		if (val < 0) {
574 			dev_warn(&client->dev,
575 				 "Read from register 0x%02x failed! %s\n",
576 				 reg, DO_REPORT);
577 		}
578 	} else { /* ISA device */
579 		outb(reg, data->addr);
580 		val = inb(data->addr + 1);
581 	}
582 
583 	return val;
584 }
585 
dme1737_write(const struct dme1737_data * data,u8 reg,u8 val)586 static s32 dme1737_write(const struct dme1737_data *data, u8 reg, u8 val)
587 {
588 	struct i2c_client *client = data->client;
589 	s32 res = 0;
590 
591 	if (client) { /* I2C device */
592 		res = i2c_smbus_write_byte_data(client, reg, val);
593 
594 		if (res < 0) {
595 			dev_warn(&client->dev,
596 				 "Write to register 0x%02x failed! %s\n",
597 				 reg, DO_REPORT);
598 		}
599 	} else { /* ISA device */
600 		outb(reg, data->addr);
601 		outb(val, data->addr + 1);
602 	}
603 
604 	return res;
605 }
606 
dme1737_update_device(struct device * dev)607 static struct dme1737_data *dme1737_update_device(struct device *dev)
608 {
609 	struct dme1737_data *data = dev_get_drvdata(dev);
610 	int ix;
611 	u8 lsb[6];
612 
613 	mutex_lock(&data->update_lock);
614 
615 	/* Enable a Vbat monitoring cycle every 10 mins */
616 	if (time_after(jiffies, data->last_vbat + 600 * HZ) || !data->valid) {
617 		dme1737_write(data, DME1737_REG_CONFIG, dme1737_read(data,
618 						DME1737_REG_CONFIG) | 0x10);
619 		data->last_vbat = jiffies;
620 	}
621 
622 	/* Sample register contents every 1 sec */
623 	if (time_after(jiffies, data->last_update + HZ) || !data->valid) {
624 		if (data->has_features & HAS_VID) {
625 			data->vid = dme1737_read(data, DME1737_REG_VID) &
626 				0x3f;
627 		}
628 
629 		/* In (voltage) registers */
630 		for (ix = 0; ix < ARRAY_SIZE(data->in); ix++) {
631 			/*
632 			 * Voltage inputs are stored as 16 bit values even
633 			 * though they have only 12 bits resolution. This is
634 			 * to make it consistent with the temp inputs.
635 			 */
636 			if (ix == 7 && !(data->has_features & HAS_IN7))
637 				continue;
638 			data->in[ix] = dme1737_read(data,
639 					DME1737_REG_IN(ix)) << 8;
640 			data->in_min[ix] = dme1737_read(data,
641 					DME1737_REG_IN_MIN(ix));
642 			data->in_max[ix] = dme1737_read(data,
643 					DME1737_REG_IN_MAX(ix));
644 		}
645 
646 		/* Temp registers */
647 		for (ix = 0; ix < ARRAY_SIZE(data->temp); ix++) {
648 			/*
649 			 * Temp inputs are stored as 16 bit values even
650 			 * though they have only 12 bits resolution. This is
651 			 * to take advantage of implicit conversions between
652 			 * register values (2's complement) and temp values
653 			 * (signed decimal).
654 			 */
655 			data->temp[ix] = dme1737_read(data,
656 					DME1737_REG_TEMP(ix)) << 8;
657 			data->temp_min[ix] = dme1737_read(data,
658 					DME1737_REG_TEMP_MIN(ix));
659 			data->temp_max[ix] = dme1737_read(data,
660 					DME1737_REG_TEMP_MAX(ix));
661 			if (data->has_features & HAS_TEMP_OFFSET) {
662 				data->temp_offset[ix] = dme1737_read(data,
663 						DME1737_REG_TEMP_OFFSET(ix));
664 			}
665 		}
666 
667 		/*
668 		 * In and temp LSB registers
669 		 * The LSBs are latched when the MSBs are read, so the order in
670 		 * which the registers are read (MSB first, then LSB) is
671 		 * important!
672 		 */
673 		for (ix = 0; ix < ARRAY_SIZE(lsb); ix++) {
674 			if (ix == 5 && !(data->has_features & HAS_IN7))
675 				continue;
676 			lsb[ix] = dme1737_read(data,
677 					DME1737_REG_IN_TEMP_LSB(ix));
678 		}
679 		for (ix = 0; ix < ARRAY_SIZE(data->in); ix++) {
680 			if (ix == 7 && !(data->has_features & HAS_IN7))
681 				continue;
682 			data->in[ix] |= (lsb[DME1737_REG_IN_LSB[ix]] <<
683 					DME1737_REG_IN_LSB_SHL[ix]) & 0xf0;
684 		}
685 		for (ix = 0; ix < ARRAY_SIZE(data->temp); ix++) {
686 			data->temp[ix] |= (lsb[DME1737_REG_TEMP_LSB[ix]] <<
687 					DME1737_REG_TEMP_LSB_SHL[ix]) & 0xf0;
688 		}
689 
690 		/* Fan registers */
691 		for (ix = 0; ix < ARRAY_SIZE(data->fan); ix++) {
692 			/*
693 			 * Skip reading registers if optional fans are not
694 			 * present
695 			 */
696 			if (!(data->has_features & HAS_FAN(ix)))
697 				continue;
698 			data->fan[ix] = dme1737_read(data,
699 					DME1737_REG_FAN(ix));
700 			data->fan[ix] |= dme1737_read(data,
701 					DME1737_REG_FAN(ix) + 1) << 8;
702 			data->fan_min[ix] = dme1737_read(data,
703 					DME1737_REG_FAN_MIN(ix));
704 			data->fan_min[ix] |= dme1737_read(data,
705 					DME1737_REG_FAN_MIN(ix) + 1) << 8;
706 			data->fan_opt[ix] = dme1737_read(data,
707 					DME1737_REG_FAN_OPT(ix));
708 			/* fan_max exists only for fan[5-6] */
709 			if (ix > 3) {
710 				data->fan_max[ix - 4] = dme1737_read(data,
711 					DME1737_REG_FAN_MAX(ix));
712 			}
713 		}
714 
715 		/* PWM registers */
716 		for (ix = 0; ix < ARRAY_SIZE(data->pwm); ix++) {
717 			/*
718 			 * Skip reading registers if optional PWMs are not
719 			 * present
720 			 */
721 			if (!(data->has_features & HAS_PWM(ix)))
722 				continue;
723 			data->pwm[ix] = dme1737_read(data,
724 					DME1737_REG_PWM(ix));
725 			data->pwm_freq[ix] = dme1737_read(data,
726 					DME1737_REG_PWM_FREQ(ix));
727 			/* pwm_config and pwm_min exist only for pwm[1-3] */
728 			if (ix < 3) {
729 				data->pwm_config[ix] = dme1737_read(data,
730 						DME1737_REG_PWM_CONFIG(ix));
731 				data->pwm_min[ix] = dme1737_read(data,
732 						DME1737_REG_PWM_MIN(ix));
733 			}
734 		}
735 		for (ix = 0; ix < ARRAY_SIZE(data->pwm_rr); ix++) {
736 			data->pwm_rr[ix] = dme1737_read(data,
737 						DME1737_REG_PWM_RR(ix));
738 		}
739 
740 		/* Thermal zone registers */
741 		for (ix = 0; ix < ARRAY_SIZE(data->zone_low); ix++) {
742 			/* Skip reading registers if zone3 is not present */
743 			if ((ix == 2) && !(data->has_features & HAS_ZONE3))
744 				continue;
745 			/* sch5127 zone2 registers are special */
746 			if ((ix == 1) && (data->type == sch5127)) {
747 				data->zone_low[1] = dme1737_read(data,
748 						DME1737_REG_ZONE_LOW(2));
749 				data->zone_abs[1] = dme1737_read(data,
750 						DME1737_REG_ZONE_ABS(2));
751 			} else {
752 				data->zone_low[ix] = dme1737_read(data,
753 						DME1737_REG_ZONE_LOW(ix));
754 				data->zone_abs[ix] = dme1737_read(data,
755 						DME1737_REG_ZONE_ABS(ix));
756 			}
757 		}
758 		if (data->has_features & HAS_ZONE_HYST) {
759 			for (ix = 0; ix < ARRAY_SIZE(data->zone_hyst); ix++) {
760 				data->zone_hyst[ix] = dme1737_read(data,
761 						DME1737_REG_ZONE_HYST(ix));
762 			}
763 		}
764 
765 		/* Alarm registers */
766 		data->alarms = dme1737_read(data,
767 						DME1737_REG_ALARM1);
768 		/*
769 		 * Bit 7 tells us if the other alarm registers are non-zero and
770 		 * therefore also need to be read
771 		 */
772 		if (data->alarms & 0x80) {
773 			data->alarms |= dme1737_read(data,
774 						DME1737_REG_ALARM2) << 8;
775 			data->alarms |= dme1737_read(data,
776 						DME1737_REG_ALARM3) << 16;
777 		}
778 
779 		/*
780 		 * The ISA chips require explicit clearing of alarm bits.
781 		 * Don't worry, an alarm will come back if the condition
782 		 * that causes it still exists
783 		 */
784 		if (!data->client) {
785 			if (data->alarms & 0xff0000)
786 				dme1737_write(data, DME1737_REG_ALARM3, 0xff);
787 			if (data->alarms & 0xff00)
788 				dme1737_write(data, DME1737_REG_ALARM2, 0xff);
789 			if (data->alarms & 0xff)
790 				dme1737_write(data, DME1737_REG_ALARM1, 0xff);
791 		}
792 
793 		data->last_update = jiffies;
794 		data->valid = 1;
795 	}
796 
797 	mutex_unlock(&data->update_lock);
798 
799 	return data;
800 }
801 
802 /* ---------------------------------------------------------------------
803  * Voltage sysfs attributes
804  * ix = [0-7]
805  * --------------------------------------------------------------------- */
806 
807 #define SYS_IN_INPUT	0
808 #define SYS_IN_MIN	1
809 #define SYS_IN_MAX	2
810 #define SYS_IN_ALARM	3
811 
show_in(struct device * dev,struct device_attribute * attr,char * buf)812 static ssize_t show_in(struct device *dev, struct device_attribute *attr,
813 		       char *buf)
814 {
815 	struct dme1737_data *data = dme1737_update_device(dev);
816 	struct sensor_device_attribute_2
817 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
818 	int ix = sensor_attr_2->index;
819 	int fn = sensor_attr_2->nr;
820 	int res;
821 
822 	switch (fn) {
823 	case SYS_IN_INPUT:
824 		res = IN_FROM_REG(data->in[ix], data->in_nominal[ix], 16);
825 		break;
826 	case SYS_IN_MIN:
827 		res = IN_FROM_REG(data->in_min[ix], data->in_nominal[ix], 8);
828 		break;
829 	case SYS_IN_MAX:
830 		res = IN_FROM_REG(data->in_max[ix], data->in_nominal[ix], 8);
831 		break;
832 	case SYS_IN_ALARM:
833 		res = (data->alarms >> DME1737_BIT_ALARM_IN[ix]) & 0x01;
834 		break;
835 	default:
836 		res = 0;
837 		dev_dbg(dev, "Unknown function %d.\n", fn);
838 	}
839 
840 	return sprintf(buf, "%d\n", res);
841 }
842 
set_in(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)843 static ssize_t set_in(struct device *dev, struct device_attribute *attr,
844 		      const char *buf, size_t count)
845 {
846 	struct dme1737_data *data = dev_get_drvdata(dev);
847 	struct sensor_device_attribute_2
848 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
849 	int ix = sensor_attr_2->index;
850 	int fn = sensor_attr_2->nr;
851 	long val;
852 	int err;
853 
854 	err = kstrtol(buf, 10, &val);
855 	if (err)
856 		return err;
857 
858 	mutex_lock(&data->update_lock);
859 	switch (fn) {
860 	case SYS_IN_MIN:
861 		data->in_min[ix] = IN_TO_REG(val, data->in_nominal[ix]);
862 		dme1737_write(data, DME1737_REG_IN_MIN(ix),
863 			      data->in_min[ix]);
864 		break;
865 	case SYS_IN_MAX:
866 		data->in_max[ix] = IN_TO_REG(val, data->in_nominal[ix]);
867 		dme1737_write(data, DME1737_REG_IN_MAX(ix),
868 			      data->in_max[ix]);
869 		break;
870 	default:
871 		dev_dbg(dev, "Unknown function %d.\n", fn);
872 	}
873 	mutex_unlock(&data->update_lock);
874 
875 	return count;
876 }
877 
878 /* ---------------------------------------------------------------------
879  * Temperature sysfs attributes
880  * ix = [0-2]
881  * --------------------------------------------------------------------- */
882 
883 #define SYS_TEMP_INPUT			0
884 #define SYS_TEMP_MIN			1
885 #define SYS_TEMP_MAX			2
886 #define SYS_TEMP_OFFSET			3
887 #define SYS_TEMP_ALARM			4
888 #define SYS_TEMP_FAULT			5
889 
show_temp(struct device * dev,struct device_attribute * attr,char * buf)890 static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
891 			 char *buf)
892 {
893 	struct dme1737_data *data = dme1737_update_device(dev);
894 	struct sensor_device_attribute_2
895 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
896 	int ix = sensor_attr_2->index;
897 	int fn = sensor_attr_2->nr;
898 	int res;
899 
900 	switch (fn) {
901 	case SYS_TEMP_INPUT:
902 		res = TEMP_FROM_REG(data->temp[ix], 16);
903 		break;
904 	case SYS_TEMP_MIN:
905 		res = TEMP_FROM_REG(data->temp_min[ix], 8);
906 		break;
907 	case SYS_TEMP_MAX:
908 		res = TEMP_FROM_REG(data->temp_max[ix], 8);
909 		break;
910 	case SYS_TEMP_OFFSET:
911 		res = TEMP_FROM_REG(data->temp_offset[ix], 8);
912 		break;
913 	case SYS_TEMP_ALARM:
914 		res = (data->alarms >> DME1737_BIT_ALARM_TEMP[ix]) & 0x01;
915 		break;
916 	case SYS_TEMP_FAULT:
917 		res = (((u16)data->temp[ix] & 0xff00) == 0x8000);
918 		break;
919 	default:
920 		res = 0;
921 		dev_dbg(dev, "Unknown function %d.\n", fn);
922 	}
923 
924 	return sprintf(buf, "%d\n", res);
925 }
926 
set_temp(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)927 static ssize_t set_temp(struct device *dev, struct device_attribute *attr,
928 			const char *buf, size_t count)
929 {
930 	struct dme1737_data *data = dev_get_drvdata(dev);
931 	struct sensor_device_attribute_2
932 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
933 	int ix = sensor_attr_2->index;
934 	int fn = sensor_attr_2->nr;
935 	long val;
936 	int err;
937 
938 	err = kstrtol(buf, 10, &val);
939 	if (err)
940 		return err;
941 
942 	mutex_lock(&data->update_lock);
943 	switch (fn) {
944 	case SYS_TEMP_MIN:
945 		data->temp_min[ix] = TEMP_TO_REG(val);
946 		dme1737_write(data, DME1737_REG_TEMP_MIN(ix),
947 			      data->temp_min[ix]);
948 		break;
949 	case SYS_TEMP_MAX:
950 		data->temp_max[ix] = TEMP_TO_REG(val);
951 		dme1737_write(data, DME1737_REG_TEMP_MAX(ix),
952 			      data->temp_max[ix]);
953 		break;
954 	case SYS_TEMP_OFFSET:
955 		data->temp_offset[ix] = TEMP_TO_REG(val);
956 		dme1737_write(data, DME1737_REG_TEMP_OFFSET(ix),
957 			      data->temp_offset[ix]);
958 		break;
959 	default:
960 		dev_dbg(dev, "Unknown function %d.\n", fn);
961 	}
962 	mutex_unlock(&data->update_lock);
963 
964 	return count;
965 }
966 
967 /* ---------------------------------------------------------------------
968  * Zone sysfs attributes
969  * ix = [0-2]
970  * --------------------------------------------------------------------- */
971 
972 #define SYS_ZONE_AUTO_CHANNELS_TEMP	0
973 #define SYS_ZONE_AUTO_POINT1_TEMP_HYST	1
974 #define SYS_ZONE_AUTO_POINT1_TEMP	2
975 #define SYS_ZONE_AUTO_POINT2_TEMP	3
976 #define SYS_ZONE_AUTO_POINT3_TEMP	4
977 
show_zone(struct device * dev,struct device_attribute * attr,char * buf)978 static ssize_t show_zone(struct device *dev, struct device_attribute *attr,
979 			 char *buf)
980 {
981 	struct dme1737_data *data = dme1737_update_device(dev);
982 	struct sensor_device_attribute_2
983 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
984 	int ix = sensor_attr_2->index;
985 	int fn = sensor_attr_2->nr;
986 	int res;
987 
988 	switch (fn) {
989 	case SYS_ZONE_AUTO_CHANNELS_TEMP:
990 		/* check config2 for non-standard temp-to-zone mapping */
991 		if ((ix == 1) && (data->config2 & 0x02))
992 			res = 4;
993 		else
994 			res = 1 << ix;
995 		break;
996 	case SYS_ZONE_AUTO_POINT1_TEMP_HYST:
997 		res = TEMP_FROM_REG(data->zone_low[ix], 8) -
998 		      TEMP_HYST_FROM_REG(data->zone_hyst[ix == 2], ix);
999 		break;
1000 	case SYS_ZONE_AUTO_POINT1_TEMP:
1001 		res = TEMP_FROM_REG(data->zone_low[ix], 8);
1002 		break;
1003 	case SYS_ZONE_AUTO_POINT2_TEMP:
1004 		/* pwm_freq holds the temp range bits in the upper nibble */
1005 		res = TEMP_FROM_REG(data->zone_low[ix], 8) +
1006 		      TEMP_RANGE_FROM_REG(data->pwm_freq[ix]);
1007 		break;
1008 	case SYS_ZONE_AUTO_POINT3_TEMP:
1009 		res = TEMP_FROM_REG(data->zone_abs[ix], 8);
1010 		break;
1011 	default:
1012 		res = 0;
1013 		dev_dbg(dev, "Unknown function %d.\n", fn);
1014 	}
1015 
1016 	return sprintf(buf, "%d\n", res);
1017 }
1018 
set_zone(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1019 static ssize_t set_zone(struct device *dev, struct device_attribute *attr,
1020 			const char *buf, size_t count)
1021 {
1022 	struct dme1737_data *data = dev_get_drvdata(dev);
1023 	struct sensor_device_attribute_2
1024 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
1025 	int ix = sensor_attr_2->index;
1026 	int fn = sensor_attr_2->nr;
1027 	long val;
1028 	int temp;
1029 	int err;
1030 	u8 reg;
1031 
1032 	err = kstrtol(buf, 10, &val);
1033 	if (err)
1034 		return err;
1035 
1036 	mutex_lock(&data->update_lock);
1037 	switch (fn) {
1038 	case SYS_ZONE_AUTO_POINT1_TEMP_HYST:
1039 		/* Refresh the cache */
1040 		data->zone_low[ix] = dme1737_read(data,
1041 						  DME1737_REG_ZONE_LOW(ix));
1042 		/* Modify the temp hyst value */
1043 		temp = TEMP_FROM_REG(data->zone_low[ix], 8);
1044 		reg = dme1737_read(data, DME1737_REG_ZONE_HYST(ix == 2));
1045 		data->zone_hyst[ix == 2] = TEMP_HYST_TO_REG(temp, val, ix, reg);
1046 		dme1737_write(data, DME1737_REG_ZONE_HYST(ix == 2),
1047 			      data->zone_hyst[ix == 2]);
1048 		break;
1049 	case SYS_ZONE_AUTO_POINT1_TEMP:
1050 		data->zone_low[ix] = TEMP_TO_REG(val);
1051 		dme1737_write(data, DME1737_REG_ZONE_LOW(ix),
1052 			      data->zone_low[ix]);
1053 		break;
1054 	case SYS_ZONE_AUTO_POINT2_TEMP:
1055 		/* Refresh the cache */
1056 		data->zone_low[ix] = dme1737_read(data,
1057 						  DME1737_REG_ZONE_LOW(ix));
1058 		/*
1059 		 * Modify the temp range value (which is stored in the upper
1060 		 * nibble of the pwm_freq register)
1061 		 */
1062 		temp = TEMP_FROM_REG(data->zone_low[ix], 8);
1063 		val = clamp_val(val, temp, temp + 80000);
1064 		reg = dme1737_read(data, DME1737_REG_PWM_FREQ(ix));
1065 		data->pwm_freq[ix] = TEMP_RANGE_TO_REG(val - temp, reg);
1066 		dme1737_write(data, DME1737_REG_PWM_FREQ(ix),
1067 			      data->pwm_freq[ix]);
1068 		break;
1069 	case SYS_ZONE_AUTO_POINT3_TEMP:
1070 		data->zone_abs[ix] = TEMP_TO_REG(val);
1071 		dme1737_write(data, DME1737_REG_ZONE_ABS(ix),
1072 			      data->zone_abs[ix]);
1073 		break;
1074 	default:
1075 		dev_dbg(dev, "Unknown function %d.\n", fn);
1076 	}
1077 	mutex_unlock(&data->update_lock);
1078 
1079 	return count;
1080 }
1081 
1082 /* ---------------------------------------------------------------------
1083  * Fan sysfs attributes
1084  * ix = [0-5]
1085  * --------------------------------------------------------------------- */
1086 
1087 #define SYS_FAN_INPUT	0
1088 #define SYS_FAN_MIN	1
1089 #define SYS_FAN_MAX	2
1090 #define SYS_FAN_ALARM	3
1091 #define SYS_FAN_TYPE	4
1092 
show_fan(struct device * dev,struct device_attribute * attr,char * buf)1093 static ssize_t show_fan(struct device *dev, struct device_attribute *attr,
1094 			char *buf)
1095 {
1096 	struct dme1737_data *data = dme1737_update_device(dev);
1097 	struct sensor_device_attribute_2
1098 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
1099 	int ix = sensor_attr_2->index;
1100 	int fn = sensor_attr_2->nr;
1101 	int res;
1102 
1103 	switch (fn) {
1104 	case SYS_FAN_INPUT:
1105 		res = FAN_FROM_REG(data->fan[ix],
1106 				   ix < 4 ? 0 :
1107 				   FAN_TPC_FROM_REG(data->fan_opt[ix]));
1108 		break;
1109 	case SYS_FAN_MIN:
1110 		res = FAN_FROM_REG(data->fan_min[ix],
1111 				   ix < 4 ? 0 :
1112 				   FAN_TPC_FROM_REG(data->fan_opt[ix]));
1113 		break;
1114 	case SYS_FAN_MAX:
1115 		/* only valid for fan[5-6] */
1116 		res = FAN_MAX_FROM_REG(data->fan_max[ix - 4]);
1117 		break;
1118 	case SYS_FAN_ALARM:
1119 		res = (data->alarms >> DME1737_BIT_ALARM_FAN[ix]) & 0x01;
1120 		break;
1121 	case SYS_FAN_TYPE:
1122 		/* only valid for fan[1-4] */
1123 		res = FAN_TYPE_FROM_REG(data->fan_opt[ix]);
1124 		break;
1125 	default:
1126 		res = 0;
1127 		dev_dbg(dev, "Unknown function %d.\n", fn);
1128 	}
1129 
1130 	return sprintf(buf, "%d\n", res);
1131 }
1132 
set_fan(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1133 static ssize_t set_fan(struct device *dev, struct device_attribute *attr,
1134 		       const char *buf, size_t count)
1135 {
1136 	struct dme1737_data *data = dev_get_drvdata(dev);
1137 	struct sensor_device_attribute_2
1138 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
1139 	int ix = sensor_attr_2->index;
1140 	int fn = sensor_attr_2->nr;
1141 	long val;
1142 	int err;
1143 
1144 	err = kstrtol(buf, 10, &val);
1145 	if (err)
1146 		return err;
1147 
1148 	mutex_lock(&data->update_lock);
1149 	switch (fn) {
1150 	case SYS_FAN_MIN:
1151 		if (ix < 4) {
1152 			data->fan_min[ix] = FAN_TO_REG(val, 0);
1153 		} else {
1154 			/* Refresh the cache */
1155 			data->fan_opt[ix] = dme1737_read(data,
1156 						DME1737_REG_FAN_OPT(ix));
1157 			/* Modify the fan min value */
1158 			data->fan_min[ix] = FAN_TO_REG(val,
1159 					FAN_TPC_FROM_REG(data->fan_opt[ix]));
1160 		}
1161 		dme1737_write(data, DME1737_REG_FAN_MIN(ix),
1162 			      data->fan_min[ix] & 0xff);
1163 		dme1737_write(data, DME1737_REG_FAN_MIN(ix) + 1,
1164 			      data->fan_min[ix] >> 8);
1165 		break;
1166 	case SYS_FAN_MAX:
1167 		/* Only valid for fan[5-6] */
1168 		data->fan_max[ix - 4] = FAN_MAX_TO_REG(val);
1169 		dme1737_write(data, DME1737_REG_FAN_MAX(ix),
1170 			      data->fan_max[ix - 4]);
1171 		break;
1172 	case SYS_FAN_TYPE:
1173 		/* Only valid for fan[1-4] */
1174 		if (!(val == 1 || val == 2 || val == 4)) {
1175 			count = -EINVAL;
1176 			dev_warn(dev,
1177 				 "Fan type value %ld not supported. Choose one of 1, 2, or 4.\n",
1178 				 val);
1179 			goto exit;
1180 		}
1181 		data->fan_opt[ix] = FAN_TYPE_TO_REG(val, dme1737_read(data,
1182 					DME1737_REG_FAN_OPT(ix)));
1183 		dme1737_write(data, DME1737_REG_FAN_OPT(ix),
1184 			      data->fan_opt[ix]);
1185 		break;
1186 	default:
1187 		dev_dbg(dev, "Unknown function %d.\n", fn);
1188 	}
1189 exit:
1190 	mutex_unlock(&data->update_lock);
1191 
1192 	return count;
1193 }
1194 
1195 /* ---------------------------------------------------------------------
1196  * PWM sysfs attributes
1197  * ix = [0-4]
1198  * --------------------------------------------------------------------- */
1199 
1200 #define SYS_PWM				0
1201 #define SYS_PWM_FREQ			1
1202 #define SYS_PWM_ENABLE			2
1203 #define SYS_PWM_RAMP_RATE		3
1204 #define SYS_PWM_AUTO_CHANNELS_ZONE	4
1205 #define SYS_PWM_AUTO_PWM_MIN		5
1206 #define SYS_PWM_AUTO_POINT1_PWM		6
1207 #define SYS_PWM_AUTO_POINT2_PWM		7
1208 
show_pwm(struct device * dev,struct device_attribute * attr,char * buf)1209 static ssize_t show_pwm(struct device *dev, struct device_attribute *attr,
1210 			char *buf)
1211 {
1212 	struct dme1737_data *data = dme1737_update_device(dev);
1213 	struct sensor_device_attribute_2
1214 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
1215 	int ix = sensor_attr_2->index;
1216 	int fn = sensor_attr_2->nr;
1217 	int res;
1218 
1219 	switch (fn) {
1220 	case SYS_PWM:
1221 		if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 0)
1222 			res = 255;
1223 		else
1224 			res = data->pwm[ix];
1225 		break;
1226 	case SYS_PWM_FREQ:
1227 		res = PWM_FREQ_FROM_REG(data->pwm_freq[ix]);
1228 		break;
1229 	case SYS_PWM_ENABLE:
1230 		if (ix >= 3)
1231 			res = 1; /* pwm[5-6] hard-wired to manual mode */
1232 		else
1233 			res = PWM_EN_FROM_REG(data->pwm_config[ix]);
1234 		break;
1235 	case SYS_PWM_RAMP_RATE:
1236 		/* Only valid for pwm[1-3] */
1237 		res = PWM_RR_FROM_REG(data->pwm_rr[ix > 0], ix);
1238 		break;
1239 	case SYS_PWM_AUTO_CHANNELS_ZONE:
1240 		/* Only valid for pwm[1-3] */
1241 		if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2)
1242 			res = PWM_ACZ_FROM_REG(data->pwm_config[ix]);
1243 		else
1244 			res = data->pwm_acz[ix];
1245 		break;
1246 	case SYS_PWM_AUTO_PWM_MIN:
1247 		/* Only valid for pwm[1-3] */
1248 		if (PWM_OFF_FROM_REG(data->pwm_rr[0], ix))
1249 			res = data->pwm_min[ix];
1250 		else
1251 			res = 0;
1252 		break;
1253 	case SYS_PWM_AUTO_POINT1_PWM:
1254 		/* Only valid for pwm[1-3] */
1255 		res = data->pwm_min[ix];
1256 		break;
1257 	case SYS_PWM_AUTO_POINT2_PWM:
1258 		/* Only valid for pwm[1-3] */
1259 		res = 255; /* hard-wired */
1260 		break;
1261 	default:
1262 		res = 0;
1263 		dev_dbg(dev, "Unknown function %d.\n", fn);
1264 	}
1265 
1266 	return sprintf(buf, "%d\n", res);
1267 }
1268 
1269 static struct attribute *dme1737_pwm_chmod_attr[];
1270 static void dme1737_chmod_file(struct device*, struct attribute*, umode_t);
1271 
set_pwm(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1272 static ssize_t set_pwm(struct device *dev, struct device_attribute *attr,
1273 		       const char *buf, size_t count)
1274 {
1275 	struct dme1737_data *data = dev_get_drvdata(dev);
1276 	struct sensor_device_attribute_2
1277 		*sensor_attr_2 = to_sensor_dev_attr_2(attr);
1278 	int ix = sensor_attr_2->index;
1279 	int fn = sensor_attr_2->nr;
1280 	long val;
1281 	int err;
1282 
1283 	err = kstrtol(buf, 10, &val);
1284 	if (err)
1285 		return err;
1286 
1287 	mutex_lock(&data->update_lock);
1288 	switch (fn) {
1289 	case SYS_PWM:
1290 		data->pwm[ix] = clamp_val(val, 0, 255);
1291 		dme1737_write(data, DME1737_REG_PWM(ix), data->pwm[ix]);
1292 		break;
1293 	case SYS_PWM_FREQ:
1294 		data->pwm_freq[ix] = PWM_FREQ_TO_REG(val, dme1737_read(data,
1295 						DME1737_REG_PWM_FREQ(ix)));
1296 		dme1737_write(data, DME1737_REG_PWM_FREQ(ix),
1297 			      data->pwm_freq[ix]);
1298 		break;
1299 	case SYS_PWM_ENABLE:
1300 		/* Only valid for pwm[1-3] */
1301 		if (val < 0 || val > 2) {
1302 			count = -EINVAL;
1303 			dev_warn(dev,
1304 				 "PWM enable %ld not supported. Choose one of 0, 1, or 2.\n",
1305 				 val);
1306 			goto exit;
1307 		}
1308 		/* Refresh the cache */
1309 		data->pwm_config[ix] = dme1737_read(data,
1310 						DME1737_REG_PWM_CONFIG(ix));
1311 		if (val == PWM_EN_FROM_REG(data->pwm_config[ix])) {
1312 			/* Bail out if no change */
1313 			goto exit;
1314 		}
1315 		/* Do some housekeeping if we are currently in auto mode */
1316 		if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
1317 			/* Save the current zone channel assignment */
1318 			data->pwm_acz[ix] = PWM_ACZ_FROM_REG(
1319 							data->pwm_config[ix]);
1320 			/* Save the current ramp rate state and disable it */
1321 			data->pwm_rr[ix > 0] = dme1737_read(data,
1322 						DME1737_REG_PWM_RR(ix > 0));
1323 			data->pwm_rr_en &= ~(1 << ix);
1324 			if (PWM_RR_EN_FROM_REG(data->pwm_rr[ix > 0], ix)) {
1325 				data->pwm_rr_en |= (1 << ix);
1326 				data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(0, ix,
1327 							data->pwm_rr[ix > 0]);
1328 				dme1737_write(data,
1329 					      DME1737_REG_PWM_RR(ix > 0),
1330 					      data->pwm_rr[ix > 0]);
1331 			}
1332 		}
1333 		/* Set the new PWM mode */
1334 		switch (val) {
1335 		case 0:
1336 			/* Change permissions of pwm[ix] to read-only */
1337 			dme1737_chmod_file(dev, dme1737_pwm_chmod_attr[ix],
1338 					   S_IRUGO);
1339 			/* Turn fan fully on */
1340 			data->pwm_config[ix] = PWM_EN_TO_REG(0,
1341 							data->pwm_config[ix]);
1342 			dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1343 				      data->pwm_config[ix]);
1344 			break;
1345 		case 1:
1346 			/* Turn on manual mode */
1347 			data->pwm_config[ix] = PWM_EN_TO_REG(1,
1348 							data->pwm_config[ix]);
1349 			dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1350 				      data->pwm_config[ix]);
1351 			/* Change permissions of pwm[ix] to read-writeable */
1352 			dme1737_chmod_file(dev, dme1737_pwm_chmod_attr[ix],
1353 					   S_IRUGO | S_IWUSR);
1354 			break;
1355 		case 2:
1356 			/* Change permissions of pwm[ix] to read-only */
1357 			dme1737_chmod_file(dev, dme1737_pwm_chmod_attr[ix],
1358 					   S_IRUGO);
1359 			/*
1360 			 * Turn on auto mode using the saved zone channel
1361 			 * assignment
1362 			 */
1363 			data->pwm_config[ix] = PWM_ACZ_TO_REG(
1364 							data->pwm_acz[ix],
1365 							data->pwm_config[ix]);
1366 			dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1367 				      data->pwm_config[ix]);
1368 			/* Enable PWM ramp rate if previously enabled */
1369 			if (data->pwm_rr_en & (1 << ix)) {
1370 				data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(1, ix,
1371 						dme1737_read(data,
1372 						DME1737_REG_PWM_RR(ix > 0)));
1373 				dme1737_write(data,
1374 					      DME1737_REG_PWM_RR(ix > 0),
1375 					      data->pwm_rr[ix > 0]);
1376 			}
1377 			break;
1378 		}
1379 		break;
1380 	case SYS_PWM_RAMP_RATE:
1381 		/* Only valid for pwm[1-3] */
1382 		/* Refresh the cache */
1383 		data->pwm_config[ix] = dme1737_read(data,
1384 						DME1737_REG_PWM_CONFIG(ix));
1385 		data->pwm_rr[ix > 0] = dme1737_read(data,
1386 						DME1737_REG_PWM_RR(ix > 0));
1387 		/* Set the ramp rate value */
1388 		if (val > 0) {
1389 			data->pwm_rr[ix > 0] = PWM_RR_TO_REG(val, ix,
1390 							data->pwm_rr[ix > 0]);
1391 		}
1392 		/*
1393 		 * Enable/disable the feature only if the associated PWM
1394 		 * output is in automatic mode.
1395 		 */
1396 		if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
1397 			data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(val > 0, ix,
1398 							data->pwm_rr[ix > 0]);
1399 		}
1400 		dme1737_write(data, DME1737_REG_PWM_RR(ix > 0),
1401 			      data->pwm_rr[ix > 0]);
1402 		break;
1403 	case SYS_PWM_AUTO_CHANNELS_ZONE:
1404 		/* Only valid for pwm[1-3] */
1405 		if (!(val == 1 || val == 2 || val == 4 ||
1406 		      val == 6 || val == 7)) {
1407 			count = -EINVAL;
1408 			dev_warn(dev,
1409 				 "PWM auto channels zone %ld not supported. Choose one of 1, 2, 4, 6, "
1410 				 "or 7.\n", val);
1411 			goto exit;
1412 		}
1413 		/* Refresh the cache */
1414 		data->pwm_config[ix] = dme1737_read(data,
1415 						DME1737_REG_PWM_CONFIG(ix));
1416 		if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
1417 			/*
1418 			 * PWM is already in auto mode so update the temp
1419 			 * channel assignment
1420 			 */
1421 			data->pwm_config[ix] = PWM_ACZ_TO_REG(val,
1422 						data->pwm_config[ix]);
1423 			dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1424 				      data->pwm_config[ix]);
1425 		} else {
1426 			/*
1427 			 * PWM is not in auto mode so we save the temp
1428 			 * channel assignment for later use
1429 			 */
1430 			data->pwm_acz[ix] = val;
1431 		}
1432 		break;
1433 	case SYS_PWM_AUTO_PWM_MIN:
1434 		/* Only valid for pwm[1-3] */
1435 		/* Refresh the cache */
1436 		data->pwm_min[ix] = dme1737_read(data,
1437 						DME1737_REG_PWM_MIN(ix));
1438 		/*
1439 		 * There are only 2 values supported for the auto_pwm_min
1440 		 * value: 0 or auto_point1_pwm. So if the temperature drops
1441 		 * below the auto_point1_temp_hyst value, the fan either turns
1442 		 * off or runs at auto_point1_pwm duty-cycle.
1443 		 */
1444 		if (val > ((data->pwm_min[ix] + 1) / 2)) {
1445 			data->pwm_rr[0] = PWM_OFF_TO_REG(1, ix,
1446 						dme1737_read(data,
1447 						DME1737_REG_PWM_RR(0)));
1448 		} else {
1449 			data->pwm_rr[0] = PWM_OFF_TO_REG(0, ix,
1450 						dme1737_read(data,
1451 						DME1737_REG_PWM_RR(0)));
1452 		}
1453 		dme1737_write(data, DME1737_REG_PWM_RR(0),
1454 			      data->pwm_rr[0]);
1455 		break;
1456 	case SYS_PWM_AUTO_POINT1_PWM:
1457 		/* Only valid for pwm[1-3] */
1458 		data->pwm_min[ix] = clamp_val(val, 0, 255);
1459 		dme1737_write(data, DME1737_REG_PWM_MIN(ix),
1460 			      data->pwm_min[ix]);
1461 		break;
1462 	default:
1463 		dev_dbg(dev, "Unknown function %d.\n", fn);
1464 	}
1465 exit:
1466 	mutex_unlock(&data->update_lock);
1467 
1468 	return count;
1469 }
1470 
1471 /* ---------------------------------------------------------------------
1472  * Miscellaneous sysfs attributes
1473  * --------------------------------------------------------------------- */
1474 
vrm_show(struct device * dev,struct device_attribute * attr,char * buf)1475 static ssize_t vrm_show(struct device *dev, struct device_attribute *attr,
1476 			char *buf)
1477 {
1478 	struct i2c_client *client = to_i2c_client(dev);
1479 	struct dme1737_data *data = i2c_get_clientdata(client);
1480 
1481 	return sprintf(buf, "%d\n", data->vrm);
1482 }
1483 
vrm_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1484 static ssize_t vrm_store(struct device *dev, struct device_attribute *attr,
1485 			 const char *buf, size_t count)
1486 {
1487 	struct dme1737_data *data = dev_get_drvdata(dev);
1488 	unsigned long val;
1489 	int err;
1490 
1491 	err = kstrtoul(buf, 10, &val);
1492 	if (err)
1493 		return err;
1494 
1495 	if (val > 255)
1496 		return -EINVAL;
1497 
1498 	data->vrm = val;
1499 	return count;
1500 }
1501 
cpu0_vid_show(struct device * dev,struct device_attribute * attr,char * buf)1502 static ssize_t cpu0_vid_show(struct device *dev,
1503 			     struct device_attribute *attr, char *buf)
1504 {
1505 	struct dme1737_data *data = dme1737_update_device(dev);
1506 
1507 	return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1508 }
1509 
name_show(struct device * dev,struct device_attribute * attr,char * buf)1510 static ssize_t name_show(struct device *dev, struct device_attribute *attr,
1511 			 char *buf)
1512 {
1513 	struct dme1737_data *data = dev_get_drvdata(dev);
1514 
1515 	return sprintf(buf, "%s\n", data->name);
1516 }
1517 
1518 /* ---------------------------------------------------------------------
1519  * Sysfs device attribute defines and structs
1520  * --------------------------------------------------------------------- */
1521 
1522 /* Voltages 0-7 */
1523 
1524 #define SENSOR_DEVICE_ATTR_IN(ix) \
1525 static SENSOR_DEVICE_ATTR_2(in##ix##_input, S_IRUGO, \
1526 	show_in, NULL, SYS_IN_INPUT, ix); \
1527 static SENSOR_DEVICE_ATTR_2(in##ix##_min, S_IRUGO | S_IWUSR, \
1528 	show_in, set_in, SYS_IN_MIN, ix); \
1529 static SENSOR_DEVICE_ATTR_2(in##ix##_max, S_IRUGO | S_IWUSR, \
1530 	show_in, set_in, SYS_IN_MAX, ix); \
1531 static SENSOR_DEVICE_ATTR_2(in##ix##_alarm, S_IRUGO, \
1532 	show_in, NULL, SYS_IN_ALARM, ix)
1533 
1534 SENSOR_DEVICE_ATTR_IN(0);
1535 SENSOR_DEVICE_ATTR_IN(1);
1536 SENSOR_DEVICE_ATTR_IN(2);
1537 SENSOR_DEVICE_ATTR_IN(3);
1538 SENSOR_DEVICE_ATTR_IN(4);
1539 SENSOR_DEVICE_ATTR_IN(5);
1540 SENSOR_DEVICE_ATTR_IN(6);
1541 SENSOR_DEVICE_ATTR_IN(7);
1542 
1543 /* Temperatures 1-3 */
1544 
1545 #define SENSOR_DEVICE_ATTR_TEMP(ix) \
1546 static SENSOR_DEVICE_ATTR_2(temp##ix##_input, S_IRUGO, \
1547 	show_temp, NULL, SYS_TEMP_INPUT, ix-1); \
1548 static SENSOR_DEVICE_ATTR_2(temp##ix##_min, S_IRUGO | S_IWUSR, \
1549 	show_temp, set_temp, SYS_TEMP_MIN, ix-1); \
1550 static SENSOR_DEVICE_ATTR_2(temp##ix##_max, S_IRUGO | S_IWUSR, \
1551 	show_temp, set_temp, SYS_TEMP_MAX, ix-1); \
1552 static SENSOR_DEVICE_ATTR_2(temp##ix##_offset, S_IRUGO, \
1553 	show_temp, set_temp, SYS_TEMP_OFFSET, ix-1); \
1554 static SENSOR_DEVICE_ATTR_2(temp##ix##_alarm, S_IRUGO, \
1555 	show_temp, NULL, SYS_TEMP_ALARM, ix-1); \
1556 static SENSOR_DEVICE_ATTR_2(temp##ix##_fault, S_IRUGO, \
1557 	show_temp, NULL, SYS_TEMP_FAULT, ix-1)
1558 
1559 SENSOR_DEVICE_ATTR_TEMP(1);
1560 SENSOR_DEVICE_ATTR_TEMP(2);
1561 SENSOR_DEVICE_ATTR_TEMP(3);
1562 
1563 /* Zones 1-3 */
1564 
1565 #define SENSOR_DEVICE_ATTR_ZONE(ix) \
1566 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_channels_temp, S_IRUGO, \
1567 	show_zone, NULL, SYS_ZONE_AUTO_CHANNELS_TEMP, ix-1); \
1568 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point1_temp_hyst, S_IRUGO, \
1569 	show_zone, set_zone, SYS_ZONE_AUTO_POINT1_TEMP_HYST, ix-1); \
1570 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point1_temp, S_IRUGO, \
1571 	show_zone, set_zone, SYS_ZONE_AUTO_POINT1_TEMP, ix-1); \
1572 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point2_temp, S_IRUGO, \
1573 	show_zone, set_zone, SYS_ZONE_AUTO_POINT2_TEMP, ix-1); \
1574 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point3_temp, S_IRUGO, \
1575 	show_zone, set_zone, SYS_ZONE_AUTO_POINT3_TEMP, ix-1)
1576 
1577 SENSOR_DEVICE_ATTR_ZONE(1);
1578 SENSOR_DEVICE_ATTR_ZONE(2);
1579 SENSOR_DEVICE_ATTR_ZONE(3);
1580 
1581 /* Fans 1-4 */
1582 
1583 #define SENSOR_DEVICE_ATTR_FAN_1TO4(ix) \
1584 static SENSOR_DEVICE_ATTR_2(fan##ix##_input, S_IRUGO, \
1585 	show_fan, NULL, SYS_FAN_INPUT, ix-1); \
1586 static SENSOR_DEVICE_ATTR_2(fan##ix##_min, S_IRUGO | S_IWUSR, \
1587 	show_fan, set_fan, SYS_FAN_MIN, ix-1); \
1588 static SENSOR_DEVICE_ATTR_2(fan##ix##_alarm, S_IRUGO, \
1589 	show_fan, NULL, SYS_FAN_ALARM, ix-1); \
1590 static SENSOR_DEVICE_ATTR_2(fan##ix##_type, S_IRUGO | S_IWUSR, \
1591 	show_fan, set_fan, SYS_FAN_TYPE, ix-1)
1592 
1593 SENSOR_DEVICE_ATTR_FAN_1TO4(1);
1594 SENSOR_DEVICE_ATTR_FAN_1TO4(2);
1595 SENSOR_DEVICE_ATTR_FAN_1TO4(3);
1596 SENSOR_DEVICE_ATTR_FAN_1TO4(4);
1597 
1598 /* Fans 5-6 */
1599 
1600 #define SENSOR_DEVICE_ATTR_FAN_5TO6(ix) \
1601 static SENSOR_DEVICE_ATTR_2(fan##ix##_input, S_IRUGO, \
1602 	show_fan, NULL, SYS_FAN_INPUT, ix-1); \
1603 static SENSOR_DEVICE_ATTR_2(fan##ix##_min, S_IRUGO | S_IWUSR, \
1604 	show_fan, set_fan, SYS_FAN_MIN, ix-1); \
1605 static SENSOR_DEVICE_ATTR_2(fan##ix##_alarm, S_IRUGO, \
1606 	show_fan, NULL, SYS_FAN_ALARM, ix-1); \
1607 static SENSOR_DEVICE_ATTR_2(fan##ix##_max, S_IRUGO | S_IWUSR, \
1608 	show_fan, set_fan, SYS_FAN_MAX, ix-1)
1609 
1610 SENSOR_DEVICE_ATTR_FAN_5TO6(5);
1611 SENSOR_DEVICE_ATTR_FAN_5TO6(6);
1612 
1613 /* PWMs 1-3 */
1614 
1615 #define SENSOR_DEVICE_ATTR_PWM_1TO3(ix) \
1616 static SENSOR_DEVICE_ATTR_2(pwm##ix, S_IRUGO, \
1617 	show_pwm, set_pwm, SYS_PWM, ix-1); \
1618 static SENSOR_DEVICE_ATTR_2(pwm##ix##_freq, S_IRUGO, \
1619 	show_pwm, set_pwm, SYS_PWM_FREQ, ix-1); \
1620 static SENSOR_DEVICE_ATTR_2(pwm##ix##_enable, S_IRUGO, \
1621 	show_pwm, set_pwm, SYS_PWM_ENABLE, ix-1); \
1622 static SENSOR_DEVICE_ATTR_2(pwm##ix##_ramp_rate, S_IRUGO, \
1623 	show_pwm, set_pwm, SYS_PWM_RAMP_RATE, ix-1); \
1624 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_channels_zone, S_IRUGO, \
1625 	show_pwm, set_pwm, SYS_PWM_AUTO_CHANNELS_ZONE, ix-1); \
1626 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_pwm_min, S_IRUGO, \
1627 	show_pwm, set_pwm, SYS_PWM_AUTO_PWM_MIN, ix-1); \
1628 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_point1_pwm, S_IRUGO, \
1629 	show_pwm, set_pwm, SYS_PWM_AUTO_POINT1_PWM, ix-1); \
1630 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_point2_pwm, S_IRUGO, \
1631 	show_pwm, NULL, SYS_PWM_AUTO_POINT2_PWM, ix-1)
1632 
1633 SENSOR_DEVICE_ATTR_PWM_1TO3(1);
1634 SENSOR_DEVICE_ATTR_PWM_1TO3(2);
1635 SENSOR_DEVICE_ATTR_PWM_1TO3(3);
1636 
1637 /* PWMs 5-6 */
1638 
1639 #define SENSOR_DEVICE_ATTR_PWM_5TO6(ix) \
1640 static SENSOR_DEVICE_ATTR_2(pwm##ix, S_IRUGO, \
1641 	show_pwm, set_pwm, SYS_PWM, ix-1); \
1642 static SENSOR_DEVICE_ATTR_2(pwm##ix##_freq, S_IRUGO, \
1643 	show_pwm, set_pwm, SYS_PWM_FREQ, ix-1); \
1644 static SENSOR_DEVICE_ATTR_2(pwm##ix##_enable, S_IRUGO, \
1645 	show_pwm, NULL, SYS_PWM_ENABLE, ix-1)
1646 
1647 SENSOR_DEVICE_ATTR_PWM_5TO6(5);
1648 SENSOR_DEVICE_ATTR_PWM_5TO6(6);
1649 
1650 /* Misc */
1651 
1652 static DEVICE_ATTR_RW(vrm);
1653 static DEVICE_ATTR_RO(cpu0_vid);
1654 static DEVICE_ATTR_RO(name);   /* for ISA devices */
1655 
1656 /*
1657  * This struct holds all the attributes that are always present and need to be
1658  * created unconditionally. The attributes that need modification of their
1659  * permissions are created read-only and write permissions are added or removed
1660  * on the fly when required
1661  */
1662 static struct attribute *dme1737_attr[] = {
1663 	/* Voltages */
1664 	&sensor_dev_attr_in0_input.dev_attr.attr,
1665 	&sensor_dev_attr_in0_min.dev_attr.attr,
1666 	&sensor_dev_attr_in0_max.dev_attr.attr,
1667 	&sensor_dev_attr_in0_alarm.dev_attr.attr,
1668 	&sensor_dev_attr_in1_input.dev_attr.attr,
1669 	&sensor_dev_attr_in1_min.dev_attr.attr,
1670 	&sensor_dev_attr_in1_max.dev_attr.attr,
1671 	&sensor_dev_attr_in1_alarm.dev_attr.attr,
1672 	&sensor_dev_attr_in2_input.dev_attr.attr,
1673 	&sensor_dev_attr_in2_min.dev_attr.attr,
1674 	&sensor_dev_attr_in2_max.dev_attr.attr,
1675 	&sensor_dev_attr_in2_alarm.dev_attr.attr,
1676 	&sensor_dev_attr_in3_input.dev_attr.attr,
1677 	&sensor_dev_attr_in3_min.dev_attr.attr,
1678 	&sensor_dev_attr_in3_max.dev_attr.attr,
1679 	&sensor_dev_attr_in3_alarm.dev_attr.attr,
1680 	&sensor_dev_attr_in4_input.dev_attr.attr,
1681 	&sensor_dev_attr_in4_min.dev_attr.attr,
1682 	&sensor_dev_attr_in4_max.dev_attr.attr,
1683 	&sensor_dev_attr_in4_alarm.dev_attr.attr,
1684 	&sensor_dev_attr_in5_input.dev_attr.attr,
1685 	&sensor_dev_attr_in5_min.dev_attr.attr,
1686 	&sensor_dev_attr_in5_max.dev_attr.attr,
1687 	&sensor_dev_attr_in5_alarm.dev_attr.attr,
1688 	&sensor_dev_attr_in6_input.dev_attr.attr,
1689 	&sensor_dev_attr_in6_min.dev_attr.attr,
1690 	&sensor_dev_attr_in6_max.dev_attr.attr,
1691 	&sensor_dev_attr_in6_alarm.dev_attr.attr,
1692 	/* Temperatures */
1693 	&sensor_dev_attr_temp1_input.dev_attr.attr,
1694 	&sensor_dev_attr_temp1_min.dev_attr.attr,
1695 	&sensor_dev_attr_temp1_max.dev_attr.attr,
1696 	&sensor_dev_attr_temp1_alarm.dev_attr.attr,
1697 	&sensor_dev_attr_temp1_fault.dev_attr.attr,
1698 	&sensor_dev_attr_temp2_input.dev_attr.attr,
1699 	&sensor_dev_attr_temp2_min.dev_attr.attr,
1700 	&sensor_dev_attr_temp2_max.dev_attr.attr,
1701 	&sensor_dev_attr_temp2_alarm.dev_attr.attr,
1702 	&sensor_dev_attr_temp2_fault.dev_attr.attr,
1703 	&sensor_dev_attr_temp3_input.dev_attr.attr,
1704 	&sensor_dev_attr_temp3_min.dev_attr.attr,
1705 	&sensor_dev_attr_temp3_max.dev_attr.attr,
1706 	&sensor_dev_attr_temp3_alarm.dev_attr.attr,
1707 	&sensor_dev_attr_temp3_fault.dev_attr.attr,
1708 	/* Zones */
1709 	&sensor_dev_attr_zone1_auto_point1_temp.dev_attr.attr,
1710 	&sensor_dev_attr_zone1_auto_point2_temp.dev_attr.attr,
1711 	&sensor_dev_attr_zone1_auto_point3_temp.dev_attr.attr,
1712 	&sensor_dev_attr_zone1_auto_channels_temp.dev_attr.attr,
1713 	&sensor_dev_attr_zone2_auto_point1_temp.dev_attr.attr,
1714 	&sensor_dev_attr_zone2_auto_point2_temp.dev_attr.attr,
1715 	&sensor_dev_attr_zone2_auto_point3_temp.dev_attr.attr,
1716 	&sensor_dev_attr_zone2_auto_channels_temp.dev_attr.attr,
1717 	NULL
1718 };
1719 
1720 static const struct attribute_group dme1737_group = {
1721 	.attrs = dme1737_attr,
1722 };
1723 
1724 /*
1725  * The following struct holds temp offset attributes, which are not available
1726  * in all chips. The following chips support them:
1727  * DME1737, SCH311x
1728  */
1729 static struct attribute *dme1737_temp_offset_attr[] = {
1730 	&sensor_dev_attr_temp1_offset.dev_attr.attr,
1731 	&sensor_dev_attr_temp2_offset.dev_attr.attr,
1732 	&sensor_dev_attr_temp3_offset.dev_attr.attr,
1733 	NULL
1734 };
1735 
1736 static const struct attribute_group dme1737_temp_offset_group = {
1737 	.attrs = dme1737_temp_offset_attr,
1738 };
1739 
1740 /*
1741  * The following struct holds VID related attributes, which are not available
1742  * in all chips. The following chips support them:
1743  * DME1737
1744  */
1745 static struct attribute *dme1737_vid_attr[] = {
1746 	&dev_attr_vrm.attr,
1747 	&dev_attr_cpu0_vid.attr,
1748 	NULL
1749 };
1750 
1751 static const struct attribute_group dme1737_vid_group = {
1752 	.attrs = dme1737_vid_attr,
1753 };
1754 
1755 /*
1756  * The following struct holds temp zone 3 related attributes, which are not
1757  * available in all chips. The following chips support them:
1758  * DME1737, SCH311x, SCH5027
1759  */
1760 static struct attribute *dme1737_zone3_attr[] = {
1761 	&sensor_dev_attr_zone3_auto_point1_temp.dev_attr.attr,
1762 	&sensor_dev_attr_zone3_auto_point2_temp.dev_attr.attr,
1763 	&sensor_dev_attr_zone3_auto_point3_temp.dev_attr.attr,
1764 	&sensor_dev_attr_zone3_auto_channels_temp.dev_attr.attr,
1765 	NULL
1766 };
1767 
1768 static const struct attribute_group dme1737_zone3_group = {
1769 	.attrs = dme1737_zone3_attr,
1770 };
1771 
1772 
1773 /*
1774  * The following struct holds temp zone hysteresis related attributes, which
1775  * are not available in all chips. The following chips support them:
1776  * DME1737, SCH311x
1777  */
1778 static struct attribute *dme1737_zone_hyst_attr[] = {
1779 	&sensor_dev_attr_zone1_auto_point1_temp_hyst.dev_attr.attr,
1780 	&sensor_dev_attr_zone2_auto_point1_temp_hyst.dev_attr.attr,
1781 	&sensor_dev_attr_zone3_auto_point1_temp_hyst.dev_attr.attr,
1782 	NULL
1783 };
1784 
1785 static const struct attribute_group dme1737_zone_hyst_group = {
1786 	.attrs = dme1737_zone_hyst_attr,
1787 };
1788 
1789 /*
1790  * The following struct holds voltage in7 related attributes, which
1791  * are not available in all chips. The following chips support them:
1792  * SCH5127
1793  */
1794 static struct attribute *dme1737_in7_attr[] = {
1795 	&sensor_dev_attr_in7_input.dev_attr.attr,
1796 	&sensor_dev_attr_in7_min.dev_attr.attr,
1797 	&sensor_dev_attr_in7_max.dev_attr.attr,
1798 	&sensor_dev_attr_in7_alarm.dev_attr.attr,
1799 	NULL
1800 };
1801 
1802 static const struct attribute_group dme1737_in7_group = {
1803 	.attrs = dme1737_in7_attr,
1804 };
1805 
1806 /*
1807  * The following structs hold the PWM attributes, some of which are optional.
1808  * Their creation depends on the chip configuration which is determined during
1809  * module load.
1810  */
1811 static struct attribute *dme1737_pwm1_attr[] = {
1812 	&sensor_dev_attr_pwm1.dev_attr.attr,
1813 	&sensor_dev_attr_pwm1_freq.dev_attr.attr,
1814 	&sensor_dev_attr_pwm1_enable.dev_attr.attr,
1815 	&sensor_dev_attr_pwm1_ramp_rate.dev_attr.attr,
1816 	&sensor_dev_attr_pwm1_auto_channels_zone.dev_attr.attr,
1817 	&sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
1818 	&sensor_dev_attr_pwm1_auto_point2_pwm.dev_attr.attr,
1819 	NULL
1820 };
1821 static struct attribute *dme1737_pwm2_attr[] = {
1822 	&sensor_dev_attr_pwm2.dev_attr.attr,
1823 	&sensor_dev_attr_pwm2_freq.dev_attr.attr,
1824 	&sensor_dev_attr_pwm2_enable.dev_attr.attr,
1825 	&sensor_dev_attr_pwm2_ramp_rate.dev_attr.attr,
1826 	&sensor_dev_attr_pwm2_auto_channels_zone.dev_attr.attr,
1827 	&sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
1828 	&sensor_dev_attr_pwm2_auto_point2_pwm.dev_attr.attr,
1829 	NULL
1830 };
1831 static struct attribute *dme1737_pwm3_attr[] = {
1832 	&sensor_dev_attr_pwm3.dev_attr.attr,
1833 	&sensor_dev_attr_pwm3_freq.dev_attr.attr,
1834 	&sensor_dev_attr_pwm3_enable.dev_attr.attr,
1835 	&sensor_dev_attr_pwm3_ramp_rate.dev_attr.attr,
1836 	&sensor_dev_attr_pwm3_auto_channels_zone.dev_attr.attr,
1837 	&sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
1838 	&sensor_dev_attr_pwm3_auto_point2_pwm.dev_attr.attr,
1839 	NULL
1840 };
1841 static struct attribute *dme1737_pwm5_attr[] = {
1842 	&sensor_dev_attr_pwm5.dev_attr.attr,
1843 	&sensor_dev_attr_pwm5_freq.dev_attr.attr,
1844 	&sensor_dev_attr_pwm5_enable.dev_attr.attr,
1845 	NULL
1846 };
1847 static struct attribute *dme1737_pwm6_attr[] = {
1848 	&sensor_dev_attr_pwm6.dev_attr.attr,
1849 	&sensor_dev_attr_pwm6_freq.dev_attr.attr,
1850 	&sensor_dev_attr_pwm6_enable.dev_attr.attr,
1851 	NULL
1852 };
1853 
1854 static const struct attribute_group dme1737_pwm_group[] = {
1855 	{ .attrs = dme1737_pwm1_attr },
1856 	{ .attrs = dme1737_pwm2_attr },
1857 	{ .attrs = dme1737_pwm3_attr },
1858 	{ .attrs = NULL },
1859 	{ .attrs = dme1737_pwm5_attr },
1860 	{ .attrs = dme1737_pwm6_attr },
1861 };
1862 
1863 /*
1864  * The following struct holds auto PWM min attributes, which are not available
1865  * in all chips. Their creation depends on the chip type which is determined
1866  * during module load.
1867  */
1868 static struct attribute *dme1737_auto_pwm_min_attr[] = {
1869 	&sensor_dev_attr_pwm1_auto_pwm_min.dev_attr.attr,
1870 	&sensor_dev_attr_pwm2_auto_pwm_min.dev_attr.attr,
1871 	&sensor_dev_attr_pwm3_auto_pwm_min.dev_attr.attr,
1872 };
1873 
1874 /*
1875  * The following structs hold the fan attributes, some of which are optional.
1876  * Their creation depends on the chip configuration which is determined during
1877  * module load.
1878  */
1879 static struct attribute *dme1737_fan1_attr[] = {
1880 	&sensor_dev_attr_fan1_input.dev_attr.attr,
1881 	&sensor_dev_attr_fan1_min.dev_attr.attr,
1882 	&sensor_dev_attr_fan1_alarm.dev_attr.attr,
1883 	&sensor_dev_attr_fan1_type.dev_attr.attr,
1884 	NULL
1885 };
1886 static struct attribute *dme1737_fan2_attr[] = {
1887 	&sensor_dev_attr_fan2_input.dev_attr.attr,
1888 	&sensor_dev_attr_fan2_min.dev_attr.attr,
1889 	&sensor_dev_attr_fan2_alarm.dev_attr.attr,
1890 	&sensor_dev_attr_fan2_type.dev_attr.attr,
1891 	NULL
1892 };
1893 static struct attribute *dme1737_fan3_attr[] = {
1894 	&sensor_dev_attr_fan3_input.dev_attr.attr,
1895 	&sensor_dev_attr_fan3_min.dev_attr.attr,
1896 	&sensor_dev_attr_fan3_alarm.dev_attr.attr,
1897 	&sensor_dev_attr_fan3_type.dev_attr.attr,
1898 	NULL
1899 };
1900 static struct attribute *dme1737_fan4_attr[] = {
1901 	&sensor_dev_attr_fan4_input.dev_attr.attr,
1902 	&sensor_dev_attr_fan4_min.dev_attr.attr,
1903 	&sensor_dev_attr_fan4_alarm.dev_attr.attr,
1904 	&sensor_dev_attr_fan4_type.dev_attr.attr,
1905 	NULL
1906 };
1907 static struct attribute *dme1737_fan5_attr[] = {
1908 	&sensor_dev_attr_fan5_input.dev_attr.attr,
1909 	&sensor_dev_attr_fan5_min.dev_attr.attr,
1910 	&sensor_dev_attr_fan5_alarm.dev_attr.attr,
1911 	&sensor_dev_attr_fan5_max.dev_attr.attr,
1912 	NULL
1913 };
1914 static struct attribute *dme1737_fan6_attr[] = {
1915 	&sensor_dev_attr_fan6_input.dev_attr.attr,
1916 	&sensor_dev_attr_fan6_min.dev_attr.attr,
1917 	&sensor_dev_attr_fan6_alarm.dev_attr.attr,
1918 	&sensor_dev_attr_fan6_max.dev_attr.attr,
1919 	NULL
1920 };
1921 
1922 static const struct attribute_group dme1737_fan_group[] = {
1923 	{ .attrs = dme1737_fan1_attr },
1924 	{ .attrs = dme1737_fan2_attr },
1925 	{ .attrs = dme1737_fan3_attr },
1926 	{ .attrs = dme1737_fan4_attr },
1927 	{ .attrs = dme1737_fan5_attr },
1928 	{ .attrs = dme1737_fan6_attr },
1929 };
1930 
1931 /*
1932  * The permissions of the following zone attributes are changed to read-
1933  * writeable if the chip is *not* locked. Otherwise they stay read-only.
1934  */
1935 static struct attribute *dme1737_zone_chmod_attr[] = {
1936 	&sensor_dev_attr_zone1_auto_point1_temp.dev_attr.attr,
1937 	&sensor_dev_attr_zone1_auto_point2_temp.dev_attr.attr,
1938 	&sensor_dev_attr_zone1_auto_point3_temp.dev_attr.attr,
1939 	&sensor_dev_attr_zone2_auto_point1_temp.dev_attr.attr,
1940 	&sensor_dev_attr_zone2_auto_point2_temp.dev_attr.attr,
1941 	&sensor_dev_attr_zone2_auto_point3_temp.dev_attr.attr,
1942 	NULL
1943 };
1944 
1945 static const struct attribute_group dme1737_zone_chmod_group = {
1946 	.attrs = dme1737_zone_chmod_attr,
1947 };
1948 
1949 
1950 /*
1951  * The permissions of the following zone 3 attributes are changed to read-
1952  * writeable if the chip is *not* locked. Otherwise they stay read-only.
1953  */
1954 static struct attribute *dme1737_zone3_chmod_attr[] = {
1955 	&sensor_dev_attr_zone3_auto_point1_temp.dev_attr.attr,
1956 	&sensor_dev_attr_zone3_auto_point2_temp.dev_attr.attr,
1957 	&sensor_dev_attr_zone3_auto_point3_temp.dev_attr.attr,
1958 	NULL
1959 };
1960 
1961 static const struct attribute_group dme1737_zone3_chmod_group = {
1962 	.attrs = dme1737_zone3_chmod_attr,
1963 };
1964 
1965 /*
1966  * The permissions of the following PWM attributes are changed to read-
1967  * writeable if the chip is *not* locked and the respective PWM is available.
1968  * Otherwise they stay read-only.
1969  */
1970 static struct attribute *dme1737_pwm1_chmod_attr[] = {
1971 	&sensor_dev_attr_pwm1_freq.dev_attr.attr,
1972 	&sensor_dev_attr_pwm1_enable.dev_attr.attr,
1973 	&sensor_dev_attr_pwm1_ramp_rate.dev_attr.attr,
1974 	&sensor_dev_attr_pwm1_auto_channels_zone.dev_attr.attr,
1975 	&sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
1976 	NULL
1977 };
1978 static struct attribute *dme1737_pwm2_chmod_attr[] = {
1979 	&sensor_dev_attr_pwm2_freq.dev_attr.attr,
1980 	&sensor_dev_attr_pwm2_enable.dev_attr.attr,
1981 	&sensor_dev_attr_pwm2_ramp_rate.dev_attr.attr,
1982 	&sensor_dev_attr_pwm2_auto_channels_zone.dev_attr.attr,
1983 	&sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
1984 	NULL
1985 };
1986 static struct attribute *dme1737_pwm3_chmod_attr[] = {
1987 	&sensor_dev_attr_pwm3_freq.dev_attr.attr,
1988 	&sensor_dev_attr_pwm3_enable.dev_attr.attr,
1989 	&sensor_dev_attr_pwm3_ramp_rate.dev_attr.attr,
1990 	&sensor_dev_attr_pwm3_auto_channels_zone.dev_attr.attr,
1991 	&sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
1992 	NULL
1993 };
1994 static struct attribute *dme1737_pwm5_chmod_attr[] = {
1995 	&sensor_dev_attr_pwm5.dev_attr.attr,
1996 	&sensor_dev_attr_pwm5_freq.dev_attr.attr,
1997 	NULL
1998 };
1999 static struct attribute *dme1737_pwm6_chmod_attr[] = {
2000 	&sensor_dev_attr_pwm6.dev_attr.attr,
2001 	&sensor_dev_attr_pwm6_freq.dev_attr.attr,
2002 	NULL
2003 };
2004 
2005 static const struct attribute_group dme1737_pwm_chmod_group[] = {
2006 	{ .attrs = dme1737_pwm1_chmod_attr },
2007 	{ .attrs = dme1737_pwm2_chmod_attr },
2008 	{ .attrs = dme1737_pwm3_chmod_attr },
2009 	{ .attrs = NULL },
2010 	{ .attrs = dme1737_pwm5_chmod_attr },
2011 	{ .attrs = dme1737_pwm6_chmod_attr },
2012 };
2013 
2014 /*
2015  * Pwm[1-3] are read-writeable if the associated pwm is in manual mode and the
2016  * chip is not locked. Otherwise they are read-only.
2017  */
2018 static struct attribute *dme1737_pwm_chmod_attr[] = {
2019 	&sensor_dev_attr_pwm1.dev_attr.attr,
2020 	&sensor_dev_attr_pwm2.dev_attr.attr,
2021 	&sensor_dev_attr_pwm3.dev_attr.attr,
2022 };
2023 
2024 /* ---------------------------------------------------------------------
2025  * Super-IO functions
2026  * --------------------------------------------------------------------- */
2027 
dme1737_sio_enter(int sio_cip)2028 static inline void dme1737_sio_enter(int sio_cip)
2029 {
2030 	outb(0x55, sio_cip);
2031 }
2032 
dme1737_sio_exit(int sio_cip)2033 static inline void dme1737_sio_exit(int sio_cip)
2034 {
2035 	outb(0xaa, sio_cip);
2036 }
2037 
dme1737_sio_inb(int sio_cip,int reg)2038 static inline int dme1737_sio_inb(int sio_cip, int reg)
2039 {
2040 	outb(reg, sio_cip);
2041 	return inb(sio_cip + 1);
2042 }
2043 
dme1737_sio_outb(int sio_cip,int reg,int val)2044 static inline void dme1737_sio_outb(int sio_cip, int reg, int val)
2045 {
2046 	outb(reg, sio_cip);
2047 	outb(val, sio_cip + 1);
2048 }
2049 
2050 /* ---------------------------------------------------------------------
2051  * Device initialization
2052  * --------------------------------------------------------------------- */
2053 
2054 static int dme1737_i2c_get_features(int, struct dme1737_data*);
2055 
dme1737_chmod_file(struct device * dev,struct attribute * attr,umode_t mode)2056 static void dme1737_chmod_file(struct device *dev,
2057 			       struct attribute *attr, umode_t mode)
2058 {
2059 	if (sysfs_chmod_file(&dev->kobj, attr, mode)) {
2060 		dev_warn(dev, "Failed to change permissions of %s.\n",
2061 			 attr->name);
2062 	}
2063 }
2064 
dme1737_chmod_group(struct device * dev,const struct attribute_group * group,umode_t mode)2065 static void dme1737_chmod_group(struct device *dev,
2066 				const struct attribute_group *group,
2067 				umode_t mode)
2068 {
2069 	struct attribute **attr;
2070 
2071 	for (attr = group->attrs; *attr; attr++)
2072 		dme1737_chmod_file(dev, *attr, mode);
2073 }
2074 
dme1737_remove_files(struct device * dev)2075 static void dme1737_remove_files(struct device *dev)
2076 {
2077 	struct dme1737_data *data = dev_get_drvdata(dev);
2078 	int ix;
2079 
2080 	for (ix = 0; ix < ARRAY_SIZE(dme1737_fan_group); ix++) {
2081 		if (data->has_features & HAS_FAN(ix)) {
2082 			sysfs_remove_group(&dev->kobj,
2083 					   &dme1737_fan_group[ix]);
2084 		}
2085 	}
2086 
2087 	for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_group); ix++) {
2088 		if (data->has_features & HAS_PWM(ix)) {
2089 			sysfs_remove_group(&dev->kobj,
2090 					   &dme1737_pwm_group[ix]);
2091 			if ((data->has_features & HAS_PWM_MIN) && ix < 3) {
2092 				sysfs_remove_file(&dev->kobj,
2093 						dme1737_auto_pwm_min_attr[ix]);
2094 			}
2095 		}
2096 	}
2097 
2098 	if (data->has_features & HAS_TEMP_OFFSET)
2099 		sysfs_remove_group(&dev->kobj, &dme1737_temp_offset_group);
2100 	if (data->has_features & HAS_VID)
2101 		sysfs_remove_group(&dev->kobj, &dme1737_vid_group);
2102 	if (data->has_features & HAS_ZONE3)
2103 		sysfs_remove_group(&dev->kobj, &dme1737_zone3_group);
2104 	if (data->has_features & HAS_ZONE_HYST)
2105 		sysfs_remove_group(&dev->kobj, &dme1737_zone_hyst_group);
2106 	if (data->has_features & HAS_IN7)
2107 		sysfs_remove_group(&dev->kobj, &dme1737_in7_group);
2108 	sysfs_remove_group(&dev->kobj, &dme1737_group);
2109 
2110 	if (!data->client)
2111 		sysfs_remove_file(&dev->kobj, &dev_attr_name.attr);
2112 }
2113 
dme1737_create_files(struct device * dev)2114 static int dme1737_create_files(struct device *dev)
2115 {
2116 	struct dme1737_data *data = dev_get_drvdata(dev);
2117 	int err, ix;
2118 
2119 	/* Create a name attribute for ISA devices */
2120 	if (!data->client) {
2121 		err = sysfs_create_file(&dev->kobj, &dev_attr_name.attr);
2122 		if (err)
2123 			goto exit;
2124 	}
2125 
2126 	/* Create standard sysfs attributes */
2127 	err = sysfs_create_group(&dev->kobj, &dme1737_group);
2128 	if (err)
2129 		goto exit_remove;
2130 
2131 	/* Create chip-dependent sysfs attributes */
2132 	if (data->has_features & HAS_TEMP_OFFSET) {
2133 		err = sysfs_create_group(&dev->kobj,
2134 					 &dme1737_temp_offset_group);
2135 		if (err)
2136 			goto exit_remove;
2137 	}
2138 	if (data->has_features & HAS_VID) {
2139 		err = sysfs_create_group(&dev->kobj, &dme1737_vid_group);
2140 		if (err)
2141 			goto exit_remove;
2142 	}
2143 	if (data->has_features & HAS_ZONE3) {
2144 		err = sysfs_create_group(&dev->kobj, &dme1737_zone3_group);
2145 		if (err)
2146 			goto exit_remove;
2147 	}
2148 	if (data->has_features & HAS_ZONE_HYST) {
2149 		err = sysfs_create_group(&dev->kobj, &dme1737_zone_hyst_group);
2150 		if (err)
2151 			goto exit_remove;
2152 	}
2153 	if (data->has_features & HAS_IN7) {
2154 		err = sysfs_create_group(&dev->kobj, &dme1737_in7_group);
2155 		if (err)
2156 			goto exit_remove;
2157 	}
2158 
2159 	/* Create fan sysfs attributes */
2160 	for (ix = 0; ix < ARRAY_SIZE(dme1737_fan_group); ix++) {
2161 		if (data->has_features & HAS_FAN(ix)) {
2162 			err = sysfs_create_group(&dev->kobj,
2163 						 &dme1737_fan_group[ix]);
2164 			if (err)
2165 				goto exit_remove;
2166 		}
2167 	}
2168 
2169 	/* Create PWM sysfs attributes */
2170 	for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_group); ix++) {
2171 		if (data->has_features & HAS_PWM(ix)) {
2172 			err = sysfs_create_group(&dev->kobj,
2173 						 &dme1737_pwm_group[ix]);
2174 			if (err)
2175 				goto exit_remove;
2176 			if ((data->has_features & HAS_PWM_MIN) && (ix < 3)) {
2177 				err = sysfs_create_file(&dev->kobj,
2178 						dme1737_auto_pwm_min_attr[ix]);
2179 				if (err)
2180 					goto exit_remove;
2181 			}
2182 		}
2183 	}
2184 
2185 	/*
2186 	 * Inform if the device is locked. Otherwise change the permissions of
2187 	 * selected attributes from read-only to read-writeable.
2188 	 */
2189 	if (data->config & 0x02) {
2190 		dev_info(dev,
2191 			 "Device is locked. Some attributes will be read-only.\n");
2192 	} else {
2193 		/* Change permissions of zone sysfs attributes */
2194 		dme1737_chmod_group(dev, &dme1737_zone_chmod_group,
2195 				    S_IRUGO | S_IWUSR);
2196 
2197 		/* Change permissions of chip-dependent sysfs attributes */
2198 		if (data->has_features & HAS_TEMP_OFFSET) {
2199 			dme1737_chmod_group(dev, &dme1737_temp_offset_group,
2200 					    S_IRUGO | S_IWUSR);
2201 		}
2202 		if (data->has_features & HAS_ZONE3) {
2203 			dme1737_chmod_group(dev, &dme1737_zone3_chmod_group,
2204 					    S_IRUGO | S_IWUSR);
2205 		}
2206 		if (data->has_features & HAS_ZONE_HYST) {
2207 			dme1737_chmod_group(dev, &dme1737_zone_hyst_group,
2208 					    S_IRUGO | S_IWUSR);
2209 		}
2210 
2211 		/* Change permissions of PWM sysfs attributes */
2212 		for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_chmod_group); ix++) {
2213 			if (data->has_features & HAS_PWM(ix)) {
2214 				dme1737_chmod_group(dev,
2215 						&dme1737_pwm_chmod_group[ix],
2216 						S_IRUGO | S_IWUSR);
2217 				if ((data->has_features & HAS_PWM_MIN) &&
2218 				    ix < 3) {
2219 					dme1737_chmod_file(dev,
2220 						dme1737_auto_pwm_min_attr[ix],
2221 						S_IRUGO | S_IWUSR);
2222 				}
2223 			}
2224 		}
2225 
2226 		/* Change permissions of pwm[1-3] if in manual mode */
2227 		for (ix = 0; ix < 3; ix++) {
2228 			if ((data->has_features & HAS_PWM(ix)) &&
2229 			    (PWM_EN_FROM_REG(data->pwm_config[ix]) == 1)) {
2230 				dme1737_chmod_file(dev,
2231 						dme1737_pwm_chmod_attr[ix],
2232 						S_IRUGO | S_IWUSR);
2233 			}
2234 		}
2235 	}
2236 
2237 	return 0;
2238 
2239 exit_remove:
2240 	dme1737_remove_files(dev);
2241 exit:
2242 	return err;
2243 }
2244 
dme1737_init_device(struct device * dev)2245 static int dme1737_init_device(struct device *dev)
2246 {
2247 	struct dme1737_data *data = dev_get_drvdata(dev);
2248 	struct i2c_client *client = data->client;
2249 	int ix;
2250 	u8 reg;
2251 
2252 	/* Point to the right nominal voltages array */
2253 	data->in_nominal = IN_NOMINAL(data->type);
2254 
2255 	data->config = dme1737_read(data, DME1737_REG_CONFIG);
2256 	/* Inform if part is not monitoring/started */
2257 	if (!(data->config & 0x01)) {
2258 		if (!force_start) {
2259 			dev_err(dev,
2260 				"Device is not monitoring. Use the force_start load parameter to override.\n");
2261 			return -EFAULT;
2262 		}
2263 
2264 		/* Force monitoring */
2265 		data->config |= 0x01;
2266 		dme1737_write(data, DME1737_REG_CONFIG, data->config);
2267 	}
2268 	/* Inform if part is not ready */
2269 	if (!(data->config & 0x04)) {
2270 		dev_err(dev, "Device is not ready.\n");
2271 		return -EFAULT;
2272 	}
2273 
2274 	/*
2275 	 * Determine which optional fan and pwm features are enabled (only
2276 	 * valid for I2C devices)
2277 	 */
2278 	if (client) {   /* I2C chip */
2279 		data->config2 = dme1737_read(data, DME1737_REG_CONFIG2);
2280 		/* Check if optional fan3 input is enabled */
2281 		if (data->config2 & 0x04)
2282 			data->has_features |= HAS_FAN(2);
2283 
2284 		/*
2285 		 * Fan4 and pwm3 are only available if the client's I2C address
2286 		 * is the default 0x2e. Otherwise the I/Os associated with
2287 		 * these functions are used for addr enable/select.
2288 		 */
2289 		if (client->addr == 0x2e)
2290 			data->has_features |= HAS_FAN(3) | HAS_PWM(2);
2291 
2292 		/*
2293 		 * Determine which of the optional fan[5-6] and pwm[5-6]
2294 		 * features are enabled. For this, we need to query the runtime
2295 		 * registers through the Super-IO LPC interface. Try both
2296 		 * config ports 0x2e and 0x4e.
2297 		 */
2298 		if (dme1737_i2c_get_features(0x2e, data) &&
2299 		    dme1737_i2c_get_features(0x4e, data)) {
2300 			dev_warn(dev,
2301 				 "Failed to query Super-IO for optional features.\n");
2302 		}
2303 	}
2304 
2305 	/* Fan[1-2] and pwm[1-2] are present in all chips */
2306 	data->has_features |= HAS_FAN(0) | HAS_FAN(1) | HAS_PWM(0) | HAS_PWM(1);
2307 
2308 	/* Chip-dependent features */
2309 	switch (data->type) {
2310 	case dme1737:
2311 		data->has_features |= HAS_TEMP_OFFSET | HAS_VID | HAS_ZONE3 |
2312 			HAS_ZONE_HYST | HAS_PWM_MIN;
2313 		break;
2314 	case sch311x:
2315 		data->has_features |= HAS_TEMP_OFFSET | HAS_ZONE3 |
2316 			HAS_ZONE_HYST | HAS_PWM_MIN | HAS_FAN(2) | HAS_PWM(2);
2317 		break;
2318 	case sch5027:
2319 		data->has_features |= HAS_ZONE3;
2320 		break;
2321 	case sch5127:
2322 		data->has_features |= HAS_FAN(2) | HAS_PWM(2) | HAS_IN7;
2323 		break;
2324 	default:
2325 		break;
2326 	}
2327 
2328 	dev_info(dev,
2329 		 "Optional features: pwm3=%s, pwm5=%s, pwm6=%s, fan3=%s, fan4=%s, fan5=%s, fan6=%s.\n",
2330 		 (data->has_features & HAS_PWM(2)) ? "yes" : "no",
2331 		 (data->has_features & HAS_PWM(4)) ? "yes" : "no",
2332 		 (data->has_features & HAS_PWM(5)) ? "yes" : "no",
2333 		 (data->has_features & HAS_FAN(2)) ? "yes" : "no",
2334 		 (data->has_features & HAS_FAN(3)) ? "yes" : "no",
2335 		 (data->has_features & HAS_FAN(4)) ? "yes" : "no",
2336 		 (data->has_features & HAS_FAN(5)) ? "yes" : "no");
2337 
2338 	reg = dme1737_read(data, DME1737_REG_TACH_PWM);
2339 	/* Inform if fan-to-pwm mapping differs from the default */
2340 	if (client && reg != 0xa4) {   /* I2C chip */
2341 		dev_warn(dev,
2342 			 "Non-standard fan to pwm mapping: fan1->pwm%d, fan2->pwm%d, fan3->pwm%d, fan4->pwm%d. %s\n",
2343 			 (reg & 0x03) + 1, ((reg >> 2) & 0x03) + 1,
2344 			 ((reg >> 4) & 0x03) + 1, ((reg >> 6) & 0x03) + 1,
2345 			 DO_REPORT);
2346 	} else if (!client && reg != 0x24) {   /* ISA chip */
2347 		dev_warn(dev,
2348 			 "Non-standard fan to pwm mapping: fan1->pwm%d, fan2->pwm%d, fan3->pwm%d. %s\n",
2349 			 (reg & 0x03) + 1, ((reg >> 2) & 0x03) + 1,
2350 			 ((reg >> 4) & 0x03) + 1, DO_REPORT);
2351 	}
2352 
2353 	/*
2354 	 * Switch pwm[1-3] to manual mode if they are currently disabled and
2355 	 * set the duty-cycles to 0% (which is identical to the PWMs being
2356 	 * disabled).
2357 	 */
2358 	if (!(data->config & 0x02)) {
2359 		for (ix = 0; ix < 3; ix++) {
2360 			data->pwm_config[ix] = dme1737_read(data,
2361 						DME1737_REG_PWM_CONFIG(ix));
2362 			if ((data->has_features & HAS_PWM(ix)) &&
2363 			    (PWM_EN_FROM_REG(data->pwm_config[ix]) == -1)) {
2364 				dev_info(dev,
2365 					 "Switching pwm%d to manual mode.\n",
2366 					 ix + 1);
2367 				data->pwm_config[ix] = PWM_EN_TO_REG(1,
2368 							data->pwm_config[ix]);
2369 				dme1737_write(data, DME1737_REG_PWM(ix), 0);
2370 				dme1737_write(data,
2371 					      DME1737_REG_PWM_CONFIG(ix),
2372 					      data->pwm_config[ix]);
2373 			}
2374 		}
2375 	}
2376 
2377 	/* Initialize the default PWM auto channels zone (acz) assignments */
2378 	data->pwm_acz[0] = 1;	/* pwm1 -> zone1 */
2379 	data->pwm_acz[1] = 2;	/* pwm2 -> zone2 */
2380 	data->pwm_acz[2] = 4;	/* pwm3 -> zone3 */
2381 
2382 	/* Set VRM */
2383 	if (data->has_features & HAS_VID)
2384 		data->vrm = vid_which_vrm();
2385 
2386 	return 0;
2387 }
2388 
2389 /* ---------------------------------------------------------------------
2390  * I2C device detection and registration
2391  * --------------------------------------------------------------------- */
2392 
2393 static struct i2c_driver dme1737_i2c_driver;
2394 
dme1737_i2c_get_features(int sio_cip,struct dme1737_data * data)2395 static int dme1737_i2c_get_features(int sio_cip, struct dme1737_data *data)
2396 {
2397 	int err = 0, reg;
2398 	u16 addr;
2399 
2400 	dme1737_sio_enter(sio_cip);
2401 
2402 	/*
2403 	 * Check device ID
2404 	 * We currently know about two kinds of DME1737 and SCH5027.
2405 	 */
2406 	reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20);
2407 	if (!(reg == DME1737_ID_1 || reg == DME1737_ID_2 ||
2408 	      reg == SCH5027_ID)) {
2409 		err = -ENODEV;
2410 		goto exit;
2411 	}
2412 
2413 	/* Select logical device A (runtime registers) */
2414 	dme1737_sio_outb(sio_cip, 0x07, 0x0a);
2415 
2416 	/* Get the base address of the runtime registers */
2417 	addr = (dme1737_sio_inb(sio_cip, 0x60) << 8) |
2418 		dme1737_sio_inb(sio_cip, 0x61);
2419 	if (!addr) {
2420 		err = -ENODEV;
2421 		goto exit;
2422 	}
2423 
2424 	/*
2425 	 * Read the runtime registers to determine which optional features
2426 	 * are enabled and available. Bits [3:2] of registers 0x43-0x46 are set
2427 	 * to '10' if the respective feature is enabled.
2428 	 */
2429 	if ((inb(addr + 0x43) & 0x0c) == 0x08) /* fan6 */
2430 		data->has_features |= HAS_FAN(5);
2431 	if ((inb(addr + 0x44) & 0x0c) == 0x08) /* pwm6 */
2432 		data->has_features |= HAS_PWM(5);
2433 	if ((inb(addr + 0x45) & 0x0c) == 0x08) /* fan5 */
2434 		data->has_features |= HAS_FAN(4);
2435 	if ((inb(addr + 0x46) & 0x0c) == 0x08) /* pwm5 */
2436 		data->has_features |= HAS_PWM(4);
2437 
2438 exit:
2439 	dme1737_sio_exit(sio_cip);
2440 
2441 	return err;
2442 }
2443 
2444 /* Return 0 if detection is successful, -ENODEV otherwise */
dme1737_i2c_detect(struct i2c_client * client,struct i2c_board_info * info)2445 static int dme1737_i2c_detect(struct i2c_client *client,
2446 			      struct i2c_board_info *info)
2447 {
2448 	struct i2c_adapter *adapter = client->adapter;
2449 	struct device *dev = &adapter->dev;
2450 	u8 company, verstep = 0;
2451 	const char *name;
2452 
2453 	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
2454 		return -ENODEV;
2455 
2456 	company = i2c_smbus_read_byte_data(client, DME1737_REG_COMPANY);
2457 	verstep = i2c_smbus_read_byte_data(client, DME1737_REG_VERSTEP);
2458 
2459 	if (company == DME1737_COMPANY_SMSC &&
2460 	    verstep == SCH5027_VERSTEP) {
2461 		name = "sch5027";
2462 	} else if (company == DME1737_COMPANY_SMSC &&
2463 		   (verstep & DME1737_VERSTEP_MASK) == DME1737_VERSTEP) {
2464 		name = "dme1737";
2465 	} else {
2466 		return -ENODEV;
2467 	}
2468 
2469 	dev_info(dev, "Found a %s chip at 0x%02x (rev 0x%02x).\n",
2470 		 verstep == SCH5027_VERSTEP ? "SCH5027" : "DME1737",
2471 		 client->addr, verstep);
2472 	strlcpy(info->type, name, I2C_NAME_SIZE);
2473 
2474 	return 0;
2475 }
2476 
dme1737_i2c_probe(struct i2c_client * client,const struct i2c_device_id * id)2477 static int dme1737_i2c_probe(struct i2c_client *client,
2478 			     const struct i2c_device_id *id)
2479 {
2480 	struct dme1737_data *data;
2481 	struct device *dev = &client->dev;
2482 	int err;
2483 
2484 	data = devm_kzalloc(dev, sizeof(struct dme1737_data), GFP_KERNEL);
2485 	if (!data)
2486 		return -ENOMEM;
2487 
2488 	i2c_set_clientdata(client, data);
2489 	data->type = id->driver_data;
2490 	data->client = client;
2491 	data->name = client->name;
2492 	mutex_init(&data->update_lock);
2493 
2494 	/* Initialize the DME1737 chip */
2495 	err = dme1737_init_device(dev);
2496 	if (err) {
2497 		dev_err(dev, "Failed to initialize device.\n");
2498 		return err;
2499 	}
2500 
2501 	/* Create sysfs files */
2502 	err = dme1737_create_files(dev);
2503 	if (err) {
2504 		dev_err(dev, "Failed to create sysfs files.\n");
2505 		return err;
2506 	}
2507 
2508 	/* Register device */
2509 	data->hwmon_dev = hwmon_device_register(dev);
2510 	if (IS_ERR(data->hwmon_dev)) {
2511 		dev_err(dev, "Failed to register device.\n");
2512 		err = PTR_ERR(data->hwmon_dev);
2513 		goto exit_remove;
2514 	}
2515 
2516 	return 0;
2517 
2518 exit_remove:
2519 	dme1737_remove_files(dev);
2520 	return err;
2521 }
2522 
dme1737_i2c_remove(struct i2c_client * client)2523 static int dme1737_i2c_remove(struct i2c_client *client)
2524 {
2525 	struct dme1737_data *data = i2c_get_clientdata(client);
2526 
2527 	hwmon_device_unregister(data->hwmon_dev);
2528 	dme1737_remove_files(&client->dev);
2529 
2530 	return 0;
2531 }
2532 
2533 static const struct i2c_device_id dme1737_id[] = {
2534 	{ "dme1737", dme1737 },
2535 	{ "sch5027", sch5027 },
2536 	{ }
2537 };
2538 MODULE_DEVICE_TABLE(i2c, dme1737_id);
2539 
2540 static struct i2c_driver dme1737_i2c_driver = {
2541 	.class = I2C_CLASS_HWMON,
2542 	.driver = {
2543 		.name = "dme1737",
2544 	},
2545 	.probe = dme1737_i2c_probe,
2546 	.remove = dme1737_i2c_remove,
2547 	.id_table = dme1737_id,
2548 	.detect = dme1737_i2c_detect,
2549 	.address_list = normal_i2c,
2550 };
2551 
2552 /* ---------------------------------------------------------------------
2553  * ISA device detection and registration
2554  * --------------------------------------------------------------------- */
2555 
dme1737_isa_detect(int sio_cip,unsigned short * addr)2556 static int __init dme1737_isa_detect(int sio_cip, unsigned short *addr)
2557 {
2558 	int err = 0, reg;
2559 	unsigned short base_addr;
2560 
2561 	dme1737_sio_enter(sio_cip);
2562 
2563 	/*
2564 	 * Check device ID
2565 	 * We currently know about SCH3112, SCH3114, SCH3116, and SCH5127
2566 	 */
2567 	reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20);
2568 	if (!(reg == SCH3112_ID || reg == SCH3114_ID || reg == SCH3116_ID ||
2569 	      reg == SCH5127_ID)) {
2570 		err = -ENODEV;
2571 		goto exit;
2572 	}
2573 
2574 	/* Select logical device A (runtime registers) */
2575 	dme1737_sio_outb(sio_cip, 0x07, 0x0a);
2576 
2577 	/* Get the base address of the runtime registers */
2578 	base_addr = (dme1737_sio_inb(sio_cip, 0x60) << 8) |
2579 		     dme1737_sio_inb(sio_cip, 0x61);
2580 	if (!base_addr) {
2581 		pr_err("Base address not set\n");
2582 		err = -ENODEV;
2583 		goto exit;
2584 	}
2585 
2586 	/*
2587 	 * Access to the hwmon registers is through an index/data register
2588 	 * pair located at offset 0x70/0x71.
2589 	 */
2590 	*addr = base_addr + 0x70;
2591 
2592 exit:
2593 	dme1737_sio_exit(sio_cip);
2594 	return err;
2595 }
2596 
dme1737_isa_device_add(unsigned short addr)2597 static int __init dme1737_isa_device_add(unsigned short addr)
2598 {
2599 	struct resource res = {
2600 		.start	= addr,
2601 		.end	= addr + DME1737_EXTENT - 1,
2602 		.name	= "dme1737",
2603 		.flags	= IORESOURCE_IO,
2604 	};
2605 	int err;
2606 
2607 	err = acpi_check_resource_conflict(&res);
2608 	if (err)
2609 		goto exit;
2610 
2611 	pdev = platform_device_alloc("dme1737", addr);
2612 	if (!pdev) {
2613 		pr_err("Failed to allocate device\n");
2614 		err = -ENOMEM;
2615 		goto exit;
2616 	}
2617 
2618 	err = platform_device_add_resources(pdev, &res, 1);
2619 	if (err) {
2620 		pr_err("Failed to add device resource (err = %d)\n", err);
2621 		goto exit_device_put;
2622 	}
2623 
2624 	err = platform_device_add(pdev);
2625 	if (err) {
2626 		pr_err("Failed to add device (err = %d)\n", err);
2627 		goto exit_device_put;
2628 	}
2629 
2630 	return 0;
2631 
2632 exit_device_put:
2633 	platform_device_put(pdev);
2634 	pdev = NULL;
2635 exit:
2636 	return err;
2637 }
2638 
dme1737_isa_probe(struct platform_device * pdev)2639 static int dme1737_isa_probe(struct platform_device *pdev)
2640 {
2641 	u8 company, device;
2642 	struct resource *res;
2643 	struct dme1737_data *data;
2644 	struct device *dev = &pdev->dev;
2645 	int err;
2646 
2647 	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
2648 	if (!devm_request_region(dev, res->start, DME1737_EXTENT, "dme1737")) {
2649 		dev_err(dev, "Failed to request region 0x%04x-0x%04x.\n",
2650 			(unsigned short)res->start,
2651 			(unsigned short)res->start + DME1737_EXTENT - 1);
2652 		return -EBUSY;
2653 	}
2654 
2655 	data = devm_kzalloc(dev, sizeof(struct dme1737_data), GFP_KERNEL);
2656 	if (!data)
2657 		return -ENOMEM;
2658 
2659 	data->addr = res->start;
2660 	platform_set_drvdata(pdev, data);
2661 
2662 	/* Skip chip detection if module is loaded with force_id parameter */
2663 	switch (force_id) {
2664 	case SCH3112_ID:
2665 	case SCH3114_ID:
2666 	case SCH3116_ID:
2667 		data->type = sch311x;
2668 		break;
2669 	case SCH5127_ID:
2670 		data->type = sch5127;
2671 		break;
2672 	default:
2673 		company = dme1737_read(data, DME1737_REG_COMPANY);
2674 		device = dme1737_read(data, DME1737_REG_DEVICE);
2675 
2676 		if ((company == DME1737_COMPANY_SMSC) &&
2677 		    (device == SCH311X_DEVICE)) {
2678 			data->type = sch311x;
2679 		} else if ((company == DME1737_COMPANY_SMSC) &&
2680 			   (device == SCH5127_DEVICE)) {
2681 			data->type = sch5127;
2682 		} else {
2683 			return -ENODEV;
2684 		}
2685 	}
2686 
2687 	if (data->type == sch5127)
2688 		data->name = "sch5127";
2689 	else
2690 		data->name = "sch311x";
2691 
2692 	/* Initialize the mutex */
2693 	mutex_init(&data->update_lock);
2694 
2695 	dev_info(dev, "Found a %s chip at 0x%04x\n",
2696 		 data->type == sch5127 ? "SCH5127" : "SCH311x", data->addr);
2697 
2698 	/* Initialize the chip */
2699 	err = dme1737_init_device(dev);
2700 	if (err) {
2701 		dev_err(dev, "Failed to initialize device.\n");
2702 		return err;
2703 	}
2704 
2705 	/* Create sysfs files */
2706 	err = dme1737_create_files(dev);
2707 	if (err) {
2708 		dev_err(dev, "Failed to create sysfs files.\n");
2709 		return err;
2710 	}
2711 
2712 	/* Register device */
2713 	data->hwmon_dev = hwmon_device_register(dev);
2714 	if (IS_ERR(data->hwmon_dev)) {
2715 		dev_err(dev, "Failed to register device.\n");
2716 		err = PTR_ERR(data->hwmon_dev);
2717 		goto exit_remove_files;
2718 	}
2719 
2720 	return 0;
2721 
2722 exit_remove_files:
2723 	dme1737_remove_files(dev);
2724 	return err;
2725 }
2726 
dme1737_isa_remove(struct platform_device * pdev)2727 static int dme1737_isa_remove(struct platform_device *pdev)
2728 {
2729 	struct dme1737_data *data = platform_get_drvdata(pdev);
2730 
2731 	hwmon_device_unregister(data->hwmon_dev);
2732 	dme1737_remove_files(&pdev->dev);
2733 
2734 	return 0;
2735 }
2736 
2737 static struct platform_driver dme1737_isa_driver = {
2738 	.driver = {
2739 		.name = "dme1737",
2740 	},
2741 	.probe = dme1737_isa_probe,
2742 	.remove = dme1737_isa_remove,
2743 };
2744 
2745 /* ---------------------------------------------------------------------
2746  * Module initialization and cleanup
2747  * --------------------------------------------------------------------- */
2748 
dme1737_init(void)2749 static int __init dme1737_init(void)
2750 {
2751 	int err;
2752 	unsigned short addr;
2753 
2754 	err = i2c_add_driver(&dme1737_i2c_driver);
2755 	if (err)
2756 		goto exit;
2757 
2758 	if (dme1737_isa_detect(0x2e, &addr) &&
2759 	    dme1737_isa_detect(0x4e, &addr) &&
2760 	    (!probe_all_addr ||
2761 	     (dme1737_isa_detect(0x162e, &addr) &&
2762 	      dme1737_isa_detect(0x164e, &addr)))) {
2763 		/* Return 0 if we didn't find an ISA device */
2764 		return 0;
2765 	}
2766 
2767 	err = platform_driver_register(&dme1737_isa_driver);
2768 	if (err)
2769 		goto exit_del_i2c_driver;
2770 
2771 	/* Sets global pdev as a side effect */
2772 	err = dme1737_isa_device_add(addr);
2773 	if (err)
2774 		goto exit_del_isa_driver;
2775 
2776 	return 0;
2777 
2778 exit_del_isa_driver:
2779 	platform_driver_unregister(&dme1737_isa_driver);
2780 exit_del_i2c_driver:
2781 	i2c_del_driver(&dme1737_i2c_driver);
2782 exit:
2783 	return err;
2784 }
2785 
dme1737_exit(void)2786 static void __exit dme1737_exit(void)
2787 {
2788 	if (pdev) {
2789 		platform_device_unregister(pdev);
2790 		platform_driver_unregister(&dme1737_isa_driver);
2791 	}
2792 
2793 	i2c_del_driver(&dme1737_i2c_driver);
2794 }
2795 
2796 MODULE_AUTHOR("Juerg Haefliger <juergh@gmail.com>");
2797 MODULE_DESCRIPTION("DME1737 sensors");
2798 MODULE_LICENSE("GPL");
2799 
2800 module_init(dme1737_init);
2801 module_exit(dme1737_exit);
2802