pcitool.c revision 10053:79ff8cfc9153
1/*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21/*
22 * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
23 * Use is subject to license terms.
24 */
25
26/* This file is the main module for the pcitool. */
27
28#include <stdio.h>
29#include <stdlib.h>
30#include <unistd.h>
31#include <sys/inttypes.h>
32#include <signal.h>
33#include <sys/types.h>
34#include <sys/param.h>
35#include <fcntl.h>
36#include <strings.h>
37#include <ctype.h>
38#include <errno.h>
39#include <libdevinfo.h>
40#include <sys/sunddi.h>
41
42#ifdef __x86
43#include <sys/apic_ctlr.h>
44#endif
45
46#include <sys/pci.h>
47#include <sys/pci_tools.h>
48
49#include "pcitool_ui.h"
50
51/* First 16 longs of device PCI config header. */
52typedef union {
53	uint8_t bytes[16 * sizeof (uint32_t)];
54	uint32_t dwords[16];
55} pci_conf_hdr_t;
56
57/* Used by probe printing functions. */
58typedef struct {
59	uint16_t cfg_offset;	/* Offset of data within config space. */
60	uint8_t size;		/* Size of desired data field. */
61	char *abbrev_hdr;	/* Abbreviated header for this data. */
62	char *full_hdr;		/* Full header for this data, verbose option. */
63} field_type_t;
64
65/* Used to package many args into one arg for probe di_node walk function. */
66typedef struct {
67	pcitool_uiargs_t *input_args_p;
68	char *pathname;
69	di_prom_handle_t di_phdl;
70} probe_walk_args_t;
71
72/*
73 * Read config space in native processor endianness.  Endian-neutral
74 * processing can then take place.  On big endian machines, MSB and LSB
75 * of little endian data end up switched if read as little endian.
76 * They are in correct order if read as big endian.
77 */
78#if defined(__sparc)
79#define	NATIVE_ENDIAN	PCITOOL_ACC_ATTR_ENDN_BIG
80#elif defined(__x86)
81#define	NATIVE_ENDIAN	PCITOOL_ACC_ATTR_ENDN_LTL
82#else
83#error "ISA is neither __sparc nor __x86"
84#endif
85
86/* status error lookup table. */
87static struct {
88	pcitool_errno_t	value;
89	char		*string;
90} pcitool_stat_str[] = {
91	{ PCITOOL_SUCCESS,
92		"No error status returned from driver" },
93	{ PCITOOL_INVALID_CPUID,
94		"CPU is non-existent or not online" },
95	{ PCITOOL_INVALID_INO,
96		"INO is out of range or invalid" },
97	{ PCITOOL_INVALID_MSI,
98		"MSI is out of range or invalid" },
99	{ PCITOOL_PENDING_INTRTIMEOUT,
100		"Timeout waiting for pending interrupts to clear" },
101	{ PCITOOL_REGPROP_NOTWELLFORMED,
102		"Reg property has invalid format" },
103	{ PCITOOL_INVALID_ADDRESS,
104		"Address out of range or invalid" },
105	{ PCITOOL_NOT_ALIGNED,
106		"Improper address alignment for access attempted" },
107	{ PCITOOL_OUT_OF_RANGE,
108		"Argument out of range" },
109	{ PCITOOL_END_OF_RANGE,
110		"End of address range" },
111	{ PCITOOL_ROM_DISABLED,
112		"Device ROM is disabled.  Cannot read" },
113	{ PCITOOL_ROM_WRITE,
114		"Write to ROM not allowed" },
115	{ PCITOOL_IO_ERROR,
116		"IO error encountered" },
117	{ PCITOOL_INVALID_SIZE,
118		"Size is invalid for this platform" },
119	{ 0, NULL }
120};
121
122
123/* Used with ^C handler to stop looping in repeat mode in do_device_or_nexus. */
124static boolean_t keep_looping = B_TRUE;
125
126static void signal_handler(int dummy);
127static char *strstatus(pcitool_errno_t pcitool_status);
128static int open_node(char *device, pcitool_uiargs_t *input_args_p);
129static void print_probe_value(pci_conf_hdr_t *config_hdr_p, uint16_t offset,
130    uint8_t size);
131static void print_probe_info_verbose(pci_conf_hdr_t *config_hdr_p,
132    pcitool_reg_t *info_p);
133static void print_probe_info_nonverbose(pci_conf_hdr_t *config_hdr_p,
134    pcitool_reg_t *info_p);
135static void print_probe_info(pci_conf_hdr_t *config_hdr_p,
136    pcitool_reg_t *info_p, boolean_t verbose);
137static int get_config_header(int fd, uint8_t bus_no, uint8_t dev_no,
138    uint8_t func_no, pci_conf_hdr_t *config_hdr_p);
139static int probe_dev(int fd, pcitool_reg_t *prg_p,
140    pcitool_uiargs_t *input_args_p);
141static int do_probe(int fd, di_node_t di_node, di_prom_handle_t di_phdl,
142    pcitool_uiargs_t *input_args_p);
143static int process_nexus_node(di_node_t node, di_minor_t minor, void *arg);
144static int do_probe_walk(pcitool_uiargs_t *input_args_p, char *pathname);
145static void print_bytedump_header(boolean_t do_chardump);
146static int bytedump_get(int fd, int cmd, pcitool_reg_t *prg_p,
147    pcitool_uiargs_t *input_args_p);
148static uint32_t set_acc_attr(pcitool_uiargs_t *input_args_p);
149static int do_single_access(int fd, int cmd, pcitool_reg_t *prg_p,
150    pcitool_uiargs_t *input_args_p);
151static int do_device_or_nexus(int fd, pcitool_uiargs_t *input_args_p);
152static void print_intr_info(pcitool_intr_get_t *iget_p);
153static int get_single_interrupt(int fd, pcitool_intr_get_t **iget_pp,
154    pcitool_uiargs_t *input_args_p);
155static int get_interrupts(int fd, pcitool_uiargs_t *input_args_p);
156static int set_interrupts(int fd, pcitool_uiargs_t *input_args_p);
157static int do_interrupts(int fd, pcitool_uiargs_t *input_args_p);
158
159
160/* *************** General ************** */
161
162/*
163 * Handler for ^C to stop looping.
164 */
165/*ARGSUSED*/
166static void
167signal_handler(int dummy)
168{
169	keep_looping = B_FALSE;
170}
171
172
173/*
174 * Print string based on PCItool status returned from driver.
175 */
176static char *
177strstatus(pcitool_errno_t pcitool_status)
178{
179	int i;
180
181	for (i = 0; pcitool_stat_str[i].string != NULL; i++) {
182		if (pcitool_stat_str[i].value == pcitool_status) {
183
184			return (pcitool_stat_str[i].string);
185		}
186	}
187
188	return ("Unknown status returned from driver.");
189}
190
191
192static int
193open_node(char *device, pcitool_uiargs_t *input_args_p)
194{
195	int fd;
196	char *path;			/* For building full nexus pathname. */
197	int stringsize;			/* Device name size. */
198	char *prefix;
199	char *suffix;
200	char *format;
201
202	static char slash_devices[] = {"/devices"};
203	static char wcolon[] = {"%s%s:%s"};
204	static char wocolon[] = {"%s%s%s"};
205
206	/* Check for names starting with /devices. */
207	prefix = (strstr(device, slash_devices) == device) ? "" : slash_devices;
208
209	format = wcolon;
210	if (input_args_p->flags & INTR_FLAG) {
211		if (strstr(device, PCI_MINOR_INTR) ==
212		    device + (strlen(device) - strlen(PCI_MINOR_INTR))) {
213			suffix = "";
214			format = wocolon;
215		} else {
216			suffix = PCI_MINOR_INTR;
217		}
218	} else {
219		if (strstr(device, PCI_MINOR_REG) ==
220		    device + (strlen(device) - strlen(PCI_MINOR_REG))) {
221			suffix = "";
222			format = wocolon;
223		} else {
224			suffix = PCI_MINOR_REG;
225		}
226	}
227
228	/*
229	 * Build nexus pathname.
230	 * User specified /pci@1f,700000 becomes /devices/pci@1f,700000:intr
231	 * for interrupt nodes, and ...:reg for register nodes.
232	 *
233	 * ...The 2 at the end leaves room for a : and the terminating NULL.
234	 */
235	stringsize = strlen(prefix) + strlen(device) + strlen(suffix) + 2;
236	path = malloc(stringsize);
237
238	/*LINTED*/
239	(void) snprintf(path, stringsize, format, prefix, device, suffix);
240
241	/* Open the nexus. */
242	if ((fd = open(path, O_RDWR)) == -1) {
243		if (!(IS_QUIET(input_args_p->flags))) {
244			(void) fprintf(stderr,
245			    "Could not open nexus node %s: %s\n",
246			    path, strerror(errno));
247		}
248	}
249
250	return (fd);
251}
252
253
254/* ****************** Probe **************** */
255
256/* The following are used by the probe printing functions. */
257
258/* Header 0 and 1 config space headers have these fields. */
259static field_type_t first_fields[] = {
260	{ PCI_CONF_VENID, 2, "Vend", "Vendor ID" },
261	{ PCI_CONF_DEVID, 2, "Dev ", "Device ID" },
262	{ PCI_CONF_COMM, 2, "Cmd ", "Command" },
263	{ PCI_CONF_STAT, 2, "Stat", "Status" },
264	{ PCI_CONF_REVID, 1, "Rv", "Revision ID" },
265	{ PCI_CONF_PROGCLASS, 3, "Class ", "Class Code" },
266	{ PCI_CONF_CACHE_LINESZ, 1, "Ca", "Cache Line Size" },
267	{ PCI_CONF_LATENCY_TIMER, 1, "LT", "Latency Timer" },
268	{ PCI_CONF_HEADER, 1, "Hd", "Header Type" },
269	{ PCI_CONF_BIST, 1, "BI", "BIST" },
270	{ 0, 0, NULL, NULL }
271};
272
273/* Header 0 (for regular devices) have these fields. */
274static field_type_t last_dev_fields[] = {
275	{ PCI_CONF_BASE0, 4, "BAR0", "Base Address Register 0 (@10)" },
276	{ PCI_CONF_BASE1, 4, "BAR1", "Base Address Register 1 (@14)" },
277	{ PCI_CONF_BASE2, 4, "BAR2", "Base Address Register 2 (@18)" },
278	{ PCI_CONF_BASE3, 4, "BAR3", "Base Address Register 3 (@1C)" },
279	{ PCI_CONF_BASE4, 4, "BAR4", "Base Address Register 4 (@20)" },
280	{ PCI_CONF_BASE5, 4, "BAR5", "Base Address Register 5 (@24)" },
281	{ PCI_CONF_ROM, 4, "ROM", "Expansion ROM Base Address Register (@30)" },
282	{ 0, 0, NULL, NULL }
283};
284
285/* Header 1 (PCI-PCI bridge devices) have these fields. */
286static field_type_t last_pcibrg_fields[] = {
287	{ PCI_CONF_BASE0, 4, "BAR0", "Base Address Register 0 (@10)" },
288	{ PCI_CONF_BASE1, 4, "BAR1", "Base Address Register 1 (@14)" },
289	{ PCI_BCNF_ROM, 4, "ROM", "Expansion ROM Base Address Register (@38)" },
290	{ 0, 0, NULL, NULL }
291};
292
293/* Header 2 (PCI-Cardbus bridge devices) have these fields. */
294static field_type_t last_cbbrg_fields[] = {
295	{ PCI_CBUS_SOCK_REG, 4, "SCKT", "Socket/ExCA Base Address (@10)" },
296	{ 0, 0, NULL, NULL }
297};
298
299#define	FMT_SIZE 7
300
301static void
302print_probe_value(pci_conf_hdr_t *config_hdr_p, uint16_t offset, uint8_t size)
303{
304
305	char format[FMT_SIZE];
306
307
308	/* Size cannot be any larger than 4 bytes.  This is not checked. */
309	uint32_t value = 0;
310
311	/* Build format of print, "%<size*2>.<size*2>x" */
312	(void) snprintf(format, FMT_SIZE, "%%%d.%dx ", size * 2, size * 2);
313
314	while (size-- > 0) {
315		value = (value << 8) + config_hdr_p->bytes[offset + size];
316	}
317
318	/*LINTED*/
319	(void) printf(format, value);
320}
321
322static void
323print_probe_info_verbose(pci_conf_hdr_t *config_hdr_p, pcitool_reg_t *info_p)
324{
325	field_type_t *last_fields = NULL;
326	int i;
327
328	(void) printf("\n"
329	    "Bus Number: %x Device Number: %x Function Number: %x\n",
330	    info_p->bus_no, info_p->dev_no, info_p->func_no);
331	if (info_p->phys_addr != 0) {
332		(void) printf("Physical Address: 0x%" PRIx64 " \n",
333		    info_p->phys_addr);
334	}
335
336	switch (config_hdr_p->bytes[PCI_CONF_HEADER] & PCI_HEADER_TYPE_M) {
337
338	case PCI_HEADER_ZERO:	/* Header type 0 is a regular device. */
339		last_fields = last_dev_fields;
340		break;
341
342	case PCI_HEADER_PPB:	/* Header type 1 is a PCI-PCI bridge. */
343		last_fields = last_pcibrg_fields;
344		(void) printf("PCI-PCI bridge\n");
345		break;
346
347	case PCI_HEADER_CARDBUS: /* Header type 2 is a cardbus bridge */
348		last_fields = last_cbbrg_fields;
349		(void) printf("PCI-Cardbus bridge\n");
350		break;
351
352	default:
353		(void) printf("Unknown device\n");
354		break;
355	}
356
357	if (last_fields != NULL) {
358
359		for (i = 0; first_fields[i].size != 0; i++) {
360			(void) printf("%s: ", first_fields[i].full_hdr);
361			print_probe_value(config_hdr_p,
362			    first_fields[i].cfg_offset, first_fields[i].size);
363			(void) putchar('\n');
364		}
365
366		for (i = 0; last_fields[i].size != 0; i++) {
367			(void) printf("%s: ", last_fields[i].full_hdr);
368			print_probe_value(config_hdr_p,
369			    last_fields[i].cfg_offset, last_fields[i].size);
370			(void) putchar('\n');
371		}
372	}
373}
374
375static void
376print_probe_info_nonverbose(pci_conf_hdr_t *config_hdr_p, pcitool_reg_t *info_p)
377{
378	int i;
379
380	(void) printf("%2.2x %2.2x %1.1x ",
381	    info_p->bus_no, info_p->dev_no, info_p->func_no);
382	for (i = 0; first_fields[i].size != 0; i++) {
383		print_probe_value(config_hdr_p,
384		    first_fields[i].cfg_offset, first_fields[i].size);
385	}
386	(void) putchar('\n');
387}
388
389
390/*
391 * Print device information retrieved during probe mode.
392 * Takes the PCI config header, plus address information retrieved from the
393 * driver.
394 *
395 * When called with config_hdr_p == NULL, this function just prints a header
396 * when not in verbose mode.
397 */
398
399static void
400print_probe_info(
401    pci_conf_hdr_t *config_hdr_p, pcitool_reg_t *info_p, boolean_t verbose)
402{
403	int i;
404
405	/* Print header if not in verbose mode. */
406	if (config_hdr_p == NULL) {
407		if (!verbose) {
408
409			/* Bus dev func not from tble */
410			(void) printf("B  D  F ");
411
412			for (i = 0; first_fields[i].size != 0; i++) {
413				(void) printf("%s ",
414				    first_fields[i].abbrev_hdr);
415			}
416			(void) putchar('\n');
417		}
418
419		return;
420	}
421
422	if (verbose) {
423		print_probe_info_verbose(config_hdr_p, info_p);
424	} else {
425		print_probe_info_nonverbose(config_hdr_p, info_p);
426	}
427}
428
429
430/*
431 * Retrieve first 16 dwords of device's config header, except for the first
432 * dword.  First 16 dwords are defined by the PCI specification.
433 */
434static int
435get_config_header(int fd, uint8_t bus_no, uint8_t dev_no, uint8_t func_no,
436    pci_conf_hdr_t *config_hdr_p)
437{
438	pcitool_reg_t cfg_prg;
439	int i;
440	int rval = SUCCESS;
441
442	/* Prepare a local pcitool_reg_t so as to not disturb the caller's. */
443	cfg_prg.offset = 0;
444	cfg_prg.acc_attr = PCITOOL_ACC_ATTR_SIZE_4 + NATIVE_ENDIAN;
445	cfg_prg.bus_no = bus_no;
446	cfg_prg.dev_no = dev_no;
447	cfg_prg.func_no = func_no;
448	cfg_prg.barnum = 0;
449	cfg_prg.user_version = PCITOOL_VERSION;
450
451	/* Get dwords 1-15 of config space. They must be read as uint32_t. */
452	for (i = 1; i < (sizeof (pci_conf_hdr_t) / sizeof (uint32_t)); i++) {
453		cfg_prg.offset += sizeof (uint32_t);
454		if ((rval =
455		    ioctl(fd, PCITOOL_DEVICE_GET_REG, &cfg_prg)) != SUCCESS) {
456			break;
457		}
458		config_hdr_p->dwords[i] = (uint32_t)cfg_prg.data;
459	}
460
461	return (rval);
462}
463
464/*
465 * Identify problematic southbridges.  These have device id 0x5249 and
466 * vendor id 0x10b9.  Check for revision ID 0 and class code 060400 as well.
467 * Values are little endian, so they are reversed for SPARC.
468 *
469 * Check for these southbridges on all architectures, as the issue is a
470 * southbridge issue, independent of processor.
471 *
472 * If one of these is found during probing, skip probing other devs/funcs on
473 * the rest of the bus, since the southbridge and all devs underneath will
474 * otherwise disappear.
475 */
476#if (NATIVE_ENDIAN == PCITOOL_ACC_ATTR_ENDN_BIG)
477#define	U45_SB_DEVID_VID	0xb9104952
478#define	U45_SB_CLASS_RID	0x00000406
479#else
480#define	U45_SB_DEVID_VID	0x524910b9
481#define	U45_SB_CLASS_RID	0x06040000
482#endif
483
484/*
485 * Probe device's functions.  Modifies many fields in the prg_p.
486 */
487static int
488probe_dev(int fd, pcitool_reg_t *prg_p, pcitool_uiargs_t *input_args_p)
489{
490	pci_conf_hdr_t	config_hdr;
491	boolean_t	multi_function_device;
492	int		func;
493	int		first_func = 0;
494	int		last_func = PCI_REG_FUNC_M >> PCI_REG_FUNC_SHIFT;
495	int		rval = SUCCESS;
496
497	if (input_args_p->flags & FUNC_SPEC_FLAG) {
498		first_func = last_func = input_args_p->function;
499	}
500
501	/*
502	 * Loop through at least func=first_func.  Continue looping through
503	 * functions if there are no errors and the device is a multi-function
504	 * device.
505	 *
506	 * (Note, if first_func == 0, header will show whether multifunction
507	 * device and set multi_function_device.  If first_func != 0, then we
508	 * will force the loop as the user wants a specific function to be
509	 * checked.
510	 */
511	for (func = first_func, multi_function_device = B_FALSE;
512	    ((func <= last_func) &&
513	    ((func == first_func) || (multi_function_device)));
514	    func++) {
515		prg_p->func_no = func;
516
517		/*
518		 * Four things can happen here:
519		 *
520		 * 1) ioctl comes back as EFAULT and prg_p->status is
521		 *    PCITOOL_INVALID_ADDRESS.  There is no device at this
522		 *    location.
523		 *
524		 * 2) ioctl comes back successful and the data comes back as
525		 *    zero.  Config space is mapped but no device responded.
526		 *
527		 * 3) ioctl comes back successful and the data comes back as
528		 *    non-zero.  We've found a device.
529		 *
530		 * 4) Some other error occurs in an ioctl.
531		 */
532
533		prg_p->status = PCITOOL_SUCCESS;
534		prg_p->offset = 0;
535		prg_p->data = 0;
536		prg_p->user_version = PCITOOL_VERSION;
537		if (((rval = ioctl(fd, PCITOOL_DEVICE_GET_REG, prg_p)) != 0) ||
538		    (prg_p->data == 0xffffffff)) {
539
540			/*
541			 * Accept errno == EINVAL along with status of
542			 * PCITOOL_OUT_OF_RANGE because some systems
543			 * don't implement the full range of config space.
544			 * Leave the loop quietly in this case.
545			 */
546			if ((errno == EINVAL) ||
547			    (prg_p->status == PCITOOL_OUT_OF_RANGE)) {
548				break;
549			}
550
551			/*
552			 * Exit silently with ENXIO as this means that there are
553			 * no devices under the pci root nexus.
554			 */
555			else if ((errno == ENXIO) &&
556			    (prg_p->status == PCITOOL_IO_ERROR)) {
557				break;
558			}
559
560			/*
561			 * Expect errno == EFAULT along with status of
562			 * PCITOOL_INVALID_ADDRESS because there won't be
563			 * devices at each stop.  Quit on any other error.
564			 */
565			else if (((errno != EFAULT) ||
566			    (prg_p->status != PCITOOL_INVALID_ADDRESS)) &&
567			    (prg_p->data != 0xffffffff)) {
568
569				if (!(IS_QUIET(input_args_p->flags))) {
570					(void) fprintf(stderr,
571					    "Ioctl error: %s\n",
572					    strerror(errno));
573				}
574				break;
575
576			/*
577			 * If no function at this location,
578			 * just advance to the next function.
579			 */
580			} else {
581				rval = SUCCESS;
582			}
583
584		/*
585		 * Data came back as 0.
586		 * Treat as unresponsive device amd check next device.
587		 */
588		} else if (prg_p->data == 0) {
589			rval = SUCCESS;
590			break;	/* Func loop. */
591
592		/* Found something. */
593		} else {
594			config_hdr.dwords[0] = (uint32_t)prg_p->data;
595
596			/* Get the rest of the PCI header. */
597			if ((rval = get_config_header(fd, prg_p->bus_no,
598			    prg_p->dev_no, prg_p->func_no, &config_hdr)) !=
599			    SUCCESS) {
600				break;
601			}
602
603			/* Print the found information. */
604			print_probe_info(&config_hdr, prg_p,
605			    IS_VERBOSE(input_args_p->flags));
606
607			/*
608			 * Special case for the type of Southbridge found on
609			 * Ultra-45 and other sun4u fire workstations.
610			 */
611			if ((config_hdr.dwords[0] == U45_SB_DEVID_VID) &&
612			    (config_hdr.dwords[2] == U45_SB_CLASS_RID)) {
613				rval = ECANCELED;
614				break;
615			}
616
617			/*
618			 * Accomodate devices which state their
619			 * multi-functionality only in their function 0 config
620			 * space.  Note multi-functionality throughout probing
621			 * of all of this device's functions.
622			 */
623			if (config_hdr.bytes[PCI_CONF_HEADER] &
624			    PCI_HEADER_MULTI) {
625				multi_function_device = B_TRUE;
626			}
627		}
628	}
629
630	return (rval);
631}
632
633
634/*
635 * Probe a given nexus config space for devices.
636 *
637 * fd is the file descriptor of the nexus.
638 * input_args contains commandline options as specified by the user.
639 */
640static int
641do_probe(int fd, di_node_t di_node, di_prom_handle_t di_phdl,
642    pcitool_uiargs_t *input_args_p)
643{
644	pcitool_reg_t prg;
645	int bus;
646	int dev;
647	int last_bus = PCI_REG_BUS_M >> PCI_REG_BUS_SHIFT;
648	int last_dev = PCI_REG_DEV_M >> PCI_REG_DEV_SHIFT;
649	int first_bus = 0;
650	int first_dev = 0;
651	int rval = SUCCESS;
652
653	prg.barnum = 0;	/* Config space. */
654
655	/* Must read in 4-byte quantities. */
656	prg.acc_attr = PCITOOL_ACC_ATTR_SIZE_4 + NATIVE_ENDIAN;
657
658	prg.data = 0;
659
660	/* If an explicit bus was specified by the user, go with it. */
661	if (input_args_p->flags & BUS_SPEC_FLAG) {
662		first_bus = last_bus = input_args_p->bus;
663
664	} else if (input_args_p->flags & PROBERNG_FLAG) {
665		/* Otherwise get the bus range from properties. */
666		int len;
667		uint32_t *rangebuf = NULL;
668
669		len = di_prop_lookup_ints(DDI_DEV_T_ANY, di_node,
670		    "bus-range", (int **)&rangebuf);
671
672		/* Try PROM property */
673		if (len <= 0) {
674			len = di_prom_prop_lookup_ints(di_phdl, di_node,
675			    "bus-range", (int **)&rangebuf);
676		}
677
678		/* Take full range for default if cannot get property. */
679		if (len > 0) {
680			first_bus = rangebuf[0];
681			last_bus = rangebuf[1];
682		}
683	}
684
685	/* Take full range for default if not PROBERNG and not BUS_SPEC. */
686
687	if (last_bus == first_bus) {
688		if (input_args_p->flags & DEV_SPEC_FLAG) {
689			/* Explicit device given.  Not probing a whole bus. */
690			(void) puts("");
691		} else {
692			(void) printf("*********** Probing bus %x "
693			    "***********\n\n", first_bus);
694		}
695	} else {
696		(void) printf("*********** Probing buses %x through %x "
697		    "***********\n\n", first_bus, last_bus);
698	}
699
700	/* Print header. */
701	print_probe_info(NULL, NULL, IS_VERBOSE(input_args_p->flags));
702
703	/* Device number explicitly specified. */
704	if (input_args_p->flags & DEV_SPEC_FLAG) {
705		first_dev = last_dev = input_args_p->device;
706	}
707
708	/*
709	 * Loop through all valid bus / dev / func combinations to check for
710	 * all devices, with the following exceptions:
711	 *
712	 * When nothing is found at function 0 of a bus / dev combination, skip
713	 * the other functions of that bus / dev combination.
714	 *
715	 * When a found device's function 0 is probed and it is determined that
716	 * it is not a multifunction device, skip probing of that device's
717	 * other functions.
718	 */
719	for (bus = first_bus; ((bus <= last_bus) && (rval == SUCCESS)); bus++) {
720		prg.bus_no = bus;
721		for (dev = first_dev;
722		    ((dev <= last_dev) && (rval == SUCCESS)); dev++) {
723			prg.dev_no = dev;
724			rval = probe_dev(fd, &prg, input_args_p);
725		}
726
727		/*
728		 * Ultra-45 southbridge workaround:
729		 * ECANCELED tells to skip to the next bus.
730		 */
731		if (rval == ECANCELED) {
732			rval = SUCCESS;
733		}
734	}
735
736	return (rval);
737}
738
739/*
740 * This function is called-back from di_walk_minor() when any PROBE is processed
741 */
742/*ARGSUSED*/
743static int
744process_nexus_node(di_node_t di_node, di_minor_t minor, void *arg)
745{
746	int fd;
747	char *trunc;
748	probe_walk_args_t *walk_args_p = (probe_walk_args_t *)arg;
749	char *pathname = walk_args_p->pathname;
750	char *nexus_path = di_devfs_minor_path(minor);
751
752	if (nexus_path == NULL) {
753		(void) fprintf(stderr, "Error getting nexus path: %s\n",
754		    strerror(errno));
755		return (DI_WALK_CONTINUE);
756	}
757
758	/*
759	 * Display this node if pathname not specified (as all nodes are
760	 * displayed) or if the current node matches the single specified
761	 * pathname. Pathname form: xxx, nexus form: xxx:reg
762	 */
763	if ((pathname != NULL) &&
764	    ((strstr(nexus_path, pathname) != nexus_path) ||
765	    (strlen(nexus_path) !=
766	    (strlen(pathname) + strlen(PCI_MINOR_REG) + 1)))) {
767		di_devfs_path_free(nexus_path);
768		return (DI_WALK_CONTINUE);
769	}
770
771	if ((fd = open_node(nexus_path, walk_args_p->input_args_p)) >= 0) {
772
773		/* Strip off the suffix at the end of the nexus path. */
774		if ((trunc = strstr(nexus_path, PCI_MINOR_REG)) != NULL) {
775			trunc--;	/* Get the : just before too. */
776			*trunc = '\0';
777		}
778
779		/* Show header only if no explicit nexus node name given. */
780		(void) puts("");
781		if (pathname == NULL) {
782			(void) printf("********** Devices in tree under %s "
783			    "**********\n", nexus_path);
784		}
785
786		/*
787		 * Exit silently with ENXIO as this means that there are
788		 * no devices under the pci root nexus.
789		 */
790		if ((do_probe(fd, di_node, walk_args_p->di_phdl,
791		    walk_args_p->input_args_p) != SUCCESS) &&
792		    (errno != ENXIO)) {
793			(void) fprintf(stderr, "Error probing node %s: %s\n",
794			    nexus_path, strerror(errno));
795		}
796
797		(void) close(fd);
798	}
799	di_devfs_path_free(nexus_path);
800
801	/*
802	 * If node was explicitly specified, it has just been displayed
803	 * and no more looping is required.
804	 * Otherwise, keep looping for more nodes.
805	 */
806	return ((pathname == NULL) ? DI_WALK_CONTINUE : DI_WALK_TERMINATE);
807}
808
809
810/*
811 * Start of probe.  If pathname is NULL, search all devices.
812 *
813 * di_walk_minor() walks all DDI_NT_REGACC (PCItool register access) nodes
814 * and calls process_nexus_node on them.  process_nexus_node will then check
815 * the pathname for a match, unless it is NULL which works like a wildcard.
816 */
817static int
818do_probe_walk(pcitool_uiargs_t *input_args_p, char *pathname)
819{
820	di_node_t di_node;
821	di_prom_handle_t di_phdl = DI_PROM_HANDLE_NIL;
822	probe_walk_args_t walk_args;
823
824	int rval = SUCCESS;
825
826	if ((di_node = di_init("/", DINFOCPYALL)) == DI_NODE_NIL) {
827		(void) fprintf(stderr, "di_init() failed: %s\n",
828		    strerror(errno));
829		rval = errno;
830
831	} else if ((input_args_p->flags & PROBERNG_FLAG) &&
832	    ((di_phdl = di_prom_init()) == DI_PROM_HANDLE_NIL)) {
833		(void) fprintf(stderr, "di_prom_init failed: %s\n",
834		    strerror(errno));
835		rval = errno;
836
837	} else {
838		walk_args.input_args_p = input_args_p;
839		walk_args.di_phdl = di_phdl;
840		walk_args.pathname = pathname;
841		(void) di_walk_minor(di_node, DDI_NT_REGACC, 0,
842		    &walk_args, process_nexus_node);
843	}
844
845	if (di_phdl != DI_PROM_HANDLE_NIL) {
846		di_prom_fini(di_phdl);
847	}
848
849	if (di_node != DI_NODE_NIL) {
850		di_fini(di_node);
851	}
852
853	return (rval);
854}
855
856
857/* **************** Byte dump specific **************** */
858
859static void
860print_bytedump_header(boolean_t do_chardump)
861{
862	static char header1[] = {"                    "
863	    "0F 0E 0D 0C 0B 0A 09 08 07 06 05 04 03 02 01 00"};
864	static char header2[] = {"                    "
865	    "-----------------------------------------------"};
866	static char cheader1[] = {" 0123456789ABCDEF"};
867	static char cheader2[] = {" ----------------"};
868
869	(void) puts("");
870	(void) printf(header1);
871	if (do_chardump) {
872		(void) printf(cheader1);
873	}
874	(void) puts("");
875	(void) printf(header2);
876	if (do_chardump) {
877		(void) printf(cheader2);
878	}
879}
880
881
882/* Number of bytes per line in a dump. */
883#define	DUMP_BUF_SIZE		16
884#define	LINES_BTWN_HEADER	16
885
886/*
887 * Retrieve several bytes over several reads, and print a formatted byte-dump
888 *
889 * fd is the nexus by which device is accessed.
890 * prg provided has bus, dev, func, bank, initial offset already specified,
891 * as well as size and endian attributes.
892 *
893 * No checking is made that this is a read operation, although only read
894 * operations are allowed.
895 */
896static int
897bytedump_get(int fd, int cmd, pcitool_reg_t *prg_p,
898    pcitool_uiargs_t *input_args_p)
899{
900	typedef union {
901		uint8_t	bytes[DUMP_BUF_SIZE];
902		uint16_t shorts[DUMP_BUF_SIZE / sizeof (uint16_t)];
903		uint32_t dwords[DUMP_BUF_SIZE / sizeof (uint32_t)];
904		uint64_t longs[DUMP_BUF_SIZE / sizeof (uint64_t)];
905	} buffer_t;
906
907	/*
908	 * Local copy of pcitool_reg_t, since offset and phys_addrs are
909	 * modified.
910	 */
911	pcitool_reg_t local_prg;
912
913	/* Loop parameters. */
914	uint32_t dump_end = prg_p->offset + input_args_p->bytedump_amt;
915	uint32_t dump_curr = prg_p->offset;
916
917	int read_size = input_args_p->size;
918
919	/* How many stores to the buffer before it is full. */
920	int wrap_size = DUMP_BUF_SIZE / read_size;
921
922	/* Address prints at the beginning of each line. */
923	uint64_t print_addr = 0;
924
925	/* Skip this num bytes at the beginning of the first dump. */
926	int skip_begin;
927
928	/* Skip this num bytes at the end of the last dump. */
929	int skip_end = 0;
930
931	/* skip_begin and skip_end are needed twice. */
932	int skip_begin2;
933	int skip_end2;
934
935	/* Number of lines between headers */
936	int lines_since_header = 0;
937
938	boolean_t do_chardump = input_args_p->flags & CHARDUMP_FLAG;
939	boolean_t continue_on_errs = input_args_p->flags & ERRCONT_FLAG;
940
941	int rval = SUCCESS;	/* Return status. */
942
943	int next;
944	int i;
945
946	buffer_t buffer;
947	uint16_t error_mask = 0; /* 1 bit/byte in buf.  Err when set */
948
949	bzero(buffer.bytes, sizeof (uint8_t) * DUMP_BUF_SIZE);
950
951	local_prg = *prg_p;	/* Make local copy. */
952
953	/*
954	 * Flip the bytes to proper order if reading on a big endian machine.
955	 * Do this by reading big as little and vs.
956	 */
957#if (NATIVE_ENDIAN == PCITOOL_ACC_ATTR_ENDN_BIG)
958		local_prg.acc_attr =
959		    (PCITOOL_ACC_IS_BIG_ENDIAN(local_prg.acc_attr) ?
960		    (local_prg.acc_attr & ~PCITOOL_ACC_ATTR_ENDN_BIG) :
961		    (local_prg.acc_attr | PCITOOL_ACC_ATTR_ENDN_BIG));
962#endif
963
964	/*
965	 * Get offset into buffer for first store.  Assumes the buffer size is
966	 * a multiple of the read size.  "next" is the next buffer index to do
967	 * a store.
968	 */
969	skip_begin = local_prg.offset % DUMP_BUF_SIZE;
970	next = skip_begin / read_size;
971
972	print_bytedump_header(do_chardump);
973
974	while (dump_curr < dump_end) {
975
976		/* For reading from the next location. */
977		local_prg.offset = dump_curr;
978
979		/* Access the device.  Abort on error. */
980		if (((rval = ioctl(fd, cmd, &local_prg)) != SUCCESS) &&
981		    (!(continue_on_errs))) {
982			if (!(IS_QUIET(input_args_p->flags))) {
983				(void) fprintf(stderr,
984				    "Ioctl failed:\n errno: %s\n status: %s\n",
985				    strerror(errno),
986				    strstatus(local_prg.status));
987			}
988			break;
989		}
990
991		/*
992		 * Initialize print_addr first time through, in case printing
993		 * is starting in the middle of the buffer.  Also reinitialize
994		 * when wrap.
995		 */
996		if (print_addr == 0) {
997
998			/*
999			 * X86 config space doesn't return phys addr.
1000			 * Use offset instead in this case.
1001			 */
1002			if (local_prg.phys_addr == 0) {	/* No phys addr ret */
1003				print_addr = local_prg.offset -
1004				    (local_prg.offset % DUMP_BUF_SIZE);
1005			} else {
1006				print_addr = local_prg.phys_addr -
1007				    (local_prg.phys_addr % DUMP_BUF_SIZE);
1008			}
1009		}
1010
1011		/*
1012		 * Read error occurred.
1013		 * Shift the right number of error bits ((1 << read_size) - 1)
1014		 * into the right place (next * read_size)
1015		 */
1016		if (rval != SUCCESS) {	/* Read error occurred */
1017			error_mask |=
1018			    ((1 << read_size) - 1) << (next * read_size);
1019
1020		} else {	/* Save data to the buffer. */
1021
1022			switch (read_size) {
1023			case 1:
1024				buffer.bytes[next] = (uint8_t)local_prg.data;
1025				break;
1026			case 2:
1027				buffer.shorts[next] = (uint16_t)local_prg.data;
1028				break;
1029			case 4:
1030				buffer.dwords[next] = (uint32_t)local_prg.data;
1031				break;
1032			case 8:
1033				buffer.longs[next] = (uint64_t)local_prg.data;
1034				break;
1035			default:
1036				rval = EIO;
1037				break;
1038			}
1039		}
1040		next++;
1041
1042		/* Increment index for next store, and wrap. */
1043		next %= wrap_size;
1044		dump_curr += read_size;
1045
1046		/* Zero out the remainder of the buffer if done. */
1047		if (dump_curr >= dump_end) {
1048			if (next != 0) {
1049				bzero(&buffer.bytes[next * read_size],
1050				    (wrap_size - next) * read_size);
1051				skip_end = (wrap_size - next) * read_size;
1052				next = 0;	/* For printing below. */
1053			}
1054		}
1055
1056		/* Dump the buffer if full or if done. */
1057		if (next == 0) {
1058
1059			skip_begin2 = skip_begin;
1060			skip_end2 = skip_end;
1061
1062			(void) printf("\n0x%16.16" PRIx64 ":", print_addr);
1063			for (i = DUMP_BUF_SIZE - 1; i >= 0; i--) {
1064				if (skip_end) {
1065					skip_end--;
1066					(void) printf(" --");
1067				} else if (skip_begin > i) {
1068					skip_begin--;
1069					(void) printf(" --");
1070				} else if (error_mask & (1 << i)) {
1071					(void) printf(" XX");
1072				} else {
1073					(void) printf(" %2.2x",
1074					    buffer.bytes[i]);
1075				}
1076			}
1077
1078			if (do_chardump) {
1079				(void) putchar(' ');
1080				for (i = 0; i < DUMP_BUF_SIZE; i++) {
1081					if (skip_begin2) {
1082						skip_begin2--;
1083						(void) printf("-");
1084					} else if (
1085					    (DUMP_BUF_SIZE - skip_end2) <= i) {
1086						(void) printf("-");
1087					} else if (error_mask & (1 << i)) {
1088						(void) putchar('X');
1089					} else if (isprint(buffer.bytes[i])) {
1090						(void) putchar(buffer.bytes[i]);
1091					} else {
1092						(void) putchar('@');
1093					}
1094				}
1095			}
1096
1097			if ((++lines_since_header == LINES_BTWN_HEADER) &&
1098			    (dump_curr < dump_end)) {
1099				lines_since_header = 0;
1100				(void) puts("");
1101				print_bytedump_header(do_chardump);
1102			}
1103
1104			print_addr += DUMP_BUF_SIZE;
1105			error_mask = 0;
1106		}
1107	}
1108	(void) printf("\n");
1109
1110	return (rval);
1111}
1112
1113
1114/* ************** Device and nexus access commands ************** */
1115
1116/*
1117 * Helper function to set access attributes.  Assumes size is valid.
1118 */
1119static uint32_t
1120set_acc_attr(pcitool_uiargs_t *input_args_p)
1121{
1122	uint32_t access_attrs;
1123
1124	switch (input_args_p->size) {
1125	case 1:
1126		access_attrs = PCITOOL_ACC_ATTR_SIZE_1;
1127		break;
1128	case 2:
1129		access_attrs = PCITOOL_ACC_ATTR_SIZE_2;
1130		break;
1131	case 4:
1132		access_attrs = PCITOOL_ACC_ATTR_SIZE_4;
1133		break;
1134	case 8:
1135		access_attrs = PCITOOL_ACC_ATTR_SIZE_8;
1136		break;
1137	}
1138
1139	if (input_args_p->big_endian) {
1140		access_attrs |= PCITOOL_ACC_ATTR_ENDN_BIG;
1141	}
1142
1143	return (access_attrs);
1144}
1145
1146static int
1147do_single_access(int fd, int cmd, pcitool_reg_t *prg_p,
1148    pcitool_uiargs_t *input_args_p)
1149{
1150	boolean_t is_write = B_FALSE;
1151	int rval;
1152
1153	switch (cmd) {
1154		case PCITOOL_NEXUS_SET_REG:
1155		case PCITOOL_DEVICE_SET_REG:
1156			is_write = B_TRUE;
1157			break;
1158		default:
1159			break;
1160	}
1161
1162	/* Do the access.  Return on error. */
1163	if ((rval = ioctl(fd, cmd, prg_p)) != SUCCESS) {
1164		if (!(IS_QUIET(input_args_p->flags))) {
1165			(void) fprintf(stderr,
1166			    "%s ioctl failed:\n errno: %s\n status: %s\n",
1167			    is_write ? "write" : "read",
1168			    strerror(errno), strstatus(prg_p->status));
1169		}
1170
1171		return (rval);
1172	}
1173
1174	/* Print on all verbose requests. */
1175	if (IS_VERBOSE(input_args_p->flags)) {
1176
1177		/*
1178		 * Return offset on platforms which return phys_addr == 0
1179		 * for config space.
1180		 */
1181		if (prg_p->phys_addr == 0)
1182			prg_p->phys_addr = input_args_p->offset;
1183
1184		(void) printf("Addr:0x%" PRIx64 ", %d-byte %s endian "
1185		    "register value: 0x%" PRIx64 "\n",
1186		    prg_p->phys_addr, input_args_p->size,
1187		    (input_args_p->big_endian ? "big" : "little"), prg_p->data);
1188
1189	/* Non-verbose, read requests. */
1190	} else if (!(is_write)) {
1191		(void) printf("0x%" PRIx64 "\n", prg_p->data);
1192	}
1193
1194	return (rval);
1195}
1196
1197
1198/*
1199 * fd is the file descriptor of the nexus to access, either to get its
1200 * registers or to access a device through that nexus.
1201 *
1202 * input args are commandline arguments specified by the user.
1203 */
1204static int
1205do_device_or_nexus(int fd, pcitool_uiargs_t *input_args_p)
1206{
1207	pcitool_reg_t prg;	/* Request details given to the driver. */
1208	uint32_t write_cmd = 0;	/* Command given to the driver. */
1209	uint32_t read_cmd = 0;	/* Command given to the driver. */
1210	int rval = SUCCESS;	/* Return status. */
1211
1212	if (input_args_p->flags & WRITE_FLAG) {
1213		prg.data = input_args_p->write_value;
1214		if (input_args_p->flags & NEXUS_FLAG) {
1215			write_cmd = PCITOOL_NEXUS_SET_REG;
1216		} else {
1217			write_cmd = PCITOOL_DEVICE_SET_REG;
1218		}
1219	}
1220	if (input_args_p->flags & READ_FLAG) {
1221		if (input_args_p->flags & NEXUS_FLAG) {
1222			read_cmd = PCITOOL_NEXUS_GET_REG;
1223		} else {
1224			read_cmd = PCITOOL_DEVICE_GET_REG;
1225		}
1226	}
1227
1228	/* Finish initializing access details for driver. */
1229
1230	/*
1231	 * For nexus, barnum is the exact bank number, unless it is 0xFF, which
1232	 * indicates that it is inactive and a base_address should be read from
1233	 * the input_args instead.
1234	 *
1235	 * For devices, barnum is the offset to the desired BAR, or 0 for
1236	 * config space.
1237	 */
1238	if ((input_args_p->flags & (BASE_SPEC_FLAG | NEXUS_FLAG)) ==
1239	    (BASE_SPEC_FLAG | NEXUS_FLAG)) {
1240		prg.barnum = PCITOOL_BASE;
1241		prg.phys_addr = input_args_p->base_address;
1242	} else
1243		prg.barnum = input_args_p->bank;
1244
1245	prg.offset = input_args_p->offset;
1246	prg.acc_attr = set_acc_attr(input_args_p);
1247	prg.bus_no = input_args_p->bus;
1248	prg.dev_no = input_args_p->device;
1249	prg.func_no = input_args_p->function;
1250	prg.user_version = PCITOOL_VERSION;
1251
1252	do {
1253		/* Do a bytedump if desired, or else do single ioctl access. */
1254		if (input_args_p->flags & BYTEDUMP_FLAG) {
1255
1256			if (IS_VERBOSE(input_args_p->flags)) {
1257				(void) printf(
1258				    "\nDoing %d-byte %s endian reads:",
1259				    input_args_p->size,
1260				    input_args_p->big_endian ?
1261				    "big" : "little");
1262			}
1263			rval = bytedump_get(fd, read_cmd, &prg, input_args_p);
1264
1265		} else {
1266
1267			/* Single write and/or read. */
1268			if (write_cmd != 0) {
1269				rval = do_single_access(
1270				    fd, write_cmd, &prg, input_args_p);
1271			}
1272
1273			if ((rval == SUCCESS) && (read_cmd != 0)) {
1274				rval = do_single_access(
1275				    fd, read_cmd, &prg, input_args_p);
1276			}
1277		}
1278	} while ((IS_LOOP(input_args_p->flags)) && (rval == SUCCESS) &&
1279	    (keep_looping));
1280
1281	return (rval != SUCCESS ? errno : SUCCESS);
1282}
1283
1284/* *************** Interrupt routing ************** */
1285
1286/*
1287 * Display interrupt information.
1288 * iget is filled in with the info to display
1289 */
1290static void
1291print_intr_info(pcitool_intr_get_t *iget_p)
1292{
1293	int i;
1294
1295	if (iget_p->flags & PCITOOL_INTR_FLAG_GET_MSI)
1296		(void) printf("\nmsi 0x%x mapped to cpu 0x%x\n",
1297		    iget_p->msi,  iget_p->cpu_id);
1298	else
1299		(void) printf("\nino 0x%x mapped to cpu 0x%x\n",
1300		    iget_p->ino,  iget_p->cpu_id);
1301
1302	for (i = 0; i < iget_p->num_devs; i++) {
1303		(void) printf("Device: %s\n", iget_p->dev[i].path);
1304		(void) printf("  Driver: %s, instance %d\n",
1305		    iget_p->dev[i].driver_name, iget_p->dev[i].dev_inst);
1306	}
1307}
1308
1309/*
1310 * Interrupt command support.
1311 *
1312 * fd is the file descriptor of the nexus being probed.
1313 * input_args are commandline options entered by the user.
1314 */
1315static int
1316get_single_interrupt(int fd, pcitool_intr_get_t **iget_pp,
1317    pcitool_uiargs_t *input_args_p)
1318{
1319	pcitool_intr_get_t *iget_p = *iget_pp;
1320	const char	*str_type = NULL;
1321	uint32_t	intr;
1322
1323	if (input_args_p->flags & MSI_SPEC_FLAG) {
1324		intr = input_args_p->intr_msi;
1325		str_type = "msi";
1326	} else {
1327		intr = input_args_p->intr_ino;
1328		str_type = "ino";
1329	}
1330
1331	/*
1332	 * Check if interrupts are active on this ino/msi. Get as much
1333	 * device info as there is room for at the moment. If there
1334	 * is not enough room for all devices, will call again with a
1335	 * larger buffer.
1336	 */
1337	if (ioctl(fd, PCITOOL_DEVICE_GET_INTR, iget_p) != 0) {
1338		/*
1339		 * Let EIO errors silently slip through, as
1340		 * some inos may not be viewable by design.
1341		 * We don't want to stop or print an error for these.
1342		 */
1343		if (errno == EIO) {
1344			return (SUCCESS);
1345		}
1346
1347		if (!(IS_QUIET(input_args_p->flags))) {
1348			(void) fprintf(stderr, "Ioctl to get %s 0x%x "
1349			    "info failed: %s\n", str_type, intr,
1350			    strerror(errno));
1351
1352			if (errno != EFAULT) {
1353				(void) fprintf(stderr, "Pcitool status: %s\n",
1354				    strstatus(iget_p->status));
1355			}
1356		}
1357		return (errno);
1358	}
1359
1360	/* Nothing to report for this interrupt. */
1361	if (iget_p->num_devs == 0) {
1362		return (SUCCESS);
1363	}
1364
1365	/* Need more room to return additional device info. */
1366	if (iget_p->num_devs_ret < iget_p->num_devs) {
1367		iget_p = *iget_pp =
1368		    realloc(iget_p, PCITOOL_IGET_SIZE(iget_p->num_devs));
1369		iget_p->num_devs_ret = iget_p->num_devs;
1370
1371		if (ioctl(fd, PCITOOL_DEVICE_GET_INTR, iget_p) != 0) {
1372			if (!(IS_QUIET(input_args_p->flags))) {
1373				(void) fprintf(stderr, "Ioctl to get %s 0x%x"
1374				    "device info failed: %s\n", str_type,
1375				    intr, strerror(errno));
1376				if (errno != EFAULT) {
1377					(void) fprintf(stderr,
1378					    "Pcitool status: %s\n",
1379					    strstatus(iget_p->status));
1380				}
1381			}
1382			return (errno);
1383		}
1384	}
1385
1386	print_intr_info(iget_p);
1387	return (SUCCESS);
1388}
1389
1390#define	INIT_NUM_DEVS	0
1391
1392static int
1393get_interrupts(int fd, pcitool_uiargs_t *input_args_p)
1394{
1395	int rval = SUCCESS;	/* Return status. */
1396
1397	/*
1398	 * Start with a struct with space for info of INIT_NUM_DEVS devs
1399	 * to be returned.
1400	 */
1401	pcitool_intr_get_t *iget_p = malloc(PCITOOL_IGET_SIZE(INIT_NUM_DEVS));
1402
1403	iget_p->num_devs_ret = INIT_NUM_DEVS;
1404	iget_p->user_version = PCITOOL_VERSION;
1405
1406	/* Explicit MSI requested. */
1407	if (input_args_p->flags & MSI_SPEC_FLAG) {
1408		iget_p->msi = input_args_p->intr_msi;
1409		iget_p->flags = PCITOOL_INTR_FLAG_GET_MSI;
1410		rval = get_single_interrupt(fd, &iget_p, input_args_p);
1411		/* Return all MSIs. */
1412	} else if (input_args_p->flags & MSI_ALL_FLAG) {
1413		pcitool_intr_info_t intr_info;
1414		intr_info.flags = PCITOOL_INTR_FLAG_GET_MSI;
1415
1416		if (ioctl(fd, PCITOOL_SYSTEM_INTR_INFO, &intr_info) != 0) {
1417			if (!(IS_QUIET(input_args_p->flags))) {
1418				(void) fprintf(stderr,
1419				    "intr info ioctl failed: %s\n",
1420				    strerror(errno));
1421			}
1422		} else {
1423			int msi;
1424
1425			/*
1426			 * Search through all interrupts.
1427			 * Display info on enabled ones.
1428			 */
1429			for (msi = 0;
1430			    ((msi < intr_info.num_intr) && (rval == SUCCESS));
1431			    msi++) {
1432				bzero(iget_p, sizeof (pcitool_intr_get_t));
1433				iget_p->num_devs_ret = INIT_NUM_DEVS;
1434				iget_p->user_version = PCITOOL_VERSION;
1435				iget_p->flags = PCITOOL_INTR_FLAG_GET_MSI;
1436				iget_p->msi = msi;
1437				rval = get_single_interrupt(
1438				    fd, &iget_p, input_args_p);
1439			}
1440		}
1441		/* Explicit INO requested. */
1442	} else if (input_args_p->flags & INO_SPEC_FLAG) {
1443		iget_p->ino = input_args_p->intr_ino;
1444		rval = get_single_interrupt(fd, &iget_p, input_args_p);
1445		/* Return all INOs. */
1446	} else if (input_args_p->flags & INO_ALL_FLAG) {
1447		pcitool_intr_info_t intr_info;
1448		intr_info.flags = 0;
1449
1450		if (ioctl(fd, PCITOOL_SYSTEM_INTR_INFO, &intr_info) != 0) {
1451			if (!(IS_QUIET(input_args_p->flags))) {
1452				(void) fprintf(stderr,
1453				    "intr info ioctl failed: %s\n",
1454				    strerror(errno));
1455			}
1456		} else {
1457			int ino;
1458
1459			/*
1460			 * Search through all interrupts.
1461			 * Display info on enabled ones.
1462			 */
1463			for (ino = 0;
1464			    ((ino < intr_info.num_intr) && (rval == SUCCESS));
1465			    ino++) {
1466				bzero(iget_p, sizeof (pcitool_intr_get_t));
1467				iget_p->num_devs_ret = INIT_NUM_DEVS;
1468				iget_p->user_version = PCITOOL_VERSION;
1469				iget_p->ino = ino;
1470				rval = get_single_interrupt(
1471				    fd, &iget_p, input_args_p);
1472			}
1473		}
1474	}
1475
1476	free(iget_p);
1477
1478	return (rval);
1479}
1480
1481
1482static int
1483get_interrupt_ctlr(int fd, pcitool_uiargs_t *input_args_p)
1484{
1485	pcitool_intr_info_t intr_info;
1486	char *ctlr_type = NULL;
1487	int rval = SUCCESS;
1488
1489	intr_info.flags = 0;
1490	if (ioctl(fd, PCITOOL_SYSTEM_INTR_INFO, &intr_info) != 0) {
1491		if (!(IS_QUIET(input_args_p->flags))) {
1492			(void) perror("Ioctl to get intr ctlr info failed");
1493		}
1494		rval = errno;
1495
1496	} else {
1497		(void) fputs("Controller type: ", stdout);
1498		switch (intr_info.ctlr_type) {
1499		case PCITOOL_CTLR_TYPE_RISC:
1500			ctlr_type = "RISC";
1501			break;
1502		case PCITOOL_CTLR_TYPE_UPPC:
1503			ctlr_type = "UPPC";
1504			break;
1505		case PCITOOL_CTLR_TYPE_PCPLUSMP:
1506			ctlr_type = "PCPLUSMP";
1507			break;
1508		default:
1509			break;
1510		}
1511
1512		if (ctlr_type == NULL) {
1513			(void) printf("Unknown or new (%d)",
1514			    intr_info.ctlr_type);
1515		} else {
1516			(void) fputs(ctlr_type, stdout);
1517		}
1518
1519#ifdef __x86
1520		if (intr_info.ctlr_type == PCITOOL_CTLR_TYPE_PCPLUSMP)
1521			(void) printf(", IO APIC version: 0x%x, "
1522			    "local APIC version: 0x%x\n",
1523			    PSMAT_IO_APIC_VER(intr_info.ctlr_version),
1524			    PSMAT_LOCAL_APIC_VER(intr_info.ctlr_version));
1525		else
1526#endif /* __x86 */
1527			(void) printf(", version: %2.2x.%2.2x.%2.2x.%2.2x\n",
1528			    ((intr_info.ctlr_version >> 24) & 0xff),
1529			    ((intr_info.ctlr_version >> 16) & 0xff),
1530			    ((intr_info.ctlr_version >> 8) & 0xff),
1531			    (intr_info.ctlr_version & 0xff));
1532	}
1533
1534	return (rval);
1535}
1536
1537/*
1538 *
1539 * fd is the file descriptor of the nexus being changed.
1540 * input_args are commandline options entered by the user.
1541 */
1542static int
1543set_interrupts(int fd, pcitool_uiargs_t *input_args_p)
1544{
1545	pcitool_intr_set_t	iset;
1546	const char		*str_type = NULL;
1547	uint32_t		intr;
1548	int			rval = SUCCESS;	/* Return status. */
1549
1550	/* Load interrupt number and cpu from commandline. */
1551	if (input_args_p->flags & MSI_SPEC_FLAG) {
1552		iset.msi = intr = input_args_p->intr_msi;
1553		iset.flags = PCITOOL_INTR_FLAG_SET_MSI;
1554		str_type = "msi";
1555	} else {
1556		iset.ino = intr = input_args_p->intr_ino;
1557		iset.flags = 0;
1558		str_type = "ino";
1559	}
1560
1561	iset.cpu_id = input_args_p->intr_cpu;
1562	iset.user_version = PCITOOL_VERSION;
1563	iset.flags |= (input_args_p->flags & SETGRP_FLAG) ?
1564	    PCITOOL_INTR_FLAG_SET_GROUP : 0;
1565
1566	/* Do the deed. */
1567	if (ioctl(fd, PCITOOL_DEVICE_SET_INTR, &iset) != 0) {
1568		if (!(IS_QUIET(input_args_p->flags))) {
1569			(void) fprintf(stderr,
1570			    "Ioctl to set %s 0x%x failed: %s\n",
1571			    str_type, intr, strerror(errno));
1572			(void) fprintf(stderr, "pcitool status: %s\n",
1573			    strstatus(iset.status));
1574		}
1575		rval = errno;
1576	} else {
1577		if (input_args_p->flags & SETGRP_FLAG) {
1578			(void) printf("\nInterrupts on %s group starting "
1579			    "at %s 0x%x reassigned:", str_type, str_type, intr);
1580		} else {
1581			(void) printf("\nInterrupts on %s 0x%x reassigned:",
1582			    str_type, intr);
1583		}
1584		(void) printf(" Old cpu: 0x%x, New cpu: 0x%x\n", iset.cpu_id,
1585		    input_args_p->intr_cpu);
1586	}
1587
1588	return (rval);
1589}
1590
1591
1592static int
1593do_interrupts(int fd, pcitool_uiargs_t *input_args_p)
1594{
1595	if (input_args_p->flags & READ_FLAG) {
1596
1597		int gic_rval;
1598		int gi_rval;
1599
1600		if (input_args_p->flags &  SHOWCTLR_FLAG) {
1601			gic_rval = get_interrupt_ctlr(fd, input_args_p);
1602		}
1603
1604		gi_rval = get_interrupts(fd, input_args_p);
1605		return ((gi_rval != SUCCESS) ? gi_rval : gic_rval);
1606
1607	} else {
1608
1609		return (set_interrupts(fd, input_args_p));
1610	}
1611}
1612
1613
1614/* *********** Where it all begins... ************* */
1615
1616int
1617main(int argc, char **argv)
1618{
1619	pcitool_uiargs_t input_args;	/* Commandline args. */
1620	int fd;				/* Nexus file descriptor. */
1621	int rval = SUCCESS;		/* Return status value. */
1622
1623
1624	/* Get commandline args and options from user. */
1625	if (get_commandline_args(argc, argv, &input_args) != SUCCESS) {
1626		return (EINVAL);
1627	}
1628
1629	/* Help. */
1630	if (!(input_args.flags & ALL_COMMANDS))
1631		return (SUCCESS);
1632
1633	/*
1634	 * Probe mode.
1635	 * Nexus is provided as argv[1] unless PROBEALL mode.
1636	 */
1637	if (input_args.flags & PROBE_FLAGS) {
1638		rval = do_probe_walk(&input_args,
1639		    ((input_args.flags & PROBEALL_FLAG) ? NULL : argv[1]));
1640
1641	} else if ((fd = open_node(argv[1], &input_args)) >= 0) {
1642		if (input_args.flags & (NEXUS_FLAG | LEAF_FLAG)) {
1643			(void) signal(SIGINT, signal_handler);
1644			(void) signal(SIGTERM, signal_handler);
1645			rval = do_device_or_nexus(fd, &input_args);
1646		} else if (input_args.flags & INTR_FLAG) {
1647			rval = do_interrupts(fd, &input_args);
1648		} else {
1649			/* Should never see this. */
1650			(void) fprintf(stderr, "Nothing to do.\n");
1651			rval = ENOTTY;
1652		}
1653
1654		(void) close(fd);
1655	}
1656
1657	return (rval);
1658}
1659