xref: /aosp_15_r20/external/pciutils/lib/caps.c (revision c2e0c6b56a71da9abe8df5c8348fb3eb5c2c9251)
1*c2e0c6b5SAndroid Build Coastguard Worker /*
2*c2e0c6b5SAndroid Build Coastguard Worker  *	The PCI Library -- Capabilities
3*c2e0c6b5SAndroid Build Coastguard Worker  *
4*c2e0c6b5SAndroid Build Coastguard Worker  *	Copyright (c) 2008 Martin Mares <[email protected]>
5*c2e0c6b5SAndroid Build Coastguard Worker  *
6*c2e0c6b5SAndroid Build Coastguard Worker  *	Can be freely distributed and used under the terms of the GNU GPL v2+.
7*c2e0c6b5SAndroid Build Coastguard Worker  *
8*c2e0c6b5SAndroid Build Coastguard Worker  *	SPDX-License-Identifier: GPL-2.0-or-later
9*c2e0c6b5SAndroid Build Coastguard Worker  */
10*c2e0c6b5SAndroid Build Coastguard Worker 
11*c2e0c6b5SAndroid Build Coastguard Worker #include <string.h>
12*c2e0c6b5SAndroid Build Coastguard Worker 
13*c2e0c6b5SAndroid Build Coastguard Worker #include "internal.h"
14*c2e0c6b5SAndroid Build Coastguard Worker 
15*c2e0c6b5SAndroid Build Coastguard Worker static void
pci_add_cap(struct pci_dev * d,unsigned int addr,unsigned int id,unsigned int type)16*c2e0c6b5SAndroid Build Coastguard Worker pci_add_cap(struct pci_dev *d, unsigned int addr, unsigned int id, unsigned int type)
17*c2e0c6b5SAndroid Build Coastguard Worker {
18*c2e0c6b5SAndroid Build Coastguard Worker   struct pci_cap *cap = pci_malloc(d->access, sizeof(*cap));
19*c2e0c6b5SAndroid Build Coastguard Worker 
20*c2e0c6b5SAndroid Build Coastguard Worker   if (d->last_cap)
21*c2e0c6b5SAndroid Build Coastguard Worker     d->last_cap->next = cap;
22*c2e0c6b5SAndroid Build Coastguard Worker   else
23*c2e0c6b5SAndroid Build Coastguard Worker     d->first_cap = cap;
24*c2e0c6b5SAndroid Build Coastguard Worker   d->last_cap = cap;
25*c2e0c6b5SAndroid Build Coastguard Worker   cap->next = NULL;
26*c2e0c6b5SAndroid Build Coastguard Worker   cap->addr = addr;
27*c2e0c6b5SAndroid Build Coastguard Worker   cap->id = id;
28*c2e0c6b5SAndroid Build Coastguard Worker   cap->type = type;
29*c2e0c6b5SAndroid Build Coastguard Worker   d->access->debug("%04x:%02x:%02x.%d: Found capability %04x of type %d at %04x\n",
30*c2e0c6b5SAndroid Build Coastguard Worker     d->domain, d->bus, d->dev, d->func, id, type, addr);
31*c2e0c6b5SAndroid Build Coastguard Worker }
32*c2e0c6b5SAndroid Build Coastguard Worker 
33*c2e0c6b5SAndroid Build Coastguard Worker static void
pci_scan_trad_caps(struct pci_dev * d)34*c2e0c6b5SAndroid Build Coastguard Worker pci_scan_trad_caps(struct pci_dev *d)
35*c2e0c6b5SAndroid Build Coastguard Worker {
36*c2e0c6b5SAndroid Build Coastguard Worker   word status = pci_read_word(d, PCI_STATUS);
37*c2e0c6b5SAndroid Build Coastguard Worker   byte been_there[256];
38*c2e0c6b5SAndroid Build Coastguard Worker   int where;
39*c2e0c6b5SAndroid Build Coastguard Worker 
40*c2e0c6b5SAndroid Build Coastguard Worker   if (!(status & PCI_STATUS_CAP_LIST))
41*c2e0c6b5SAndroid Build Coastguard Worker     return;
42*c2e0c6b5SAndroid Build Coastguard Worker 
43*c2e0c6b5SAndroid Build Coastguard Worker   memset(been_there, 0, 256);
44*c2e0c6b5SAndroid Build Coastguard Worker   where = pci_read_byte(d, PCI_CAPABILITY_LIST) & ~3;
45*c2e0c6b5SAndroid Build Coastguard Worker   while (where)
46*c2e0c6b5SAndroid Build Coastguard Worker     {
47*c2e0c6b5SAndroid Build Coastguard Worker       byte id = pci_read_byte(d, where + PCI_CAP_LIST_ID);
48*c2e0c6b5SAndroid Build Coastguard Worker       byte next = pci_read_byte(d, where + PCI_CAP_LIST_NEXT) & ~3;
49*c2e0c6b5SAndroid Build Coastguard Worker       if (been_there[where]++)
50*c2e0c6b5SAndroid Build Coastguard Worker 	break;
51*c2e0c6b5SAndroid Build Coastguard Worker       if (id == 0xff)
52*c2e0c6b5SAndroid Build Coastguard Worker 	break;
53*c2e0c6b5SAndroid Build Coastguard Worker       pci_add_cap(d, where, id, PCI_CAP_NORMAL);
54*c2e0c6b5SAndroid Build Coastguard Worker       where = next;
55*c2e0c6b5SAndroid Build Coastguard Worker     }
56*c2e0c6b5SAndroid Build Coastguard Worker }
57*c2e0c6b5SAndroid Build Coastguard Worker 
58*c2e0c6b5SAndroid Build Coastguard Worker static void
pci_scan_ext_caps(struct pci_dev * d)59*c2e0c6b5SAndroid Build Coastguard Worker pci_scan_ext_caps(struct pci_dev *d)
60*c2e0c6b5SAndroid Build Coastguard Worker {
61*c2e0c6b5SAndroid Build Coastguard Worker   byte been_there[0x1000];
62*c2e0c6b5SAndroid Build Coastguard Worker   int where = 0x100;
63*c2e0c6b5SAndroid Build Coastguard Worker 
64*c2e0c6b5SAndroid Build Coastguard Worker   if (!pci_find_cap(d, PCI_CAP_ID_EXP, PCI_CAP_NORMAL))
65*c2e0c6b5SAndroid Build Coastguard Worker     return;
66*c2e0c6b5SAndroid Build Coastguard Worker 
67*c2e0c6b5SAndroid Build Coastguard Worker   memset(been_there, 0, 0x1000);
68*c2e0c6b5SAndroid Build Coastguard Worker   do
69*c2e0c6b5SAndroid Build Coastguard Worker     {
70*c2e0c6b5SAndroid Build Coastguard Worker       u32 header;
71*c2e0c6b5SAndroid Build Coastguard Worker       int id;
72*c2e0c6b5SAndroid Build Coastguard Worker 
73*c2e0c6b5SAndroid Build Coastguard Worker       header = pci_read_long(d, where);
74*c2e0c6b5SAndroid Build Coastguard Worker       if (!header || header == 0xffffffff)
75*c2e0c6b5SAndroid Build Coastguard Worker 	break;
76*c2e0c6b5SAndroid Build Coastguard Worker       id = header & 0xffff;
77*c2e0c6b5SAndroid Build Coastguard Worker       if (been_there[where]++)
78*c2e0c6b5SAndroid Build Coastguard Worker 	break;
79*c2e0c6b5SAndroid Build Coastguard Worker       pci_add_cap(d, where, id, PCI_CAP_EXTENDED);
80*c2e0c6b5SAndroid Build Coastguard Worker       where = (header >> 20) & ~3;
81*c2e0c6b5SAndroid Build Coastguard Worker     }
82*c2e0c6b5SAndroid Build Coastguard Worker   while (where);
83*c2e0c6b5SAndroid Build Coastguard Worker }
84*c2e0c6b5SAndroid Build Coastguard Worker 
85*c2e0c6b5SAndroid Build Coastguard Worker void
pci_scan_caps(struct pci_dev * d,unsigned int want_fields)86*c2e0c6b5SAndroid Build Coastguard Worker pci_scan_caps(struct pci_dev *d, unsigned int want_fields)
87*c2e0c6b5SAndroid Build Coastguard Worker {
88*c2e0c6b5SAndroid Build Coastguard Worker   if (want_fields & PCI_FILL_EXT_CAPS)
89*c2e0c6b5SAndroid Build Coastguard Worker     want_fields |= PCI_FILL_CAPS;
90*c2e0c6b5SAndroid Build Coastguard Worker 
91*c2e0c6b5SAndroid Build Coastguard Worker   if (want_fill(d, want_fields, PCI_FILL_CAPS))
92*c2e0c6b5SAndroid Build Coastguard Worker     pci_scan_trad_caps(d);
93*c2e0c6b5SAndroid Build Coastguard Worker   if (want_fill(d, want_fields, PCI_FILL_EXT_CAPS))
94*c2e0c6b5SAndroid Build Coastguard Worker     pci_scan_ext_caps(d);
95*c2e0c6b5SAndroid Build Coastguard Worker }
96*c2e0c6b5SAndroid Build Coastguard Worker 
97*c2e0c6b5SAndroid Build Coastguard Worker void
pci_free_caps(struct pci_dev * d)98*c2e0c6b5SAndroid Build Coastguard Worker pci_free_caps(struct pci_dev *d)
99*c2e0c6b5SAndroid Build Coastguard Worker {
100*c2e0c6b5SAndroid Build Coastguard Worker   struct pci_cap *cap;
101*c2e0c6b5SAndroid Build Coastguard Worker 
102*c2e0c6b5SAndroid Build Coastguard Worker   while (cap = d->first_cap)
103*c2e0c6b5SAndroid Build Coastguard Worker     {
104*c2e0c6b5SAndroid Build Coastguard Worker       d->first_cap = cap->next;
105*c2e0c6b5SAndroid Build Coastguard Worker       pci_mfree(cap);
106*c2e0c6b5SAndroid Build Coastguard Worker     }
107*c2e0c6b5SAndroid Build Coastguard Worker }
108*c2e0c6b5SAndroid Build Coastguard Worker 
109*c2e0c6b5SAndroid Build Coastguard Worker struct pci_cap *
pci_find_cap(struct pci_dev * d,unsigned int id,unsigned int type)110*c2e0c6b5SAndroid Build Coastguard Worker pci_find_cap(struct pci_dev *d, unsigned int id, unsigned int type)
111*c2e0c6b5SAndroid Build Coastguard Worker {
112*c2e0c6b5SAndroid Build Coastguard Worker   return pci_find_cap_nr(d, id, type, NULL);
113*c2e0c6b5SAndroid Build Coastguard Worker }
114*c2e0c6b5SAndroid Build Coastguard Worker 
115*c2e0c6b5SAndroid Build Coastguard Worker /**
116*c2e0c6b5SAndroid Build Coastguard Worker  * Finds a particular capability of a device
117*c2e0c6b5SAndroid Build Coastguard Worker  *
118*c2e0c6b5SAndroid Build Coastguard Worker  * To select one capability if there are more than one with the same id, you
119*c2e0c6b5SAndroid Build Coastguard Worker  * can provide a pointer to an unsigned int that contains the index which you
120*c2e0c6b5SAndroid Build Coastguard Worker  * want as cap_number. If you don't care and are fine with the first one you
121*c2e0c6b5SAndroid Build Coastguard Worker  * can supply NULL. The cap_number will be replaced by the actual number
122*c2e0c6b5SAndroid Build Coastguard Worker  * of capabilities with that id.
123*c2e0c6b5SAndroid Build Coastguard Worker  */
124*c2e0c6b5SAndroid Build Coastguard Worker struct pci_cap *
pci_find_cap_nr(struct pci_dev * d,unsigned int id,unsigned int type,unsigned int * cap_number)125*c2e0c6b5SAndroid Build Coastguard Worker pci_find_cap_nr(struct pci_dev *d, unsigned int id, unsigned int type,
126*c2e0c6b5SAndroid Build Coastguard Worker                 unsigned int *cap_number)
127*c2e0c6b5SAndroid Build Coastguard Worker {
128*c2e0c6b5SAndroid Build Coastguard Worker   struct pci_cap *c;
129*c2e0c6b5SAndroid Build Coastguard Worker   struct pci_cap *found = NULL;
130*c2e0c6b5SAndroid Build Coastguard Worker   unsigned int target = (cap_number ? *cap_number : 0);
131*c2e0c6b5SAndroid Build Coastguard Worker   unsigned int index = 0;
132*c2e0c6b5SAndroid Build Coastguard Worker 
133*c2e0c6b5SAndroid Build Coastguard Worker   pci_fill_info_v313(d, ((type == PCI_CAP_NORMAL) ? PCI_FILL_CAPS : PCI_FILL_EXT_CAPS));
134*c2e0c6b5SAndroid Build Coastguard Worker 
135*c2e0c6b5SAndroid Build Coastguard Worker   for (c=d->first_cap; c; c=c->next)
136*c2e0c6b5SAndroid Build Coastguard Worker     {
137*c2e0c6b5SAndroid Build Coastguard Worker       if (c->type == type && c->id == id)
138*c2e0c6b5SAndroid Build Coastguard Worker 	{
139*c2e0c6b5SAndroid Build Coastguard Worker 	  if (target == index)
140*c2e0c6b5SAndroid Build Coastguard Worker 	    found = c;
141*c2e0c6b5SAndroid Build Coastguard Worker 	  index++;
142*c2e0c6b5SAndroid Build Coastguard Worker 	}
143*c2e0c6b5SAndroid Build Coastguard Worker     }
144*c2e0c6b5SAndroid Build Coastguard Worker 
145*c2e0c6b5SAndroid Build Coastguard Worker   if (cap_number)
146*c2e0c6b5SAndroid Build Coastguard Worker     *cap_number = index;
147*c2e0c6b5SAndroid Build Coastguard Worker   return found;
148*c2e0c6b5SAndroid Build Coastguard Worker }
149