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
|
/*
* The PCI Library -- Device Filtering
*
* Copyright (c) 1998--2003 Martin Mares <mj@ucw.cz>
*
* Can be freely distributed and used under the terms of the GNU GPL.
*/
#include <stdlib.h>
#include <string.h>
#include "internal.h"
void
pci_filter_init(struct pci_access *a UNUSED, struct pci_filter *f)
{
f->domain = f->bus = f->slot = f->func = -1;
f->vendor = f->device = -1;
}
/* Slot filter syntax: [[[domain]:][bus]:][slot][.[func]] */
char *
pci_filter_parse_slot(struct pci_filter *f, char *str)
{
char *colon = strrchr(str, ':');
char *dot = strchr((colon ? colon + 1 : str), '.');
char *mid = str;
char *e, *bus, *colon2;
if (colon)
{
*colon++ = 0;
mid = colon;
colon2 = strchr(str, ':');
if (colon2)
{
*colon2++ = 0;
bus = colon2;
if (str[0] && strcmp(str, "*"))
{
long int x = strtol(str, &e, 16);
if ((e && *e) || (x < 0 || x > 0xffff))
return "Invalid domain number";
f->domain = x;
}
}
else
bus = str;
if (bus[0] && strcmp(bus, "*"))
{
long int x = strtol(bus, &e, 16);
if ((e && *e) || (x < 0 || x > 0xff))
return "Invalid bus number";
f->bus = x;
}
}
if (dot)
*dot++ = 0;
if (mid[0] && strcmp(mid, "*"))
{
long int x = strtol(mid, &e, 16);
if ((e && *e) || (x < 0 || x > 0x1f))
return "Invalid slot number";
f->slot = x;
}
if (dot && dot[0] && strcmp(dot, "*"))
{
long int x = strtol(dot, &e, 16);
if ((e && *e) || (x < 0 || x > 7))
return "Invalid function number";
f->func = x;
}
return NULL;
}
/* ID filter syntax: [vendor]:[device] */
char *
pci_filter_parse_id(struct pci_filter *f, char *str)
{
char *s, *e;
if (!*str)
return NULL;
s = strchr(str, ':');
if (!s)
return "':' expected";
*s++ = 0;
if (str[0] && strcmp(str, "*"))
{
long int x = strtol(str, &e, 16);
if ((e && *e) || (x < 0 || x > 0xffff))
return "Invalid vendor ID";
f->vendor = x;
}
if (s[0] && strcmp(s, "*"))
{
long int x = strtol(s, &e, 16);
if ((e && *e) || (x < 0 || x > 0xffff))
return "Invalid device ID";
f->device = x;
}
return NULL;
}
int
pci_filter_match(struct pci_filter *f, struct pci_dev *d)
{
if ((f->domain >= 0 && f->domain != d->domain) ||
(f->bus >= 0 && f->bus != d->bus) ||
(f->slot >= 0 && f->slot != d->dev) ||
(f->func >= 0 && f->func != d->func))
return 0;
if (f->device >= 0 || f->vendor >= 0)
{
pci_fill_info_v32(d, PCI_FILL_IDENT);
if ((f->device >= 0 && f->device != d->device_id) ||
(f->vendor >= 0 && f->vendor != d->vendor_id))
return 0;
}
return 1;
}
|
