File: sens_wl784.c

package info (click to toggle)
xmbmon 2.05-8
  • links: PTS
  • area: main
  • in suites: bullseye, buster, sid, stretch
  • size: 928 kB
  • ctags: 910
  • sloc: ansic: 6,089; sh: 2,151; perl: 87; makefile: 79
file content (326 lines) | stat: -rw-r--r-- 6,789 bytes parent folder | download | duplicates (5)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
/*
 * Winbond new chips
 *
 ***************************************************************
 * Before calling these routines, one must call method->Open() *
 * After calling these routines, one must call method->Close() *
 ***************************************************************
 *
 * Winbond chip: W83L784R, W83L785R, W83L785TS-S
 *

Winbond
         Chip            Temp    Volt    Fan     SMBus   IOport
        W83L784R          3       4       2       yes     no
        W83L785R          2       4       2       yes     no
        W83L785TS-S       1       0       0       yes     no

 *
 * by YRS
 */

/* To allow "unknown" (fuzzy probing), define this */
/*	#define ALLOW_UNKNOWN	*/

#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include "pci_pm.h"
#include "sensors.h"
#include "sens_wl784.h"

/* external (global) data */
extern int pm_smb_detected;
extern int smb_slave;
extern int smb_wbtemp1, smb_wbtemp2;
extern int smb_wbtemp1_flag, smb_wbtemp2_flag;
extern LM_METHODS method_isa, method_smb;
extern int numSMBSlave, canSMBSlave[128];

#define	WINBD_ADDR_START	0x50	/* 0x50-0x5E (0x28-0x2F) */
#define	WINBD_ADDR_END		0x5E

#define	WINBD_CONFIG	0x40
#define	WINBD_SMBADDR	0x4A
#define	WINBD_VENDIDL	0x4C
#define	WINBD_VENDIDH	0x4D
#define	WINBD_CHIPID	0x4E

/* temp nr=0,1,2; volt nr=0,...3; fan nr=0,1 */
#define	WINBD_TEMP0		0x27
#define	WINBD_TEMP1		0x26
#define	WINBD_TEMPADDR	0x4B
#define	WINBD_VOLT(nr)	(0x20 + (nr))
#define	WINBD_FAN(nr)	(0x28 + (nr))
#define	WINBD_FANDIV	0x49

#define WINBD_DIOSEL	0x53

static	int		wl784_probe(LM_METHODS *);
static	int		wl784_probe_act(LM_METHODS *, int);
static	float	wl784_temp(LM_METHODS *, int);
static	int		wl784_fanrpm(LM_METHODS *, int);
static	float	wl784_volt(LM_METHODS *, int);

#define BUFF_LEN 128
static char buff[BUFF_LEN];

SENSOR wl784 = {
	buff,
	wl784_probe,
	wl784_temp,
	wl784_volt,
	wl784_fanrpm
};

/* chip idenfication */
static int wbdchipid = 0;

/* temp1/2 flags address */
static int temp1_flag = 0;	/* = 0 if enabled ! */
static int temp2_flag = 0;	/* = 0 if enabled ! */
static int temp1_addr = 0;
static int temp2_addr = 0;

#define WINBD_chkRegNum 8

/* Register checked for probing */
static int chkReg[] = {
	0x40, 0x41, 0x42, 0x43,
	0x44, 0x45, 0x46, 0x47,
	0x48, 0x49, 0x4A, 0x4B,
	0x4C, 0x4D, 0x4E, 0x4F,
	0x20, 0x21, 0x22, 0x23,
	0x26, 0x27, 0x28, 0x29,
	0x2B, 0x2C, 0x2D, 0x2E,
	-1 };


/*
 *  return 0 if not probed
 */
static	int 	wl784_probe(LM_METHODS *method)
{
	int n, save, slave;

	if (method != &method_smb)
		return 0;

	save = smb_slave;

	for (n = WINBD_ADDR_START; n <= WINBD_ADDR_END;) {
		if (!(slave = get_smb_slave(n, WINBD_ADDR_END)))
			goto ret0;
		else {
			if (wl784_probe_act(method, slave))
				goto ret1;
			else
				n = slave + 2;
		}
	}

ret0:
	smb_slave = save;
	return 0;
ret1:
	kill_smb_slave(slave);
	if(!smb_wbtemp1_flag)
		kill_smb_slave(smb_wbtemp1);
	if(!smb_wbtemp2_flag)
		kill_smb_slave(smb_wbtemp2);
	return wbdchipid;
}

static	int 	wl784_probe_act(LM_METHODS *method, int slave)
{
	int n, nc, nvl, nvh;

	smb_slave = slave;

	if (chkReg_Probe(slave, "Probing Winbond W83L78x chip:\n",
			chkReg, method) < WINBD_chkRegNum)
		goto ret0;


	nvl = method->Read(WINBD_VENDIDL);
	nvh = method->Read(WINBD_VENDIDH);
	nc = method->Read(WINBD_CHIPID);
#ifdef DEBUG
printf("DEBUG 4C:0x%02X 4D:0x%02X 4E:0x%02X\n",nvl,nvh,nc);
#endif

	if (nvl == 0xA3 && nvh == 0x5C) {	/* Winbond Chip */
		switch (nc & 0xFE) {
			case 0x50:	/* 0x50 (or 0x51) */
				wbdchipid = W83L784R;
				break;
			case 0x60:	/* 0x60 (or 0x61) */
				wbdchipid = W83L785R;
				break;
			case 0x70:	/* 0x70 (or 0x71) */
				wbdchipid = W83L785TS;
				break;
			default:
				goto ret0;
		}
	} else
		goto ret0;

	strcpy(wl784.Name, wlchip[wbdchipid]);

/* Checking Extra temperatures Temp1, Temp2 */

	if (wbdchipid != W83L784R)
		goto ret1;

	n = method->Read(WINBD_TEMPADDR);
	if (!(temp1_flag = (n & 0x08) >> 3)) {
		temp1_addr = smb_wbtemp1;
		smb_wbtemp1 = 2 * ( 0x48 + (n & 0x07) );
		if (method->ReadTemp1() == 0xFFFF) {
			temp1_flag = 1;	/* disable! */
			smb_wbtemp1 = temp1_addr;
		}
	}

	if (!(temp2_flag = (n & 0x80) >> 7)) {
		temp2_addr = smb_wbtemp2;
		smb_wbtemp2 = 2 * ( 0x48 + ((n & 0x70) >> 4) );
		if (method->ReadTemp2() == 0xFFFF) {
			temp2_flag = 1;	/* disable! */
			smb_wbtemp2 = temp2_addr;
		}
	}
	info_Extemp(method, temp1_flag, temp2_flag);

ret1:
	smb_wbtemp1_flag = temp1_flag;
	smb_wbtemp2_flag = temp2_flag;
	return wbdchipid;
ret0:
	return 0;
}


/*
 *	\retval	0xFFFF	no sensor
 *	\retval	other	temperature
 *  no = 0,1,2
 */
static	float	wl784_temp(LM_METHODS *method, int no)
{
	int n = 0;
	float f;

	if (no < 0 || 2 < no)
		return 0xFFFF;
	if (no == 2 && wbdchipid == W83L785R)
		return 0xFFFF;
	if (no >= 1 && wbdchipid == W83L785TS)
		return 0xFFFF;

	if (no == 0)
		return (float) method->Read(WINBD_TEMP0);
	else if (no == 1) {
		if (wbdchipid == W83L785R)
			return (float) method->Read(WINBD_TEMP1);
		else
			n = method->ReadTemp1();
	} else if (no == 2) {
			n = method->ReadTemp2();
	}

	if ((n & 0xFF) >= 0x80)
		n = 0;

	f = (float) (n & 0xFF) + 0.5 * ((n & 0xFF00) >> 15);

	return f;
}


/*
 *	\retval	0x0000FFFF	no sensor
 *  no = 0,1,2,...,6
 */
static	float	wl784_volt(LM_METHODS *method, int no)
{
	int n;
	float f = 0.0;

	if (wbdchipid == W83L785TS)
		return 0xFFFF;
	if (no < 0 || 3 < no)
		return 0xFFFF;

	n = method->Read(WINBD_VOLT(no));
	switch (no) {
		case 0:
			f = n * 0.016;
		case 1:
			if (wbdchipid == W83L784R)
				f = n * 0.016 * 3.3434;
			else
				f = n * 0.016 * 2;
		case 2:
			f = n * 0.016;
			break;
		case 3:
			if (wbdchipid == W83L784R)
				f = n * 0.016 * 1.68;
			else
				f = n * 0.016 * 3;
			break;
	}

	return f;
}


/*
	Controlling Fan Divisor: CR = 0x49.
	lowest 3bits for fan1, 4-6th bits for fan2.

         7       3     0
        +-+-+-+-+-+-+-+-+    xxx = 000,001,010,011,...  div1fac = 1,2,4,8,...
        |  y y y|  x x x|    yyy = 000,001,010,011,...  div2fac = 1,2,4,8,...
        +-+-+-+-+-+-+-+-+    initial values: xx=001, yy=001

 */

/*
 *	\retval	0xFFFF no sensor
 *  no = 0,1
 *
 *  Clock is 22.5kHz (22,500 x 60 = 1350000 counts/minute)
 */
static	int		wl784_fanrpm(LM_METHODS *method, int no)
{
	int r, n1 = 0x11;
	static int div[2] = {1,1};

	if (wbdchipid == W83L785TS)
		return 0xFFFF;
	if (no < 0 || 1 < no)
		return 0xFFFF;

	n1 = method->Read(WINBD_FANDIV);
	div[0] =  n1 & 0x07 ;
	div[1] = (n1 >> 4) & 0x07;

	r = method->Read(WINBD_FAN(no));
	if (r == 0xFF) {
		/* change divisor for the sake of next call ! */
		if (div[no] < 7)
			++(div[no]);
		else
			div[no] = 0;
		r = (n1 & 0x88) | div[0] | (div[1] << 4);
		method->Write(WINBD_FANDIV, r);
		return 0xFFFF;
	} else if (r == 0) {
		return 0xFFFF;
	}

	return 1350000 / (r * (1 << div[no]));
}