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
|
#define _GNU_SOURCE
#include <stdio.h>
#include <stdarg.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 <pci/header.h>
#include "common.h"
/* /proc files're 256 bytes but we only need first 64 bytes*/
#define CONFIG_SPACE_SIZE 64
static char *proc_pci_path_default = "/proc/bus/pci/devices";
char* proc_pci_path = NULL;
static void __attribute__((noreturn)) error_and_die(char *msg, ...)
{
va_list args;
va_start(args, msg);
fprintf(stderr, "%s: ", "lspcidrake");
vfprintf(stderr, msg, args);
fputc('\n', stderr);
exit(1);
}
static struct pci_access *pacc;
char* get_pci_description(int vendor_id, int device_id) {
char vendorbuf[128], devbuf[128];
char *buf = malloc(256);
if (!pacc) {
pacc = pci_alloc();
pci_init(pacc); /* Initialize the PCI library */
pacc->numeric_ids = 0;
pci_init(pacc);
}
asprintf(&buf, "%s|%s",
pci_lookup_name(pacc, vendorbuf, sizeof(vendorbuf), PCI_LOOKUP_VENDOR | PCI_LOOKUP_NO_NUMBERS, vendor_id, device_id),
pci_lookup_name(pacc, devbuf, sizeof(devbuf), PCI_LOOKUP_DEVICE, vendor_id, device_id)
);
//pci_cleanup(pacc); // only used by stage1's merge-pcitable.pl that doesn't care about leaking _one_ struct
return buf;
}
extern struct pciusb_entries pci_probe(void) {
u8 buf[CONFIG_SPACE_SIZE];
struct pciusb_entries r;
static struct pci_access *pacc;
struct pci_dev *dev;
char classbuf[128], vendorbuf[128], devbuf[128];
size_t allocated = MAX_DEVICES;
r.nb = 0;
if ((access(proc_pci_path_default, R_OK) != 0)
|| (proc_pci_path && (access(proc_pci_path_default, R_OK) != 0)))
return r;
pacc = pci_alloc();
if (proc_pci_path) {
pci_set_param(pacc, "proc.path", proc_pci_path);
}
pci_init(pacc);
pacc->error = error_and_die;
pci_scan_bus(pacc);
r.nb = 0;
r.entries = malloc(sizeof(struct pciusb_entry) * MAX_DEVICES);
for (dev = pacc->devices; dev; dev = dev->next, r.nb++) {
if (r.nb >= allocated) {
allocated = r.nb*2;
r.entries = realloc(r.entries, sizeof(struct pciusb_entry) * allocated);
}
struct pciusb_entry *e = &r.entries[r.nb];
memset(buf, 0, CONFIG_SPACE_SIZE); // make sure not to retrieve values from previous devices
pci_setup_cache(dev, (u8*)buf, CONFIG_SPACE_SIZE);
pci_read_block(dev, 0, buf, CONFIG_SPACE_SIZE);
pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_CLASS | PCI_FILL_CAPS);
pciusb_initialize(e);
asprintf(&e->text, "%s|%s",
pci_lookup_name(pacc, vendorbuf, sizeof(vendorbuf), PCI_LOOKUP_VENDOR, dev->vendor_id, dev->device_id),
pci_lookup_name(pacc, devbuf, sizeof(devbuf), PCI_LOOKUP_DEVICE, dev->vendor_id, dev->device_id)
);
pci_lookup_name(pacc, classbuf, sizeof(classbuf), PCI_LOOKUP_CLASS, dev->device_class),
e->class=strdup(classbuf);
e->vendor = dev->vendor_id;
e->device = dev->device_id;
e->pci_domain = dev->domain;
e->pci_bus = dev->bus;
e->pci_device = dev->dev;
e->pci_function = dev->func;
e->class_id = dev->device_class;
e->subvendor = pci_read_word(dev, PCI_SUBSYSTEM_VENDOR_ID);
e->subdevice = pci_read_word(dev, PCI_SUBSYSTEM_ID);
e->pci_revision = pci_read_byte(dev, PCI_REVISION_ID);
if ((e->subvendor == 0 && e->subdevice == 0) ||
(e->subvendor == e->vendor && e->subdevice == e->device)) {
e->subvendor = 0xffff;
e->subdevice = 0xffff;
}
if (pci_find_cap(dev,PCI_CAP_ID_EXP, PCI_CAP_NORMAL))
e->is_pciexpress = 1;
/* special case for realtek 8139 that has two drivers */
if (e->vendor == 0x10ec && e->device == 0x8139) {
if (e->pci_revision < 0x20)
e->module = strdup("8139too");
else
e->module = strdup("8139cp");
}
}
/* shrink to real size */
r.entries = realloc(r.entries, sizeof(struct pciusb_entry) * r.nb);
pci_cleanup(pacc);
if (pciusb_find_modules(&r, "pcitable", DO_NOT_LOAD, 1))
return r;
/* should not happen */
exit(1);
}
|
