xref: /freebsd/usr.sbin/pciconf/cap.c (revision 7cc42f6d)
1 /*-
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright (c) 2007 Yahoo!, Inc.
5  * All rights reserved.
6  * Written by: John Baldwin <jhb@FreeBSD.org>
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. Neither the name of the author nor the names of any co-contributors
17  *    may be used to endorse or promote products derived from this software
18  *    without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30  * SUCH DAMAGE.
31  */
32 
33 #ifndef lint
34 static const char rcsid[] =
35   "$FreeBSD$";
36 #endif /* not lint */
37 
38 #include <sys/types.h>
39 
40 #include <err.h>
41 #include <stdio.h>
42 #include <strings.h>
43 #include <sys/agpio.h>
44 #include <sys/pciio.h>
45 
46 #include <dev/agp/agpreg.h>
47 #include <dev/pci/pcireg.h>
48 
49 #include "pciconf.h"
50 
51 static void	list_ecaps(int fd, struct pci_conf *p);
52 
53 static int cap_level;
54 
55 static void
56 cap_power(int fd, struct pci_conf *p, uint8_t ptr)
57 {
58 	uint16_t cap, status;
59 
60 	cap = read_config(fd, &p->pc_sel, ptr + PCIR_POWER_CAP, 2);
61 	status = read_config(fd, &p->pc_sel, ptr + PCIR_POWER_STATUS, 2);
62 	printf("powerspec %d  supports D0%s%s D3  current D%d",
63 	    cap & PCIM_PCAP_SPEC,
64 	    cap & PCIM_PCAP_D1SUPP ? " D1" : "",
65 	    cap & PCIM_PCAP_D2SUPP ? " D2" : "",
66 	    status & PCIM_PSTAT_DMASK);
67 }
68 
69 static void
70 cap_agp(int fd, struct pci_conf *p, uint8_t ptr)
71 {
72 	uint32_t status, command;
73 
74 	status = read_config(fd, &p->pc_sel, ptr + AGP_STATUS, 4);
75 	command = read_config(fd, &p->pc_sel, ptr + AGP_CAPID, 4);
76 	printf("AGP ");
77 	if (AGP_MODE_GET_MODE_3(status)) {
78 		printf("v3 ");
79 		if (AGP_MODE_GET_RATE(status) & AGP_MODE_V3_RATE_8x)
80 			printf("8x ");
81 		if (AGP_MODE_GET_RATE(status) & AGP_MODE_V3_RATE_4x)
82 			printf("4x ");
83 	} else {
84 		if (AGP_MODE_GET_RATE(status) & AGP_MODE_V2_RATE_4x)
85 			printf("4x ");
86 		if (AGP_MODE_GET_RATE(status) & AGP_MODE_V2_RATE_2x)
87 			printf("2x ");
88 		if (AGP_MODE_GET_RATE(status) & AGP_MODE_V2_RATE_1x)
89 			printf("1x ");
90 	}
91 	if (AGP_MODE_GET_SBA(status))
92 		printf("SBA ");
93 	if (AGP_MODE_GET_AGP(command)) {
94 		printf("enabled at ");
95 		if (AGP_MODE_GET_MODE_3(command)) {
96 			printf("v3 ");
97 			switch (AGP_MODE_GET_RATE(command)) {
98 			case AGP_MODE_V3_RATE_8x:
99 				printf("8x ");
100 				break;
101 			case AGP_MODE_V3_RATE_4x:
102 				printf("4x ");
103 				break;
104 			}
105 		} else
106 			switch (AGP_MODE_GET_RATE(command)) {
107 			case AGP_MODE_V2_RATE_4x:
108 				printf("4x ");
109 				break;
110 			case AGP_MODE_V2_RATE_2x:
111 				printf("2x ");
112 				break;
113 			case AGP_MODE_V2_RATE_1x:
114 				printf("1x ");
115 				break;
116 			}
117 		if (AGP_MODE_GET_SBA(command))
118 			printf("SBA ");
119 	} else
120 		printf("disabled");
121 }
122 
123 static void
124 cap_vpd(int fd __unused, struct pci_conf *p __unused, uint8_t ptr __unused)
125 {
126 
127 	printf("VPD");
128 }
129 
130 static void
131 cap_msi(int fd, struct pci_conf *p, uint8_t ptr)
132 {
133 	uint16_t ctrl;
134 	int msgnum;
135 
136 	ctrl = read_config(fd, &p->pc_sel, ptr + PCIR_MSI_CTRL, 2);
137 	msgnum = 1 << ((ctrl & PCIM_MSICTRL_MMC_MASK) >> 1);
138 	printf("MSI supports %d message%s%s%s ", msgnum,
139 	    (msgnum == 1) ? "" : "s",
140 	    (ctrl & PCIM_MSICTRL_64BIT) ? ", 64 bit" : "",
141 	    (ctrl & PCIM_MSICTRL_VECTOR) ? ", vector masks" : "");
142 	if (ctrl & PCIM_MSICTRL_MSI_ENABLE) {
143 		msgnum = 1 << ((ctrl & PCIM_MSICTRL_MME_MASK) >> 4);
144 		printf("enabled with %d message%s", msgnum,
145 		    (msgnum == 1) ? "" : "s");
146 	}
147 }
148 
149 static void
150 cap_pcix(int fd, struct pci_conf *p, uint8_t ptr)
151 {
152 	uint32_t status;
153 	int comma, max_splits, max_burst_read;
154 
155 	status = read_config(fd, &p->pc_sel, ptr + PCIXR_STATUS, 4);
156 	printf("PCI-X ");
157 	if (status & PCIXM_STATUS_64BIT)
158 		printf("64-bit ");
159 	if ((p->pc_hdr & PCIM_HDRTYPE) == 1)
160 		printf("bridge ");
161 	if ((p->pc_hdr & PCIM_HDRTYPE) != 1 || (status & (PCIXM_STATUS_133CAP |
162 	    PCIXM_STATUS_266CAP | PCIXM_STATUS_533CAP)) != 0)
163 		printf("supports");
164 	comma = 0;
165 	if (status & PCIXM_STATUS_133CAP) {
166 		printf(" 133MHz");
167 		comma = 1;
168 	}
169 	if (status & PCIXM_STATUS_266CAP) {
170 		printf("%s 266MHz", comma ? "," : "");
171 		comma = 1;
172 	}
173 	if (status & PCIXM_STATUS_533CAP) {
174 		printf("%s 533MHz", comma ? "," : "");
175 		comma = 1;
176 	}
177 	if ((p->pc_hdr & PCIM_HDRTYPE) == 1)
178 		return;
179 	max_burst_read = 0;
180 	switch (status & PCIXM_STATUS_MAX_READ) {
181 	case PCIXM_STATUS_MAX_READ_512:
182 		max_burst_read = 512;
183 		break;
184 	case PCIXM_STATUS_MAX_READ_1024:
185 		max_burst_read = 1024;
186 		break;
187 	case PCIXM_STATUS_MAX_READ_2048:
188 		max_burst_read = 2048;
189 		break;
190 	case PCIXM_STATUS_MAX_READ_4096:
191 		max_burst_read = 4096;
192 		break;
193 	}
194 	max_splits = 0;
195 	switch (status & PCIXM_STATUS_MAX_SPLITS) {
196 	case PCIXM_STATUS_MAX_SPLITS_1:
197 		max_splits = 1;
198 		break;
199 	case PCIXM_STATUS_MAX_SPLITS_2:
200 		max_splits = 2;
201 		break;
202 	case PCIXM_STATUS_MAX_SPLITS_3:
203 		max_splits = 3;
204 		break;
205 	case PCIXM_STATUS_MAX_SPLITS_4:
206 		max_splits = 4;
207 		break;
208 	case PCIXM_STATUS_MAX_SPLITS_8:
209 		max_splits = 8;
210 		break;
211 	case PCIXM_STATUS_MAX_SPLITS_12:
212 		max_splits = 12;
213 		break;
214 	case PCIXM_STATUS_MAX_SPLITS_16:
215 		max_splits = 16;
216 		break;
217 	case PCIXM_STATUS_MAX_SPLITS_32:
218 		max_splits = 32;
219 		break;
220 	}
221 	printf("%s %d burst read, %d split transaction%s", comma ? "," : "",
222 	    max_burst_read, max_splits, max_splits == 1 ? "" : "s");
223 }
224 
225 static void
226 cap_ht(int fd, struct pci_conf *p, uint8_t ptr)
227 {
228 	uint32_t reg;
229 	uint16_t command;
230 
231 	command = read_config(fd, &p->pc_sel, ptr + PCIR_HT_COMMAND, 2);
232 	printf("HT ");
233 	if ((command & 0xe000) == PCIM_HTCAP_SLAVE)
234 		printf("slave");
235 	else if ((command & 0xe000) == PCIM_HTCAP_HOST)
236 		printf("host");
237 	else
238 		switch (command & PCIM_HTCMD_CAP_MASK) {
239 		case PCIM_HTCAP_SWITCH:
240 			printf("switch");
241 			break;
242 		case PCIM_HTCAP_INTERRUPT:
243 			printf("interrupt");
244 			break;
245 		case PCIM_HTCAP_REVISION_ID:
246 			printf("revision ID");
247 			break;
248 		case PCIM_HTCAP_UNITID_CLUMPING:
249 			printf("unit ID clumping");
250 			break;
251 		case PCIM_HTCAP_EXT_CONFIG_SPACE:
252 			printf("extended config space");
253 			break;
254 		case PCIM_HTCAP_ADDRESS_MAPPING:
255 			printf("address mapping");
256 			break;
257 		case PCIM_HTCAP_MSI_MAPPING:
258 			printf("MSI %saddress window %s at 0x",
259 			    command & PCIM_HTCMD_MSI_FIXED ? "fixed " : "",
260 			    command & PCIM_HTCMD_MSI_ENABLE ? "enabled" :
261 			    "disabled");
262 			if (command & PCIM_HTCMD_MSI_FIXED)
263 				printf("fee00000");
264 			else {
265 				reg = read_config(fd, &p->pc_sel,
266 				    ptr + PCIR_HTMSI_ADDRESS_HI, 4);
267 				if (reg != 0)
268 					printf("%08x", reg);
269 				reg = read_config(fd, &p->pc_sel,
270 				    ptr + PCIR_HTMSI_ADDRESS_LO, 4);
271 				printf("%08x", reg);
272 			}
273 			break;
274 		case PCIM_HTCAP_DIRECT_ROUTE:
275 			printf("direct route");
276 			break;
277 		case PCIM_HTCAP_VCSET:
278 			printf("VC set");
279 			break;
280 		case PCIM_HTCAP_RETRY_MODE:
281 			printf("retry mode");
282 			break;
283 		case PCIM_HTCAP_X86_ENCODING:
284 			printf("X86 encoding");
285 			break;
286 		case PCIM_HTCAP_GEN3:
287 			printf("Gen3");
288 			break;
289 		case PCIM_HTCAP_FLE:
290 			printf("function-level extension");
291 			break;
292 		case PCIM_HTCAP_PM:
293 			printf("power management");
294 			break;
295 		case PCIM_HTCAP_HIGH_NODE_COUNT:
296 			printf("high node count");
297 			break;
298 		default:
299 			printf("unknown %02x", command);
300 			break;
301 		}
302 }
303 
304 static void
305 cap_vendor(int fd, struct pci_conf *p, uint8_t ptr)
306 {
307 	uint8_t length;
308 
309 	length = read_config(fd, &p->pc_sel, ptr + PCIR_VENDOR_LENGTH, 1);
310 	printf("vendor (length %d)", length);
311 	if (p->pc_vendor == 0x8086) {
312 		/* Intel */
313 		uint8_t version;
314 
315 		version = read_config(fd, &p->pc_sel, ptr + PCIR_VENDOR_DATA,
316 		    1);
317 		printf(" Intel cap %d version %d", version >> 4, version & 0xf);
318 		if (version >> 4 == 1 && length == 12) {
319 			/* Feature Detection */
320 			uint32_t fvec;
321 			int comma;
322 
323 			comma = 0;
324 			fvec = read_config(fd, &p->pc_sel, ptr +
325 			    PCIR_VENDOR_DATA + 5, 4);
326 			printf("\n\t\t features:");
327 			if (fvec & (1 << 0)) {
328 				printf(" AMT");
329 				comma = 1;
330 			}
331 			fvec = read_config(fd, &p->pc_sel, ptr +
332 			    PCIR_VENDOR_DATA + 1, 4);
333 			if (fvec & (1 << 21)) {
334 				printf("%s Quick Resume", comma ? "," : "");
335 				comma = 1;
336 			}
337 			if (fvec & (1 << 18)) {
338 				printf("%s SATA RAID-5", comma ? "," : "");
339 				comma = 1;
340 			}
341 			if (fvec & (1 << 9)) {
342 				printf("%s Mobile", comma ? "," : "");
343 				comma = 1;
344 			}
345 			if (fvec & (1 << 7)) {
346 				printf("%s 6 PCI-e x1 slots", comma ? "," : "");
347 				comma = 1;
348 			} else {
349 				printf("%s 4 PCI-e x1 slots", comma ? "," : "");
350 				comma = 1;
351 			}
352 			if (fvec & (1 << 5)) {
353 				printf("%s SATA RAID-0/1/10", comma ? "," : "");
354 				comma = 1;
355 			}
356 			if (fvec & (1 << 3))
357 				printf(", SATA AHCI");
358 		}
359 	}
360 }
361 
362 static void
363 cap_debug(int fd, struct pci_conf *p, uint8_t ptr)
364 {
365 	uint16_t debug_port;
366 
367 	debug_port = read_config(fd, &p->pc_sel, ptr + PCIR_DEBUG_PORT, 2);
368 	printf("EHCI Debug Port at offset 0x%x in map 0x%x", debug_port &
369 	    PCIM_DEBUG_PORT_OFFSET, PCIR_BAR(debug_port >> 13));
370 }
371 
372 static void
373 cap_subvendor(int fd, struct pci_conf *p, uint8_t ptr)
374 {
375 	uint32_t id;
376 	uint16_t ssid, ssvid;
377 
378 	id = read_config(fd, &p->pc_sel, ptr + PCIR_SUBVENDCAP_ID, 4);
379 	ssid = id >> 16;
380 	ssvid = id & 0xffff;
381 	printf("PCI Bridge subvendor=0x%04x subdevice=0x%04x", ssvid, ssid);
382 }
383 
384 #define	MAX_PAYLOAD(field)		(128 << (field))
385 
386 static const char *
387 link_speed_string(uint8_t speed)
388 {
389 
390 	switch (speed) {
391 	case 1:
392 		return ("2.5");
393 	case 2:
394 		return ("5.0");
395 	case 3:
396 		return ("8.0");
397 	case 4:
398 		return ("16.0");
399 	default:
400 		return ("undef");
401 	}
402 }
403 
404 static const char *
405 max_read_string(u_int max_read)
406 {
407 
408 	switch (max_read) {
409 	case 0x0:
410 		return ("128");
411 	case 0x1:
412 		return ("256");
413 	case 0x2:
414 		return ("512");
415 	case 0x3:
416 		return ("1024");
417 	case 0x4:
418 		return ("2048");
419 	case 0x5:
420 		return ("4096");
421 	default:
422 		return ("undef");
423 	}
424 }
425 
426 static const char *
427 aspm_string(uint8_t aspm)
428 {
429 
430 	switch (aspm) {
431 	case 1:
432 		return ("L0s");
433 	case 2:
434 		return ("L1");
435 	case 3:
436 		return ("L0s/L1");
437 	default:
438 		return ("disabled");
439 	}
440 }
441 
442 static int
443 slot_power(uint32_t cap)
444 {
445 	int mwatts;
446 
447 	mwatts = (cap & PCIEM_SLOT_CAP_SPLV) >> 7;
448 	switch (cap & PCIEM_SLOT_CAP_SPLS) {
449 	case 0x0:
450 		mwatts *= 1000;
451 		break;
452 	case 0x1:
453 		mwatts *= 100;
454 		break;
455 	case 0x2:
456 		mwatts *= 10;
457 		break;
458 	default:
459 		break;
460 	}
461 	return (mwatts);
462 }
463 
464 static void
465 cap_express(int fd, struct pci_conf *p, uint8_t ptr)
466 {
467 	uint32_t cap;
468 	uint16_t ctl, flags, sta;
469 	unsigned int version;
470 
471 	flags = read_config(fd, &p->pc_sel, ptr + PCIER_FLAGS, 2);
472 	version = flags & PCIEM_FLAGS_VERSION;
473 	printf("PCI-Express %u ", version);
474 	switch (flags & PCIEM_FLAGS_TYPE) {
475 	case PCIEM_TYPE_ENDPOINT:
476 		printf("endpoint");
477 		break;
478 	case PCIEM_TYPE_LEGACY_ENDPOINT:
479 		printf("legacy endpoint");
480 		break;
481 	case PCIEM_TYPE_ROOT_PORT:
482 		printf("root port");
483 		break;
484 	case PCIEM_TYPE_UPSTREAM_PORT:
485 		printf("upstream port");
486 		break;
487 	case PCIEM_TYPE_DOWNSTREAM_PORT:
488 		printf("downstream port");
489 		break;
490 	case PCIEM_TYPE_PCI_BRIDGE:
491 		printf("PCI bridge");
492 		break;
493 	case PCIEM_TYPE_PCIE_BRIDGE:
494 		printf("PCI to PCIe bridge");
495 		break;
496 	case PCIEM_TYPE_ROOT_INT_EP:
497 		printf("root endpoint");
498 		break;
499 	case PCIEM_TYPE_ROOT_EC:
500 		printf("event collector");
501 		break;
502 	default:
503 		printf("type %d", (flags & PCIEM_FLAGS_TYPE) >> 4);
504 		break;
505 	}
506 	if (flags & PCIEM_FLAGS_IRQ)
507 		printf(" MSI %d", (flags & PCIEM_FLAGS_IRQ) >> 9);
508 	cap = read_config(fd, &p->pc_sel, ptr + PCIER_DEVICE_CAP, 4);
509 	ctl = read_config(fd, &p->pc_sel, ptr + PCIER_DEVICE_CTL, 2);
510 	printf(" max data %d(%d)",
511 	    MAX_PAYLOAD((ctl & PCIEM_CTL_MAX_PAYLOAD) >> 5),
512 	    MAX_PAYLOAD(cap & PCIEM_CAP_MAX_PAYLOAD));
513 	if ((cap & PCIEM_CAP_FLR) != 0)
514 		printf(" FLR");
515 	if (ctl & PCIEM_CTL_RELAXED_ORD_ENABLE)
516 		printf(" RO");
517 	if (ctl & PCIEM_CTL_NOSNOOP_ENABLE)
518 		printf(" NS");
519 	if (version >= 2) {
520 		cap = read_config(fd, &p->pc_sel, ptr + PCIER_DEVICE_CAP2, 4);
521 		if ((cap & PCIEM_CAP2_ARI) != 0) {
522 			ctl = read_config(fd, &p->pc_sel,
523 			    ptr + PCIER_DEVICE_CTL2, 4);
524 			printf(" ARI %s",
525 			    (ctl & PCIEM_CTL2_ARI) ? "enabled" : "disabled");
526 		}
527 	}
528 	printf("\n                 max read %s", max_read_string((ctl &
529 	    PCIEM_CTL_MAX_READ_REQUEST) >> 12));
530 	cap = read_config(fd, &p->pc_sel, ptr + PCIER_LINK_CAP, 4);
531 	sta = read_config(fd, &p->pc_sel, ptr + PCIER_LINK_STA, 2);
532 	if (cap == 0 && sta == 0)
533 		return;
534 	printf("\n                ");
535 	printf(" link x%d(x%d)", (sta & PCIEM_LINK_STA_WIDTH) >> 4,
536 	    (cap & PCIEM_LINK_CAP_MAX_WIDTH) >> 4);
537 	if ((cap & PCIEM_LINK_CAP_MAX_WIDTH) != 0) {
538 		printf(" speed %s(%s)", (sta & PCIEM_LINK_STA_WIDTH) == 0 ?
539 		    "0.0" : link_speed_string(sta & PCIEM_LINK_STA_SPEED),
540 	    	    link_speed_string(cap & PCIEM_LINK_CAP_MAX_SPEED));
541 	}
542 	if ((cap & PCIEM_LINK_CAP_ASPM) != 0) {
543 		ctl = read_config(fd, &p->pc_sel, ptr + PCIER_LINK_CTL, 2);
544 		printf(" ASPM %s(%s)", aspm_string(ctl & PCIEM_LINK_CTL_ASPMC),
545 		    aspm_string((cap & PCIEM_LINK_CAP_ASPM) >> 10));
546 	}
547 	if ((cap & PCIEM_LINK_CAP_CLOCK_PM) != 0) {
548 		ctl = read_config(fd, &p->pc_sel, ptr + PCIER_LINK_CTL, 2);
549 		printf(" ClockPM %s", (ctl & PCIEM_LINK_CTL_ECPM) ?
550 		    "enabled" : "disabled");
551 	}
552 	if (!(flags & PCIEM_FLAGS_SLOT))
553 		return;
554 	cap = read_config(fd, &p->pc_sel, ptr + PCIER_SLOT_CAP, 4);
555 	sta = read_config(fd, &p->pc_sel, ptr + PCIER_SLOT_STA, 2);
556 	ctl = read_config(fd, &p->pc_sel, ptr + PCIER_SLOT_CTL, 2);
557 	printf("\n                ");
558 	printf(" slot %d", (cap & PCIEM_SLOT_CAP_PSN) >> 19);
559 	printf(" power limit %d mW", slot_power(cap));
560 	if (cap & PCIEM_SLOT_CAP_HPC)
561 		printf(" HotPlug(%s)", sta & PCIEM_SLOT_STA_PDS ? "present" :
562 		    "empty");
563 	if (cap & PCIEM_SLOT_CAP_HPS)
564 		printf(" surprise");
565 	if (cap & PCIEM_SLOT_CAP_APB)
566 		printf(" Attn Button");
567 	if (cap & PCIEM_SLOT_CAP_PCP)
568 		printf(" PC(%s)", ctl & PCIEM_SLOT_CTL_PCC ? "off" : "on");
569 	if (cap & PCIEM_SLOT_CAP_MRLSP)
570 		printf(" MRL(%s)", sta & PCIEM_SLOT_STA_MRLSS ? "open" :
571 		    "closed");
572 	if (cap & PCIEM_SLOT_CAP_EIP)
573 		printf(" EI(%s)", sta & PCIEM_SLOT_STA_EIS ? "engaged" :
574 		    "disengaged");
575 }
576 
577 static void
578 cap_msix(int fd, struct pci_conf *p, uint8_t ptr)
579 {
580 	uint32_t pba_offset, table_offset, val;
581 	int msgnum, pba_bar, table_bar;
582 	uint16_t ctrl;
583 
584 	ctrl = read_config(fd, &p->pc_sel, ptr + PCIR_MSIX_CTRL, 2);
585 	msgnum = (ctrl & PCIM_MSIXCTRL_TABLE_SIZE) + 1;
586 
587 	val = read_config(fd, &p->pc_sel, ptr + PCIR_MSIX_TABLE, 4);
588 	table_bar = PCIR_BAR(val & PCIM_MSIX_BIR_MASK);
589 	table_offset = val & ~PCIM_MSIX_BIR_MASK;
590 
591 	val = read_config(fd, &p->pc_sel, ptr + PCIR_MSIX_PBA, 4);
592 	pba_bar = PCIR_BAR(val & PCIM_MSIX_BIR_MASK);
593 	pba_offset = val & ~PCIM_MSIX_BIR_MASK;
594 
595 	printf("MSI-X supports %d message%s%s\n", msgnum,
596 	    (msgnum == 1) ? "" : "s",
597 	    (ctrl & PCIM_MSIXCTRL_MSIX_ENABLE) ? ", enabled" : "");
598 
599 	printf("                 ");
600 	printf("Table in map 0x%x[0x%x], PBA in map 0x%x[0x%x]",
601 	    table_bar, table_offset, pba_bar, pba_offset);
602 }
603 
604 static void
605 cap_sata(int fd __unused, struct pci_conf *p __unused, uint8_t ptr __unused)
606 {
607 
608 	printf("SATA Index-Data Pair");
609 }
610 
611 static void
612 cap_pciaf(int fd, struct pci_conf *p, uint8_t ptr)
613 {
614 	uint8_t cap;
615 
616 	cap = read_config(fd, &p->pc_sel, ptr + PCIR_PCIAF_CAP, 1);
617 	printf("PCI Advanced Features:%s%s",
618 	    cap & PCIM_PCIAFCAP_FLR ? " FLR" : "",
619 	    cap & PCIM_PCIAFCAP_TP  ? " TP"  : "");
620 }
621 
622 static const char *
623 ea_bei_to_name(int bei)
624 {
625 	static const char *barstr[] = {
626 		"BAR0", "BAR1", "BAR2", "BAR3", "BAR4", "BAR5"
627 	};
628 	static const char *vfbarstr[] = {
629 		"VFBAR0", "VFBAR1", "VFBAR2", "VFBAR3", "VFBAR4", "VFBAR5"
630 	};
631 
632 	if ((bei >= PCIM_EA_BEI_BAR_0) && (bei <= PCIM_EA_BEI_BAR_5))
633 		return (barstr[bei - PCIM_EA_BEI_BAR_0]);
634 	if ((bei >= PCIM_EA_BEI_VF_BAR_0) && (bei <= PCIM_EA_BEI_VF_BAR_5))
635 		return (vfbarstr[bei - PCIM_EA_BEI_VF_BAR_0]);
636 
637 	switch (bei) {
638 	case PCIM_EA_BEI_BRIDGE:
639 		return "BRIDGE";
640 	case PCIM_EA_BEI_ENI:
641 		return "ENI";
642 	case PCIM_EA_BEI_ROM:
643 		return "ROM";
644 	case PCIM_EA_BEI_RESERVED:
645 	default:
646 		return "RSVD";
647 	}
648 }
649 
650 static const char *
651 ea_prop_to_name(uint8_t prop)
652 {
653 
654 	switch (prop) {
655 	case PCIM_EA_P_MEM:
656 		return "Non-Prefetchable Memory";
657 	case PCIM_EA_P_MEM_PREFETCH:
658 		return "Prefetchable Memory";
659 	case PCIM_EA_P_IO:
660 		return "I/O Space";
661 	case PCIM_EA_P_VF_MEM_PREFETCH:
662 		return "VF Prefetchable Memory";
663 	case PCIM_EA_P_VF_MEM:
664 		return "VF Non-Prefetchable Memory";
665 	case PCIM_EA_P_BRIDGE_MEM:
666 		return "Bridge Non-Prefetchable Memory";
667 	case PCIM_EA_P_BRIDGE_MEM_PREFETCH:
668 		return "Bridge Prefetchable Memory";
669 	case PCIM_EA_P_BRIDGE_IO:
670 		return "Bridge I/O Space";
671 	case PCIM_EA_P_MEM_RESERVED:
672 		return "Reserved Memory";
673 	case PCIM_EA_P_IO_RESERVED:
674 		return "Reserved I/O Space";
675 	case PCIM_EA_P_UNAVAILABLE:
676 		return "Unavailable";
677 	default:
678 		return "Reserved";
679 	}
680 }
681 
682 static void
683 cap_ea(int fd, struct pci_conf *p, uint8_t ptr)
684 {
685 	int num_ent;
686 	int a, b;
687 	uint32_t bei;
688 	uint32_t val;
689 	int ent_size;
690 	uint32_t dw[4];
691 	uint32_t flags, flags_pp, flags_sp;
692 	uint64_t base, max_offset;
693 	uint8_t fixed_sub_bus_nr, fixed_sec_bus_nr;
694 
695 	/* Determine the number of entries */
696 	num_ent = read_config(fd, &p->pc_sel, ptr + PCIR_EA_NUM_ENT, 2);
697 	num_ent &= PCIM_EA_NUM_ENT_MASK;
698 
699 	printf("PCI Enhanced Allocation (%d entries)", num_ent);
700 
701 	/* Find the first entry to care of */
702 	ptr += PCIR_EA_FIRST_ENT;
703 
704 	/* Print BUS numbers for bridges */
705 	if ((p->pc_hdr & PCIM_HDRTYPE) == PCIM_HDRTYPE_BRIDGE) {
706 		val = read_config(fd, &p->pc_sel, ptr, 4);
707 
708 		fixed_sec_bus_nr = PCIM_EA_SEC_NR(val);
709 		fixed_sub_bus_nr = PCIM_EA_SUB_NR(val);
710 
711 		printf("\n\t\t BRIDGE, sec bus [%d], sub bus [%d]",
712 		    fixed_sec_bus_nr, fixed_sub_bus_nr);
713 		ptr += 4;
714 	}
715 
716 	for (a = 0; a < num_ent; a++) {
717 		/* Read a number of dwords in the entry */
718 		val = read_config(fd, &p->pc_sel, ptr, 4);
719 		ptr += 4;
720 		ent_size = (val & PCIM_EA_ES);
721 
722 		for (b = 0; b < ent_size; b++) {
723 			dw[b] = read_config(fd, &p->pc_sel, ptr, 4);
724 			ptr += 4;
725 		}
726 
727 		flags = val;
728 		flags_pp = (flags & PCIM_EA_PP) >> PCIM_EA_PP_OFFSET;
729 		flags_sp = (flags & PCIM_EA_SP) >> PCIM_EA_SP_OFFSET;
730 		bei = (PCIM_EA_BEI & val) >> PCIM_EA_BEI_OFFSET;
731 
732 		base = dw[0] & PCIM_EA_FIELD_MASK;
733 		max_offset = dw[1] | ~PCIM_EA_FIELD_MASK;
734 		b = 2;
735 		if (((dw[0] & PCIM_EA_IS_64) != 0) && (b < ent_size)) {
736 			base |= (uint64_t)dw[b] << 32UL;
737 			b++;
738 		}
739 		if (((dw[1] & PCIM_EA_IS_64) != 0)
740 			&& (b < ent_size)) {
741 			max_offset |= (uint64_t)dw[b] << 32UL;
742 			b++;
743 		}
744 
745 		printf("\n\t\t [%d] %s, %s, %s, base [0x%jx], size [0x%jx]"
746 		    "\n\t\t\tPrimary properties [0x%x] (%s)"
747 		    "\n\t\t\tSecondary properties [0x%x] (%s)",
748 		    bei, ea_bei_to_name(bei),
749 		    (flags & PCIM_EA_ENABLE ? "Enabled" : "Disabled"),
750 		    (flags & PCIM_EA_WRITABLE ? "Writable" : "Read-only"),
751 		    (uintmax_t)base, (uintmax_t)(max_offset + 1),
752 		    flags_pp, ea_prop_to_name(flags_pp),
753 		    flags_sp, ea_prop_to_name(flags_sp));
754 	}
755 }
756 
757 void
758 list_caps(int fd, struct pci_conf *p, int level)
759 {
760 	int express;
761 	uint16_t sta;
762 	uint8_t ptr, cap;
763 
764 	/* Are capabilities present for this device? */
765 	sta = read_config(fd, &p->pc_sel, PCIR_STATUS, 2);
766 	if (!(sta & PCIM_STATUS_CAPPRESENT))
767 		return;
768 
769 	cap_level = level;
770 
771 	switch (p->pc_hdr & PCIM_HDRTYPE) {
772 	case PCIM_HDRTYPE_NORMAL:
773 	case PCIM_HDRTYPE_BRIDGE:
774 		ptr = PCIR_CAP_PTR;
775 		break;
776 	case PCIM_HDRTYPE_CARDBUS:
777 		ptr = PCIR_CAP_PTR_2;
778 		break;
779 	default:
780 		errx(1, "list_caps: bad header type");
781 	}
782 
783 	/* Walk the capability list. */
784 	express = 0;
785 	ptr = read_config(fd, &p->pc_sel, ptr, 1);
786 	while (ptr != 0 && ptr != 0xff) {
787 		cap = read_config(fd, &p->pc_sel, ptr + PCICAP_ID, 1);
788 		printf("    cap %02x[%02x] = ", cap, ptr);
789 		switch (cap) {
790 		case PCIY_PMG:
791 			cap_power(fd, p, ptr);
792 			break;
793 		case PCIY_AGP:
794 			cap_agp(fd, p, ptr);
795 			break;
796 		case PCIY_VPD:
797 			cap_vpd(fd, p, ptr);
798 			break;
799 		case PCIY_MSI:
800 			cap_msi(fd, p, ptr);
801 			break;
802 		case PCIY_PCIX:
803 			cap_pcix(fd, p, ptr);
804 			break;
805 		case PCIY_HT:
806 			cap_ht(fd, p, ptr);
807 			break;
808 		case PCIY_VENDOR:
809 			cap_vendor(fd, p, ptr);
810 			break;
811 		case PCIY_DEBUG:
812 			cap_debug(fd, p, ptr);
813 			break;
814 		case PCIY_SUBVENDOR:
815 			cap_subvendor(fd, p, ptr);
816 			break;
817 		case PCIY_EXPRESS:
818 			express = 1;
819 			cap_express(fd, p, ptr);
820 			break;
821 		case PCIY_MSIX:
822 			cap_msix(fd, p, ptr);
823 			break;
824 		case PCIY_SATA:
825 			cap_sata(fd, p, ptr);
826 			break;
827 		case PCIY_PCIAF:
828 			cap_pciaf(fd, p, ptr);
829 			break;
830 		case PCIY_EA:
831 			cap_ea(fd, p, ptr);
832 			break;
833 		default:
834 			printf("unknown");
835 			break;
836 		}
837 		printf("\n");
838 		ptr = read_config(fd, &p->pc_sel, ptr + PCICAP_NEXTPTR, 1);
839 	}
840 
841 	if (express)
842 		list_ecaps(fd, p);
843 }
844 
845 /* From <sys/systm.h>. */
846 static __inline uint32_t
847 bitcount32(uint32_t x)
848 {
849 
850 	x = (x & 0x55555555) + ((x & 0xaaaaaaaa) >> 1);
851 	x = (x & 0x33333333) + ((x & 0xcccccccc) >> 2);
852 	x = (x + (x >> 4)) & 0x0f0f0f0f;
853 	x = (x + (x >> 8));
854 	x = (x + (x >> 16)) & 0x000000ff;
855 	return (x);
856 }
857 
858 static void
859 ecap_aer(int fd, struct pci_conf *p, uint16_t ptr, uint8_t ver)
860 {
861 	uint32_t sta, mask;
862 
863 	printf("AER %d", ver);
864 	if (ver < 1)
865 		return;
866 	sta = read_config(fd, &p->pc_sel, ptr + PCIR_AER_UC_STATUS, 4);
867 	mask = read_config(fd, &p->pc_sel, ptr + PCIR_AER_UC_SEVERITY, 4);
868 	printf(" %d fatal", bitcount32(sta & mask));
869 	printf(" %d non-fatal", bitcount32(sta & ~mask));
870 	sta = read_config(fd, &p->pc_sel, ptr + PCIR_AER_COR_STATUS, 4);
871 	printf(" %d corrected\n", bitcount32(sta));
872 }
873 
874 static void
875 ecap_vc(int fd, struct pci_conf *p, uint16_t ptr, uint8_t ver)
876 {
877 	uint32_t cap1;
878 
879 	printf("VC %d", ver);
880 	if (ver < 1)
881 		return;
882 	cap1 = read_config(fd, &p->pc_sel, ptr + PCIR_VC_CAP1, 4);
883 	printf(" max VC%d", cap1 & PCIM_VC_CAP1_EXT_COUNT);
884 	if ((cap1 & PCIM_VC_CAP1_LOWPRI_EXT_COUNT) != 0)
885 		printf(" lowpri VC0-VC%d",
886 		    (cap1 & PCIM_VC_CAP1_LOWPRI_EXT_COUNT) >> 4);
887 	printf("\n");
888 }
889 
890 static void
891 ecap_sernum(int fd, struct pci_conf *p, uint16_t ptr, uint8_t ver)
892 {
893 	uint32_t high, low;
894 
895 	printf("Serial %d", ver);
896 	if (ver < 1)
897 		return;
898 	low = read_config(fd, &p->pc_sel, ptr + PCIR_SERIAL_LOW, 4);
899 	high = read_config(fd, &p->pc_sel, ptr + PCIR_SERIAL_HIGH, 4);
900 	printf(" %08x%08x\n", high, low);
901 }
902 
903 static void
904 ecap_vendor(int fd, struct pci_conf *p, uint16_t ptr, uint8_t ver)
905 {
906 	uint32_t val, hdr;
907 	uint16_t nextptr, len;
908 	int i;
909 
910 	val = read_config(fd, &p->pc_sel, ptr, 4);
911 	nextptr = PCI_EXTCAP_NEXTPTR(val);
912 	hdr = read_config(fd, &p->pc_sel, ptr + PCIR_VSEC_HEADER, 4);
913 	len = PCIR_VSEC_LENGTH(hdr);
914 	if (len == 0) {
915 		if (nextptr == 0)
916 			nextptr = 0x1000;
917 		len = nextptr - ptr;
918 	}
919 
920 	printf("Vendor [%d] ID %04x Rev %d Length %d\n", ver,
921 	    PCIR_VSEC_ID(hdr), PCIR_VSEC_REV(hdr), len);
922 	if ((ver < 1) || (cap_level <= 1))
923 		return;
924 	for (i = 0; i < len; i += 4) {
925 		val = read_config(fd, &p->pc_sel, ptr + i, 4);
926 		if ((i % 16) == 0)
927 			printf("                 ");
928 		printf("%02x %02x %02x %02x", val & 0xff, (val >> 8) & 0xff,
929 		    (val >> 16) & 0xff, (val >> 24) & 0xff);
930 		if ((((i + 4) % 16) == 0 ) || ((i + 4) >= len))
931 			printf("\n");
932 		else
933 			printf(" ");
934 	}
935 }
936 
937 static void
938 ecap_sec_pcie(int fd, struct pci_conf *p, uint16_t ptr, uint8_t ver)
939 {
940 	uint32_t val;
941 
942 	printf("PCIe Sec %d", ver);
943 	if (ver < 1)
944 		return;
945 	val = read_config(fd, &p->pc_sel, ptr + 8, 4);
946 	printf(" lane errors %#x\n", val);
947 }
948 
949 static const char *
950 check_enabled(int value)
951 {
952 
953 	return (value ? "enabled" : "disabled");
954 }
955 
956 static void
957 ecap_sriov(int fd, struct pci_conf *p, uint16_t ptr, uint8_t ver)
958 {
959 	const char *comma, *enabled;
960 	uint16_t iov_ctl, total_vfs, num_vfs, vf_offset, vf_stride, vf_did;
961 	uint32_t page_caps, page_size, page_shift, size;
962 	int i;
963 
964 	printf("SR-IOV %d ", ver);
965 
966 	iov_ctl = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_CTL, 2);
967 	printf("IOV %s, Memory Space %s, ARI %s\n",
968 	    check_enabled(iov_ctl & PCIM_SRIOV_VF_EN),
969 	    check_enabled(iov_ctl & PCIM_SRIOV_VF_MSE),
970 	    check_enabled(iov_ctl & PCIM_SRIOV_ARI_EN));
971 
972 	total_vfs = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_TOTAL_VFS, 2);
973 	num_vfs = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_NUM_VFS, 2);
974 	printf("                     ");
975 	printf("%d VFs configured out of %d supported\n", num_vfs, total_vfs);
976 
977 	vf_offset = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_VF_OFF, 2);
978 	vf_stride = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_VF_STRIDE, 2);
979 	printf("                     ");
980 	printf("First VF RID Offset 0x%04x, VF RID Stride 0x%04x\n", vf_offset,
981 	    vf_stride);
982 
983 	vf_did = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_VF_DID, 2);
984 	printf("                     VF Device ID 0x%04x\n", vf_did);
985 
986 	page_caps = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_PAGE_CAP, 4);
987 	page_size = read_config(fd, &p->pc_sel, ptr + PCIR_SRIOV_PAGE_SIZE, 4);
988 	printf("                     ");
989 	printf("Page Sizes: ");
990 	comma = "";
991 	while (page_caps != 0) {
992 		page_shift = ffs(page_caps) - 1;
993 
994 		if (page_caps & page_size)
995 			enabled = " (enabled)";
996 		else
997 			enabled = "";
998 
999 		size = (1 << (page_shift + PCI_SRIOV_BASE_PAGE_SHIFT));
1000 		printf("%s%d%s", comma, size, enabled);
1001 		comma = ", ";
1002 
1003 		page_caps &= ~(1 << page_shift);
1004 	}
1005 	printf("\n");
1006 
1007 	for (i = 0; i <= PCIR_MAX_BAR_0; i++)
1008 		print_bar(fd, p, "iov bar  ", ptr + PCIR_SRIOV_BAR(i));
1009 }
1010 
1011 static struct {
1012 	uint16_t id;
1013 	const char *name;
1014 } ecap_names[] = {
1015 	{ PCIZ_AER, "AER" },
1016 	{ PCIZ_VC, "Virtual Channel" },
1017 	{ PCIZ_SERNUM, "Device Serial Number" },
1018 	{ PCIZ_PWRBDGT, "Power Budgeting" },
1019 	{ PCIZ_RCLINK_DCL, "Root Complex Link Declaration" },
1020 	{ PCIZ_RCLINK_CTL, "Root Complex Internal Link Control" },
1021 	{ PCIZ_RCEC_ASSOC, "Root Complex Event Collector ASsociation" },
1022 	{ PCIZ_MFVC, "MFVC" },
1023 	{ PCIZ_VC2, "Virtual Channel 2" },
1024 	{ PCIZ_RCRB, "RCRB" },
1025 	{ PCIZ_CAC, "Configuration Access Correction" },
1026 	{ PCIZ_ACS, "ACS" },
1027 	{ PCIZ_ARI, "ARI" },
1028 	{ PCIZ_ATS, "ATS" },
1029 	{ PCIZ_SRIOV, "SRIOV" },
1030 	{ PCIZ_MRIOV, "MRIOV" },
1031 	{ PCIZ_MULTICAST, "Multicast" },
1032 	{ PCIZ_PAGE_REQ, "Page Page Request" },
1033 	{ PCIZ_AMD, "AMD proprietary "},
1034 	{ PCIZ_RESIZE_BAR, "Resizable BAR" },
1035 	{ PCIZ_DPA, "DPA" },
1036 	{ PCIZ_TPH_REQ, "TPH Requester" },
1037 	{ PCIZ_LTR, "LTR" },
1038 	{ PCIZ_SEC_PCIE, "Secondary PCI Express" },
1039 	{ PCIZ_PMUX, "Protocol Multiplexing" },
1040 	{ PCIZ_PASID, "Process Address Space ID" },
1041 	{ PCIZ_LN_REQ, "LN Requester" },
1042 	{ PCIZ_DPC, "Downstream Port Containment" },
1043 	{ PCIZ_L1PM, "L1 PM Substates" },
1044 	{ PCIZ_PTM, "Precision Time Measurement" },
1045 	{ PCIZ_M_PCIE, "PCIe over M-PHY" },
1046 	{ PCIZ_FRS, "FRS Queuing" },
1047 	{ PCIZ_RTR, "Readiness Time Reporting" },
1048 	{ PCIZ_DVSEC, "Designated Vendor-Specific" },
1049 	{ PCIZ_VF_REBAR, "VF Resizable BAR" },
1050 	{ PCIZ_DLNK, "Data Link Feature" },
1051 	{ PCIZ_16GT, "Physical Layer 16.0 GT/s" },
1052 	{ PCIZ_LMR, "Lane Margining at Receiver" },
1053 	{ PCIZ_HIER_ID, "Hierarchy ID" },
1054 	{ PCIZ_NPEM, "Native PCIe Enclosure Management" },
1055 	{ PCIZ_PL32, "Physical Layer 32.0 GT/s" },
1056 	{ PCIZ_AP, "Alternate Protocol" },
1057 	{ PCIZ_SFI, "System Firmware Intermediary" },
1058 	{ 0, NULL }
1059 };
1060 
1061 static void
1062 list_ecaps(int fd, struct pci_conf *p)
1063 {
1064 	const char *name;
1065 	uint32_t ecap;
1066 	uint16_t ptr;
1067 	int i;
1068 
1069 	ptr = PCIR_EXTCAP;
1070 	ecap = read_config(fd, &p->pc_sel, ptr, 4);
1071 	if (ecap == 0xffffffff || ecap == 0)
1072 		return;
1073 	for (;;) {
1074 		printf("    ecap %04x[%03x] = ", PCI_EXTCAP_ID(ecap), ptr);
1075 		switch (PCI_EXTCAP_ID(ecap)) {
1076 		case PCIZ_AER:
1077 			ecap_aer(fd, p, ptr, PCI_EXTCAP_VER(ecap));
1078 			break;
1079 		case PCIZ_VC:
1080 			ecap_vc(fd, p, ptr, PCI_EXTCAP_VER(ecap));
1081 			break;
1082 		case PCIZ_SERNUM:
1083 			ecap_sernum(fd, p, ptr, PCI_EXTCAP_VER(ecap));
1084 			break;
1085 		case PCIZ_VENDOR:
1086 			ecap_vendor(fd, p, ptr, PCI_EXTCAP_VER(ecap));
1087 			break;
1088 		case PCIZ_SEC_PCIE:
1089 			ecap_sec_pcie(fd, p, ptr, PCI_EXTCAP_VER(ecap));
1090 			break;
1091 		case PCIZ_SRIOV:
1092 			ecap_sriov(fd, p, ptr, PCI_EXTCAP_VER(ecap));
1093 			break;
1094 		default:
1095 			name = "unknown";
1096 			for (i = 0; ecap_names[i].name != NULL; i++)
1097 				if (ecap_names[i].id == PCI_EXTCAP_ID(ecap)) {
1098 					name = ecap_names[i].name;
1099 					break;
1100 				}
1101 			printf("%s %d\n", name, PCI_EXTCAP_VER(ecap));
1102 			break;
1103 		}
1104 		ptr = PCI_EXTCAP_NEXTPTR(ecap);
1105 		if (ptr == 0)
1106 			break;
1107 		ecap = read_config(fd, &p->pc_sel, ptr, 4);
1108 	}
1109 }
1110 
1111 /* Find offset of a specific capability.  Returns 0 on failure. */
1112 uint8_t
1113 pci_find_cap(int fd, struct pci_conf *p, uint8_t id)
1114 {
1115 	uint16_t sta;
1116 	uint8_t ptr, cap;
1117 
1118 	/* Are capabilities present for this device? */
1119 	sta = read_config(fd, &p->pc_sel, PCIR_STATUS, 2);
1120 	if (!(sta & PCIM_STATUS_CAPPRESENT))
1121 		return (0);
1122 
1123 	switch (p->pc_hdr & PCIM_HDRTYPE) {
1124 	case PCIM_HDRTYPE_NORMAL:
1125 	case PCIM_HDRTYPE_BRIDGE:
1126 		ptr = PCIR_CAP_PTR;
1127 		break;
1128 	case PCIM_HDRTYPE_CARDBUS:
1129 		ptr = PCIR_CAP_PTR_2;
1130 		break;
1131 	default:
1132 		return (0);
1133 	}
1134 
1135 	ptr = read_config(fd, &p->pc_sel, ptr, 1);
1136 	while (ptr != 0 && ptr != 0xff) {
1137 		cap = read_config(fd, &p->pc_sel, ptr + PCICAP_ID, 1);
1138 		if (cap == id)
1139 			return (ptr);
1140 		ptr = read_config(fd, &p->pc_sel, ptr + PCICAP_NEXTPTR, 1);
1141 	}
1142 	return (0);
1143 }
1144 
1145 /* Find offset of a specific extended capability.  Returns 0 on failure. */
1146 uint16_t
1147 pcie_find_cap(int fd, struct pci_conf *p, uint16_t id)
1148 {
1149 	uint32_t ecap;
1150 	uint16_t ptr;
1151 
1152 	ptr = PCIR_EXTCAP;
1153 	ecap = read_config(fd, &p->pc_sel, ptr, 4);
1154 	if (ecap == 0xffffffff || ecap == 0)
1155 		return (0);
1156 	for (;;) {
1157 		if (PCI_EXTCAP_ID(ecap) == id)
1158 			return (ptr);
1159 		ptr = PCI_EXTCAP_NEXTPTR(ecap);
1160 		if (ptr == 0)
1161 			break;
1162 		ecap = read_config(fd, &p->pc_sel, ptr, 4);
1163 	}
1164 	return (0);
1165 }
1166