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
|
#define _GNU_SOURCE
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <pci/pci.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <dirent.h>
#include "common.h"
static char *proc_pci_path_default = "/proc/bus/pci/devices";
char *proc_pci_path = NULL;
#define MAX_PCI_DOMAINS 256
static int pci_domains[MAX_PCI_DOMAINS] = { 0, };
static int probe_domains(void)
{
static int n_pci_domains = -1;
if (n_pci_domains == -1) {
int i;
DIR *dir;
n_pci_domains = 0;
for (i = 0; i < MAX_PCI_DOMAINS; i++)
pci_domains[i] = 0;
if ((dir = opendir("/proc/bus/pci")) != NULL) {
struct dirent *dent;
while ((dent = readdir(dir)) != NULL) {
int domain, bus, ret;
ret = sscanf(dent->d_name, "%x:%x", &domain, &bus);
if (ret == 2) {
if (domain < MAX_PCI_DOMAINS)
pci_domains[domain] = 1;
}
}
closedir(dir);
for (i = 0; i < MAX_PCI_DOMAINS; i++) {
if (pci_domains[i])
pci_domains[n_pci_domains++] = i;
}
}
}
return n_pci_domains;
}
extern struct pciusb_entries pci_probe(void) {
FILE *f; int devf;
char buf[BUF_SIZE];
unsigned short *bufi = (unsigned short *) &buf;
unsigned short devbusfn;
unsigned int id;
struct pciusb_entries r;
char file[32];
int n_pci_domains;
n_pci_domains = probe_domains();
r.nb = 0;
if (!(f = fopen(proc_pci_path ? proc_pci_path : proc_pci_path_default, "r"))) {
if (proc_pci_path) {
char *err_msg;
asprintf(&err_msg, "unable to open \"%s\"\n"
"You may have passed a wrong argument to the \"-p\" option.\n"
"fopen() sets errno to", proc_pci_path);
perror(err_msg);
free(err_msg);
}
r.nb = 0;
r.entries = NULL; // is that needed?
return r;
}
r.entries = malloc(sizeof(struct pciusb_entry) * MAX_DEVICES);
for (; fgets(buf, sizeof(buf) - 1, f) && r.nb < MAX_DEVICES; r.nb++) {
struct pciusb_entry *e = &r.entries[r.nb];
unsigned char class_prog = 0;
pciusb_initialize(e);
sscanf(buf, "%hx %x", &devbusfn, &id);
e->vendor = id >> 16;
e->device = id & 0xffff;
e->pci_bus = devbusfn >> 8;
e->pci_device = (devbusfn & 0xff) >> 3;
e->pci_function = (devbusfn & 0xff) & 0x07;
snprintf(file, sizeof(file), "/proc/bus/pci/%02x/%02x.%d", e->pci_bus, e->pci_device, e->pci_function);
if ((devf = open(file, O_RDONLY)) == -1) {
/* try with pci domains */
int found = 0;
if (n_pci_domains) {
int i;
for (i = 0; !found && i < n_pci_domains; i++) {
snprintf(file, sizeof(file), "/proc/bus/pci/%04x:%02x/%02x.%d", pci_domains[i], e->pci_bus, e->pci_device, e->pci_function);
if ((devf = open(file, O_RDONLY)) >= 0)
found = 1;
}
}
if (!found)
continue;
}
read(devf, &buf, 0x30); /* these files're 256 bytes but we only need first 48 bytes*/
e->class_ = bufi[0x5];
e->subvendor = bufi[0x16];
e->subdevice = bufi[0x17];
if ((e->subvendor == 0 && e->subdevice == 0) ||
(e->subvendor == e->vendor && e->subdevice == e->device)) {
e->subvendor = 0xffff;
e->subdevice = 0xffff;
}
class_prog = buf[0x9];
/* special rules below must be in sync with gi/mdk-stage1/probing.c */
if (e->class_ == PCI_CLASS_SERIAL_USB) {
/* taken from kudzu's pci.c */
char *module =
class_prog == 0 ? "usb-uhci" :
class_prog == 0x10 ? "usb-ohci" :
class_prog == 0x20 ? "ehci-hcd" : NULL;
if (module) e->module = strdup(module);
} else if (e->class_ == PCI_CLASS_SERIAL_FIREWIRE) {
/* taken from kudzu's pci.c */
if (class_prog == 0x10) e->module = strdup("ohci1394");
} else if (e->class_ == PCI_CLASS_BRIDGE_CARDBUS) {
e->module = strdup("yenta_socket");
} else if (e->class_ == (PCI_CLASS_BRIDGE_HOST << 8)) { /* AGP */
if (e->vendor == 0x10b9)
e->module = strdup("ali-agp");
else if (e->vendor == 0x1002)
e->module = strdup("ati-agp");
else if (e->vendor == 0x1039)
e->module = strdup("sis-agp");
else if (e->vendor == 0x1166)
e->module = strdup("sworks-agp");
else if (e->vendor == 0x1279)
e->module = strdup("efficeon-agp");
} else if (e->device == 0x8139) {
if (e->subvendor == 0x8139 && e->subdevice == 0x10ec
|| e->subvendor == 0x1186 && e->subdevice == 0x1300
|| e->subvendor == 0x13d1 && e->subdevice == 0xab06)
e->module = strdup("8139too");
} else if (e->vendor == 0x10de && e->class_ == PCI_CLASS_STORAGE_IDE) {
e->module = strdup("sata_nv");
} else if (e->vendor == 0x10b5 && (e->device == 0x9030 || e->device == 0x9050) && e->subvendor == 0x1369) {
e->module = strdup("snd-vx222");
} else if (e->vendor == 0x1119) { /* Vortex only makes RAID controllers. */
e->module = strdup("gdth");
}
close(devf);
}
fclose(f);
realloc(r.entries, sizeof(struct pciusb_entry) * r.nb);
if (pciusb_find_modules(&r, "pcitable"))
return r;
/* should not happen */
exit(1);
}
|
