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
|
/* Looking for Power Management ChipSet by checking
the PCI Configuration Register, by YRS 2001.08.
Information on how to access SMBus is provided
by ":p araffin.(Yoneya)", MANY THANKS!!
Information for SMBus access and PCI chipset comes from
the Linux lm_sensor codes: http://www.lm-sensors.nu
*/
#include <unistd.h>
#include "pci_pm.h"
#include "io_static.c"
#ifndef PCI_SMB_INCLUDED
/* counter for not calling iopl() multiply */
int iopl_counter = 0;
/* file descripter for FreeBSD /dev/io */
int iofl;
#endif
int canSMBUS_base[] = {
getSMBBA0,
getSMBBA1,
getSMBBA2,
getSMBBA3,
getSMBBA4,
getSMBBA5,
getSMBBA6,
getSMBBA70,
getSMBBA71,
0 };
int pci_smb_prob(int smb_base[], u_int chip_id[])
{
u_int chip, dat, addr;
u_char dev, fun;
int i, n = 0;
if(OpenIO() == -1) return -1;
for (dev = 0; dev < PCI_DEVM; ++dev) {
for (fun = 0; fun < PCI_FUNM; ++fun) {
chip = pci_conf_read(PCI_BUSN, dev, fun, 0x00);
if (chip != 0xFFFFFFFF) {
for (i = 0; (addr = canSMBUS_base[i]) != 0; i++) {
dat = pci_conf_readw(PCI_BUSN, dev, fun, (u_char) addr);
#ifdef PCI_LIST
if (i == 0) {
printf("bus=0x00:dev=0x%02X:fun=0x%02X ---> ", dev, fun);
printf("chip=0x%08X [0x%02X] SMBase=0x%08X\n", chip, addr, dat);
} else {
printf(" ");
printf("[0x%02X] SMBase=0x%08X\n", addr, dat);
}
#endif
if (dat != 0x0 && dat != 0xFFFFFFFF \
&& (dat & 0x0F) == 1 && (dat & 0xFFF00000) == 0) {
chip_id[n] = chip;
if (chip == ID_AMD756 || chip == ID_AMD766 )
smb_base[n] = (dat & 0xFF00) + AMD_SMBOFF;
else
smb_base[n] = (dat & 0xFFF0);
if (INb(smb_base[n]) != 0xFF)
++n;
}
}
}
}
}
CloseIO();
return n;
}
|
