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
|
#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);
}
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];
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 && r.nb < MAX_DEVICES; dev = dev->next, r.nb++) {
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);
}
|
