2 * The PCI Library -- Capabilities
4 * Copyright (c) 2008 Martin Mares <mj@ucw.cz>
6 * Can be freely distributed and used under the terms of the GNU GPL.
14 pci_add_cap(struct pci_dev *d, unsigned int addr, unsigned int id, unsigned int type)
16 struct pci_cap *cap = pci_malloc(d->access, sizeof(*cap));
18 cap->next = d->first_cap;
23 d->access->debug("%04x:%02x:%02x.%d: Found capability %04x of type %d at %04x\n",
24 d->domain, d->bus, d->dev, d->func, id, type, addr);
28 pci_scan_trad_caps(struct pci_dev *d)
30 word status = pci_read_word(d, PCI_STATUS);
34 if (!(status & PCI_STATUS_CAP_LIST))
37 memset(been_there, 0, 256);
38 where = pci_read_byte(d, PCI_CAPABILITY_LIST) & ~3;
41 byte id = pci_read_byte(d, where + PCI_CAP_LIST_ID);
42 byte next = pci_read_byte(d, where + PCI_CAP_LIST_NEXT) & ~3;
43 if (been_there[where]++)
47 pci_add_cap(d, where, id, PCI_CAP_NORMAL);
53 pci_scan_ext_caps(struct pci_dev *d)
55 byte been_there[0x1000];
58 if (!pci_find_cap(d, PCI_CAP_ID_EXP, PCI_CAP_NORMAL))
61 memset(been_there, 0, 0x1000);
67 header = pci_read_long(d, where);
68 if (!header || header == 0xffffffff)
71 if (been_there[where]++)
73 pci_add_cap(d, where, id, PCI_CAP_EXTENDED);
74 where = (header >> 20) & ~3;
80 pci_scan_caps(struct pci_dev *d, unsigned int want_fields)
82 if ((want_fields & PCI_FILL_EXT_CAPS) && !(d->known_fields & PCI_FILL_CAPS))
83 want_fields |= PCI_FILL_CAPS;
85 if (want_fields & PCI_FILL_CAPS)
86 pci_scan_trad_caps(d);
87 if (want_fields & PCI_FILL_EXT_CAPS)
93 pci_free_caps(struct pci_dev *d)
97 while (cap = d->first_cap)
99 d->first_cap = cap->next;
105 pci_find_cap(struct pci_dev *d, unsigned int id, unsigned int type)
107 return pci_find_cap_nr(d, id, type, NULL);
111 * Finds a particular capability of a device
113 * To select one capability if there are more than one with the same id, you
114 * can provide a pointer to an unsigned int that contains the index which you
115 * want as cap_number. If you don't care and are fine with the first one you
116 * can supply NULL. The cap_number will be replaced by the acutal number
117 * of capablities with that id.
120 pci_find_cap_nr(struct pci_dev *d, unsigned int id, unsigned int type,
121 unsigned int *cap_number)
124 struct pci_cap *found = NULL;
125 unsigned int target = (cap_number ? *cap_number : 0);
126 unsigned int index = 0;
128 pci_fill_info_v35(d, ((type == PCI_CAP_NORMAL) ? PCI_FILL_CAPS : PCI_FILL_EXT_CAPS));
130 for (c=d->first_cap; c; c=c->next)
132 if (c->type == type && c->id == id)