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
|
/*
* The PCI Library -- Capabilities
*
* Copyright (c) 2008 Martin Mares <mj@ucw.cz>
*
* Can be freely distributed and used under the terms of the GNU GPL.
*/
#include <string.h>
#include "internal.h"
static void
pci_add_cap(struct pci_dev *d, unsigned int addr, unsigned int id, unsigned int type)
{
struct pci_cap *cap = pci_malloc(d->access, sizeof(*cap));
cap->next = d->first_cap;
d->first_cap = cap;
cap->addr = addr;
cap->id = id;
cap->type = type;
d->access->debug("%04x:%02x:%02x.%d: Found capability %04x of type %d at %04x\n",
d->domain, d->bus, d->dev, d->func, id, type, addr);
}
static void
pci_scan_trad_caps(struct pci_dev *d)
{
word status = pci_read_word(d, PCI_STATUS);
byte been_there[256];
int where;
if (!(status & PCI_STATUS_CAP_LIST))
return;
memset(been_there, 0, 256);
where = pci_read_byte(d, PCI_CAPABILITY_LIST) & ~3;
while (where)
{
byte id = pci_read_byte(d, where + PCI_CAP_LIST_ID);
byte next = pci_read_byte(d, where + PCI_CAP_LIST_NEXT) & ~3;
if (been_there[where]++)
break;
if (id == 0xff)
break;
pci_add_cap(d, where, id, PCI_CAP_NORMAL);
where = next;
}
}
static void
pci_scan_ext_caps(struct pci_dev *d)
{
byte been_there[0x1000];
int where = 0x100;
if (!pci_find_cap(d, PCI_CAP_ID_EXP, PCI_CAP_NORMAL))
return;
memset(been_there, 0, 0x1000);
do
{
u32 header;
int id;
header = pci_read_long(d, where);
if (!header || header == 0xffffffff)
break;
id = header & 0xffff;
if (been_there[where]++)
break;
pci_add_cap(d, where, id, PCI_CAP_EXTENDED);
where = (header >> 20) & ~3;
}
while (where);
}
unsigned int
pci_scan_caps(struct pci_dev *d, unsigned int want_fields)
{
if ((want_fields & PCI_FILL_EXT_CAPS) && !(d->known_fields & PCI_FILL_CAPS))
want_fields |= PCI_FILL_CAPS;
if (want_fields & PCI_FILL_CAPS)
pci_scan_trad_caps(d);
if (want_fields & PCI_FILL_EXT_CAPS)
pci_scan_ext_caps(d);
return want_fields;
}
void
pci_free_caps(struct pci_dev *d)
{
struct pci_cap *cap;
while (cap = d->first_cap)
{
d->first_cap = cap->next;
pci_mfree(cap);
}
}
struct pci_cap *
pci_find_cap(struct pci_dev *d, unsigned int id, unsigned int type)
{
struct pci_cap *c;
pci_fill_info_v33(d, ((type == PCI_CAP_NORMAL) ? PCI_FILL_CAPS : PCI_FILL_EXT_CAPS));
for (c=d->first_cap; c; c=c->next)
if (c->type == type && c->id == id)
return c;
return NULL;
}
|
