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