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
|
#include <u.h>
#include <libc.h>
int
pcicfg16r(int fd, ushort *s, vlong offset)
{
char buf[2];
if(pread(fd, buf, 2, offset) < 2) return -1;
*s = buf[0] | (buf[1] << 8);
return 0;
}
void
main()
{
int fd;
long n;
Dir *dir;
char *p, *s;
uchar cap, c;
ushort sh;
fd = open("/dev/pci", OREAD);
if(fd < 0) sysfatal("open /dev/pci: %r");
n = dirreadall(fd, &dir);
if(n < 0) sysfatal("dirreadall /dev/pci: %r");
close(fd);
for(; n--; dir++) {
p = dir->name + strlen(dir->name) - 3;
if(strcmp(p, "raw") != 0)
continue;
s = smprint("/dev/pci/%s", dir->name);
fd = open(s, OREAD);
if(fd < 0) {
fprint(2, "open %s: %r", s);
free(s);
continue;
}
if(pcicfg16r(fd, &sh, 0) < 0) goto err;
if(sh == 0xFFFF) goto end;
if(pcicfg16r(fd, &sh, 0x06) < 0) goto err;
if((sh & (1<<4)) == 0) goto end;
cap = 0x33;
for(;;) {
if(pread(fd, &cap, 1, cap+1) < 0) goto err;
if(cap == 0) goto end;
if(pread(fd, &c, 1, cap) < 0) goto err;
if(c == 0x05) break;
}
s[strlen(s) - 3] = 0;
print("%s\n", s+9);
goto end;
err:
fprint(2, "read %s: %r", s);
end:
free(s);
close(fd);
}
}
|
