xref: /freebsd/usr.sbin/cxgbetool/cxgbetool.c (revision b0b1dbdd)
1 /*-
2  * Copyright (c) 2011 Chelsio Communications, Inc.
3  * All rights reserved.
4  * Written by: Navdeep Parhar <np@FreeBSD.org>
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25  * SUCH DAMAGE.
26  */
27 
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD$");
30 
31 #include <sys/param.h>
32 #include <sys/ioctl.h>
33 #include <sys/mman.h>
34 #include <sys/socket.h>
35 #include <sys/stat.h>
36 
37 #include <arpa/inet.h>
38 #include <net/ethernet.h>
39 #include <net/sff8472.h>
40 #include <netinet/in.h>
41 
42 #include <ctype.h>
43 #include <err.h>
44 #include <errno.h>
45 #include <fcntl.h>
46 #include <limits.h>
47 #include <stdint.h>
48 #include <stdio.h>
49 #include <stdlib.h>
50 #include <string.h>
51 #include <unistd.h>
52 
53 #include "t4_ioctl.h"
54 
55 #define in_range(val, lo, hi) ( val < 0 || (val <= hi && val >= lo))
56 #define	max(x, y) ((x) > (y) ? (x) : (y))
57 
58 static const char *progname, *nexus;
59 static int chip_id;	/* 4 for T4, 5 for T5 */
60 
61 struct reg_info {
62 	const char *name;
63 	uint32_t addr;
64 	uint32_t len;
65 };
66 
67 struct mod_regs {
68 	const char *name;
69 	const struct reg_info *ri;
70 };
71 
72 struct field_desc {
73 	const char *name;     /* Field name */
74 	unsigned short start; /* Start bit position */
75 	unsigned short end;   /* End bit position */
76 	unsigned char shift;  /* # of low order bits omitted and implicitly 0 */
77 	unsigned char hex;    /* Print field in hex instead of decimal */
78 	unsigned char islog2; /* Field contains the base-2 log of the value */
79 };
80 
81 #include "reg_defs_t4.c"
82 #include "reg_defs_t5.c"
83 #include "reg_defs_t6.c"
84 #include "reg_defs_t4vf.c"
85 
86 static void
87 usage(FILE *fp)
88 {
89 	fprintf(fp, "Usage: %s <nexus> [operation]\n", progname);
90 	fprintf(fp,
91 	    "\tclearstats <port>                   clear port statistics\n"
92 	    "\tcontext <type> <id>                 show an SGE context\n"
93 	    "\tfilter <idx> [<param> <val>] ...    set a filter\n"
94 	    "\tfilter <idx> delete|clear           delete a filter\n"
95 	    "\tfilter list                         list all filters\n"
96 	    "\tfilter mode [<match>] ...           get/set global filter mode\n"
97 	    "\ti2c <port> <devaddr> <addr> [<len>] read from i2c device\n"
98 	    "\tloadcfg <fw-config.txt>             install configuration file\n"
99 	    "\tloadcfg clear                       remove configuration file\n"
100 	    "\tloadfw <fw-image.bin>               install firmware\n"
101 	    "\tmemdump <addr> <len>                dump a memory range\n"
102 	    "\tmodinfo <port> [raw]                optics/cable information\n"
103 	    "\treg <address>[=<val>]               read/write register\n"
104 	    "\treg64 <address>[=<val>]             read/write 64 bit register\n"
105 	    "\tregdump [<module>] ...              dump registers\n"
106 	    "\tsched-class params <param> <val> .. configure TX scheduler class\n"
107 	    "\tsched-queue <port> <queue> <class>  bind NIC queues to TX Scheduling class\n"
108 	    "\tstdio                               interactive mode\n"
109 	    "\ttcb <tid>                           read TCB\n"
110 	    "\ttracer <idx> tx<n>|rx<n>            set and enable a tracer\n"
111 	    "\ttracer <idx> disable|enable         disable or enable a tracer\n"
112 	    "\ttracer list                         list all tracers\n"
113 	    );
114 }
115 
116 static inline unsigned int
117 get_card_vers(unsigned int version)
118 {
119 	return (version & 0x3ff);
120 }
121 
122 static int
123 real_doit(unsigned long cmd, void *data, const char *cmdstr)
124 {
125 	static int fd = -1;
126 	int rc = 0;
127 
128 	if (fd == -1) {
129 		char buf[64];
130 
131 		snprintf(buf, sizeof(buf), "/dev/%s", nexus);
132 		if ((fd = open(buf, O_RDWR)) < 0) {
133 			warn("open(%s)", nexus);
134 			rc = errno;
135 			return (rc);
136 		}
137 		chip_id = nexus[1] - '0';
138 	}
139 
140 	rc = ioctl(fd, cmd, data);
141 	if (rc < 0) {
142 		warn("%s", cmdstr);
143 		rc = errno;
144 	}
145 
146 	return (rc);
147 }
148 #define doit(x, y) real_doit(x, y, #x)
149 
150 static char *
151 str_to_number(const char *s, long *val, long long *vall)
152 {
153 	char *p;
154 
155 	if (vall)
156 		*vall = strtoll(s, &p, 0);
157 	else if (val)
158 		*val = strtol(s, &p, 0);
159 	else
160 		p = NULL;
161 
162 	return (p);
163 }
164 
165 static int
166 read_reg(long addr, int size, long long *val)
167 {
168 	struct t4_reg reg;
169 	int rc;
170 
171 	reg.addr = (uint32_t) addr;
172 	reg.size = (uint32_t) size;
173 	reg.val = 0;
174 
175 	rc = doit(CHELSIO_T4_GETREG, &reg);
176 
177 	*val = reg.val;
178 
179 	return (rc);
180 }
181 
182 static int
183 write_reg(long addr, int size, long long val)
184 {
185 	struct t4_reg reg;
186 
187 	reg.addr = (uint32_t) addr;
188 	reg.size = (uint32_t) size;
189 	reg.val = (uint64_t) val;
190 
191 	return doit(CHELSIO_T4_SETREG, &reg);
192 }
193 
194 static int
195 register_io(int argc, const char *argv[], int size)
196 {
197 	char *p, *v;
198 	long addr;
199 	long long val;
200 	int w = 0, rc;
201 
202 	if (argc == 1) {
203 		/* <reg> OR <reg>=<value> */
204 
205 		p = str_to_number(argv[0], &addr, NULL);
206 		if (*p) {
207 			if (*p != '=') {
208 				warnx("invalid register \"%s\"", argv[0]);
209 				return (EINVAL);
210 			}
211 
212 			w = 1;
213 			v = p + 1;
214 			p = str_to_number(v, NULL, &val);
215 
216 			if (*p) {
217 				warnx("invalid value \"%s\"", v);
218 				return (EINVAL);
219 			}
220 		}
221 
222 	} else if (argc == 2) {
223 		/* <reg> <value> */
224 
225 		w = 1;
226 
227 		p = str_to_number(argv[0], &addr, NULL);
228 		if (*p) {
229 			warnx("invalid register \"%s\"", argv[0]);
230 			return (EINVAL);
231 		}
232 
233 		p = str_to_number(argv[1], NULL, &val);
234 		if (*p) {
235 			warnx("invalid value \"%s\"", argv[1]);
236 			return (EINVAL);
237 		}
238 	} else {
239 		warnx("reg: invalid number of arguments (%d)", argc);
240 		return (EINVAL);
241 	}
242 
243 	if (w)
244 		rc = write_reg(addr, size, val);
245 	else {
246 		rc = read_reg(addr, size, &val);
247 		if (rc == 0)
248 			printf("0x%llx [%llu]\n", val, val);
249 	}
250 
251 	return (rc);
252 }
253 
254 static inline uint32_t
255 xtract(uint32_t val, int shift, int len)
256 {
257 	return (val >> shift) & ((1 << len) - 1);
258 }
259 
260 static int
261 dump_block_regs(const struct reg_info *reg_array, const uint32_t *regs)
262 {
263 	uint32_t reg_val = 0;
264 
265 	for ( ; reg_array->name; ++reg_array)
266 		if (!reg_array->len) {
267 			reg_val = regs[reg_array->addr / 4];
268 			printf("[%#7x] %-47s %#-10x %u\n", reg_array->addr,
269 			       reg_array->name, reg_val, reg_val);
270 		} else {
271 			uint32_t v = xtract(reg_val, reg_array->addr,
272 					    reg_array->len);
273 
274 			printf("    %*u:%u %-47s %#-10x %u\n",
275 			       reg_array->addr < 10 ? 3 : 2,
276 			       reg_array->addr + reg_array->len - 1,
277 			       reg_array->addr, reg_array->name, v, v);
278 		}
279 
280 	return (1);
281 }
282 
283 static int
284 dump_regs_table(int argc, const char *argv[], const uint32_t *regs,
285     const struct mod_regs *modtab, int nmodules)
286 {
287 	int i, j, match;
288 
289 	for (i = 0; i < argc; i++) {
290 		for (j = 0; j < nmodules; j++) {
291 			if (!strcmp(argv[i], modtab[j].name))
292 				break;
293 		}
294 
295 		if (j == nmodules) {
296 			warnx("invalid register block \"%s\"", argv[i]);
297 			fprintf(stderr, "\nAvailable blocks:");
298 			for ( ; nmodules; nmodules--, modtab++)
299 				fprintf(stderr, " %s", modtab->name);
300 			fprintf(stderr, "\n");
301 			return (EINVAL);
302 		}
303 	}
304 
305 	for ( ; nmodules; nmodules--, modtab++) {
306 
307 		match = argc == 0 ? 1 : 0;
308 		for (i = 0; !match && i < argc; i++) {
309 			if (!strcmp(argv[i], modtab->name))
310 				match = 1;
311 		}
312 
313 		if (match)
314 			dump_block_regs(modtab->ri, regs);
315 	}
316 
317 	return (0);
318 }
319 
320 #define T4_MODREGS(name) { #name, t4_##name##_regs }
321 static int
322 dump_regs_t4(int argc, const char *argv[], const uint32_t *regs)
323 {
324 	static struct mod_regs t4_mod[] = {
325 		T4_MODREGS(sge),
326 		{ "pci", t4_pcie_regs },
327 		T4_MODREGS(dbg),
328 		T4_MODREGS(mc),
329 		T4_MODREGS(ma),
330 		{ "edc0", t4_edc_0_regs },
331 		{ "edc1", t4_edc_1_regs },
332 		T4_MODREGS(cim),
333 		T4_MODREGS(tp),
334 		T4_MODREGS(ulp_rx),
335 		T4_MODREGS(ulp_tx),
336 		{ "pmrx", t4_pm_rx_regs },
337 		{ "pmtx", t4_pm_tx_regs },
338 		T4_MODREGS(mps),
339 		{ "cplsw", t4_cpl_switch_regs },
340 		T4_MODREGS(smb),
341 		{ "i2c", t4_i2cm_regs },
342 		T4_MODREGS(mi),
343 		T4_MODREGS(uart),
344 		T4_MODREGS(pmu),
345 		T4_MODREGS(sf),
346 		T4_MODREGS(pl),
347 		T4_MODREGS(le),
348 		T4_MODREGS(ncsi),
349 		T4_MODREGS(xgmac)
350 	};
351 
352 	return dump_regs_table(argc, argv, regs, t4_mod, nitems(t4_mod));
353 }
354 #undef T4_MODREGS
355 
356 #define T5_MODREGS(name) { #name, t5_##name##_regs }
357 static int
358 dump_regs_t5(int argc, const char *argv[], const uint32_t *regs)
359 {
360 	static struct mod_regs t5_mod[] = {
361 		T5_MODREGS(sge),
362 		{ "pci", t5_pcie_regs },
363 		T5_MODREGS(dbg),
364 		{ "mc0", t5_mc_0_regs },
365 		{ "mc1", t5_mc_1_regs },
366 		T5_MODREGS(ma),
367 		{ "edc0", t5_edc_t50_regs },
368 		{ "edc1", t5_edc_t51_regs },
369 		T5_MODREGS(cim),
370 		T5_MODREGS(tp),
371 		{ "ulprx", t5_ulp_rx_regs },
372 		{ "ulptx", t5_ulp_tx_regs },
373 		{ "pmrx", t5_pm_rx_regs },
374 		{ "pmtx", t5_pm_tx_regs },
375 		T5_MODREGS(mps),
376 		{ "cplsw", t5_cpl_switch_regs },
377 		T5_MODREGS(smb),
378 		{ "i2c", t5_i2cm_regs },
379 		T5_MODREGS(mi),
380 		T5_MODREGS(uart),
381 		T5_MODREGS(pmu),
382 		T5_MODREGS(sf),
383 		T5_MODREGS(pl),
384 		T5_MODREGS(le),
385 		T5_MODREGS(ncsi),
386 		T5_MODREGS(mac),
387 		{ "hma", t5_hma_t5_regs }
388 	};
389 
390 	return dump_regs_table(argc, argv, regs, t5_mod, nitems(t5_mod));
391 }
392 #undef T5_MODREGS
393 
394 #define T6_MODREGS(name) { #name, t6_##name##_regs }
395 static int
396 dump_regs_t6(int argc, const char *argv[], const uint32_t *regs)
397 {
398 	static struct mod_regs t6_mod[] = {
399 		T6_MODREGS(sge),
400 		{ "pci", t6_pcie_regs },
401 		T6_MODREGS(dbg),
402 		{ "mc0", t6_mc_0_regs },
403 		T6_MODREGS(ma),
404 		{ "edc0", t6_edc_t60_regs },
405 		{ "edc1", t6_edc_t61_regs },
406 		T6_MODREGS(cim),
407 		T6_MODREGS(tp),
408 		{ "ulprx", t6_ulp_rx_regs },
409 		{ "ulptx", t6_ulp_tx_regs },
410 		{ "pmrx", t6_pm_rx_regs },
411 		{ "pmtx", t6_pm_tx_regs },
412 		T6_MODREGS(mps),
413 		{ "cplsw", t6_cpl_switch_regs },
414 		T6_MODREGS(smb),
415 		{ "i2c", t6_i2cm_regs },
416 		T6_MODREGS(mi),
417 		T6_MODREGS(uart),
418 		T6_MODREGS(pmu),
419 		T6_MODREGS(sf),
420 		T6_MODREGS(pl),
421 		T6_MODREGS(le),
422 		T6_MODREGS(ncsi),
423 		T6_MODREGS(mac),
424 		{ "hma", t6_hma_t6_regs }
425 	};
426 
427 	return dump_regs_table(argc, argv, regs, t6_mod, nitems(t6_mod));
428 }
429 #undef T6_MODREGS
430 
431 static int
432 dump_regs_t4vf(int argc, const char *argv[], const uint32_t *regs)
433 {
434 	static struct mod_regs t4vf_mod[] = {
435 		{ "sge", t4vf_sge_regs },
436 		{ "mps", t4vf_mps_regs },
437 		{ "pl", t4vf_pl_regs },
438 		{ "mbdata", t4vf_mbdata_regs },
439 		{ "cim", t4vf_cim_regs },
440 	};
441 
442 	return dump_regs_table(argc, argv, regs, t4vf_mod, nitems(t4vf_mod));
443 }
444 
445 static int
446 dump_regs_t5vf(int argc, const char *argv[], const uint32_t *regs)
447 {
448 	static struct mod_regs t5vf_mod[] = {
449 		{ "sge", t5vf_sge_regs },
450 		{ "mps", t4vf_mps_regs },
451 		{ "pl", t5vf_pl_regs },
452 		{ "mbdata", t4vf_mbdata_regs },
453 		{ "cim", t4vf_cim_regs },
454 	};
455 
456 	return dump_regs_table(argc, argv, regs, t5vf_mod, nitems(t5vf_mod));
457 }
458 
459 static int
460 dump_regs_t6vf(int argc, const char *argv[], const uint32_t *regs)
461 {
462 	static struct mod_regs t6vf_mod[] = {
463 		{ "sge", t5vf_sge_regs },
464 		{ "mps", t4vf_mps_regs },
465 		{ "pl", t6vf_pl_regs },
466 		{ "mbdata", t4vf_mbdata_regs },
467 		{ "cim", t4vf_cim_regs },
468 	};
469 
470 	return dump_regs_table(argc, argv, regs, t6vf_mod, nitems(t6vf_mod));
471 }
472 
473 static int
474 dump_regs(int argc, const char *argv[])
475 {
476 	int vers, revision, rc;
477 	struct t4_regdump regs;
478 	uint32_t len;
479 
480 	len = max(T4_REGDUMP_SIZE, T5_REGDUMP_SIZE);
481 	regs.data = calloc(1, len);
482 	if (regs.data == NULL) {
483 		warnc(ENOMEM, "regdump");
484 		return (ENOMEM);
485 	}
486 
487 	regs.len = len;
488 	rc = doit(CHELSIO_T4_REGDUMP, &regs);
489 	if (rc != 0)
490 		return (rc);
491 
492 	vers = get_card_vers(regs.version);
493 	revision = (regs.version >> 10) & 0x3f;
494 
495 	if (vers == 4) {
496 		if (revision == 0x3f)
497 			rc = dump_regs_t4vf(argc, argv, regs.data);
498 		else
499 			rc = dump_regs_t4(argc, argv, regs.data);
500 	} else if (vers == 5) {
501 		if (revision == 0x3f)
502 			rc = dump_regs_t5vf(argc, argv, regs.data);
503 		else
504 			rc = dump_regs_t5(argc, argv, regs.data);
505 	} else if (vers == 6) {
506 		if (revision == 0x3f)
507 			rc = dump_regs_t6vf(argc, argv, regs.data);
508 		else
509 			rc = dump_regs_t6(argc, argv, regs.data);
510 	} else {
511 		warnx("%s (type %d, rev %d) is not a known card.",
512 		    nexus, vers, revision);
513 		return (ENOTSUP);
514 	}
515 
516 	free(regs.data);
517 	return (rc);
518 }
519 
520 static void
521 do_show_info_header(uint32_t mode)
522 {
523 	uint32_t i;
524 
525 	printf("%4s %8s", "Idx", "Hits");
526 	for (i = T4_FILTER_FCoE; i <= T4_FILTER_IP_FRAGMENT; i <<= 1) {
527 		switch (mode & i) {
528 		case T4_FILTER_FCoE:
529 			printf(" FCoE");
530 			break;
531 
532 		case T4_FILTER_PORT:
533 			printf(" Port");
534 			break;
535 
536 		case T4_FILTER_VNIC:
537 			if (mode & T4_FILTER_IC_VNIC)
538 				printf("   VFvld:PF:VF");
539 			else
540 				printf("     vld:oVLAN");
541 			break;
542 
543 		case T4_FILTER_VLAN:
544 			printf("      vld:VLAN");
545 			break;
546 
547 		case T4_FILTER_IP_TOS:
548 			printf("   TOS");
549 			break;
550 
551 		case T4_FILTER_IP_PROTO:
552 			printf("  Prot");
553 			break;
554 
555 		case T4_FILTER_ETH_TYPE:
556 			printf("   EthType");
557 			break;
558 
559 		case T4_FILTER_MAC_IDX:
560 			printf("  MACIdx");
561 			break;
562 
563 		case T4_FILTER_MPS_HIT_TYPE:
564 			printf(" MPS");
565 			break;
566 
567 		case T4_FILTER_IP_FRAGMENT:
568 			printf(" Frag");
569 			break;
570 
571 		default:
572 			/* compressed filter field not enabled */
573 			break;
574 		}
575 	}
576 	printf(" %20s %20s %9s %9s %s\n",
577 	    "DIP", "SIP", "DPORT", "SPORT", "Action");
578 }
579 
580 /*
581  * Parse an argument sub-vector as a { <parameter name> <value>[:<mask>] }
582  * ordered tuple.  If the parameter name in the argument sub-vector does not
583  * match the passed in parameter name, then a zero is returned for the
584  * function and no parsing is performed.  If there is a match, then the value
585  * and optional mask are parsed and returned in the provided return value
586  * pointers.  If no optional mask is specified, then a default mask of all 1s
587  * will be returned.
588  *
589  * An error in parsing the value[:mask] will result in an error message and
590  * program termination.
591  */
592 static int
593 parse_val_mask(const char *param, const char *args[], uint32_t *val,
594     uint32_t *mask)
595 {
596 	char *p;
597 
598 	if (strcmp(param, args[0]) != 0)
599 		return (EINVAL);
600 
601 	*val = strtoul(args[1], &p, 0);
602 	if (p > args[1]) {
603 		if (p[0] == 0) {
604 			*mask = ~0;
605 			return (0);
606 		}
607 
608 		if (p[0] == ':' && p[1] != 0) {
609 			*mask = strtoul(p+1, &p, 0);
610 			if (p[0] == 0)
611 				return (0);
612 		}
613 	}
614 
615 	warnx("parameter \"%s\" has bad \"value[:mask]\" %s",
616 	    args[0], args[1]);
617 
618 	return (EINVAL);
619 }
620 
621 /*
622  * Parse an argument sub-vector as a { <parameter name> <addr>[/<mask>] }
623  * ordered tuple.  If the parameter name in the argument sub-vector does not
624  * match the passed in parameter name, then a zero is returned for the
625  * function and no parsing is performed.  If there is a match, then the value
626  * and optional mask are parsed and returned in the provided return value
627  * pointers.  If no optional mask is specified, then a default mask of all 1s
628  * will be returned.
629  *
630  * The value return parameter "afp" is used to specify the expected address
631  * family -- IPv4 or IPv6 -- of the address[/mask] and return its actual
632  * format.  A passed in value of AF_UNSPEC indicates that either IPv4 or IPv6
633  * is acceptable; AF_INET means that only IPv4 addresses are acceptable; and
634  * AF_INET6 means that only IPv6 are acceptable.  AF_INET is returned for IPv4
635  * and AF_INET6 for IPv6 addresses, respectively.  IPv4 address/mask pairs are
636  * returned in the first four bytes of the address and mask return values with
637  * the address A.B.C.D returned with { A, B, C, D } returned in addresses { 0,
638  * 1, 2, 3}, respectively.
639  *
640  * An error in parsing the value[:mask] will result in an error message and
641  * program termination.
642  */
643 static int
644 parse_ipaddr(const char *param, const char *args[], int *afp, uint8_t addr[],
645     uint8_t mask[])
646 {
647 	const char *colon, *afn;
648 	char *slash;
649 	uint8_t *m;
650 	int af, ret;
651 	unsigned int masksize;
652 
653 	/*
654 	 * Is this our parameter?
655 	 */
656 	if (strcmp(param, args[0]) != 0)
657 		return (EINVAL);
658 
659 	/*
660 	 * Fundamental IPv4 versus IPv6 selection.
661 	 */
662 	colon = strchr(args[1], ':');
663 	if (!colon) {
664 		afn = "IPv4";
665 		af = AF_INET;
666 		masksize = 32;
667 	} else {
668 		afn = "IPv6";
669 		af = AF_INET6;
670 		masksize = 128;
671 	}
672 	if (*afp == AF_UNSPEC)
673 		*afp = af;
674 	else if (*afp != af) {
675 		warnx("address %s is not of expected family %s",
676 		    args[1], *afp == AF_INET ? "IP" : "IPv6");
677 		return (EINVAL);
678 	}
679 
680 	/*
681 	 * Parse address (temporarily stripping off any "/mask"
682 	 * specification).
683 	 */
684 	slash = strchr(args[1], '/');
685 	if (slash)
686 		*slash = 0;
687 	ret = inet_pton(af, args[1], addr);
688 	if (slash)
689 		*slash = '/';
690 	if (ret <= 0) {
691 		warnx("Cannot parse %s %s address %s", param, afn, args[1]);
692 		return (EINVAL);
693 	}
694 
695 	/*
696 	 * Parse optional mask specification.
697 	 */
698 	if (slash) {
699 		char *p;
700 		unsigned int prefix = strtoul(slash + 1, &p, 10);
701 
702 		if (p == slash + 1) {
703 			warnx("missing address prefix for %s", param);
704 			return (EINVAL);
705 		}
706 		if (*p) {
707 			warnx("%s is not a valid address prefix", slash + 1);
708 			return (EINVAL);
709 		}
710 		if (prefix > masksize) {
711 			warnx("prefix %u is too long for an %s address",
712 			     prefix, afn);
713 			return (EINVAL);
714 		}
715 		memset(mask, 0, masksize / 8);
716 		masksize = prefix;
717 	}
718 
719 	/*
720 	 * Fill in mask.
721 	 */
722 	for (m = mask; masksize >= 8; m++, masksize -= 8)
723 		*m = ~0;
724 	if (masksize)
725 		*m = ~0 << (8 - masksize);
726 
727 	return (0);
728 }
729 
730 /*
731  * Parse an argument sub-vector as a { <parameter name> <value> } ordered
732  * tuple.  If the parameter name in the argument sub-vector does not match the
733  * passed in parameter name, then a zero is returned for the function and no
734  * parsing is performed.  If there is a match, then the value is parsed and
735  * returned in the provided return value pointer.
736  */
737 static int
738 parse_val(const char *param, const char *args[], uint32_t *val)
739 {
740 	char *p;
741 
742 	if (strcmp(param, args[0]) != 0)
743 		return (EINVAL);
744 
745 	*val = strtoul(args[1], &p, 0);
746 	if (p > args[1] && p[0] == 0)
747 		return (0);
748 
749 	warnx("parameter \"%s\" has bad \"value\" %s", args[0], args[1]);
750 	return (EINVAL);
751 }
752 
753 static void
754 filters_show_ipaddr(int type, uint8_t *addr, uint8_t *addrm)
755 {
756 	int noctets, octet;
757 
758 	printf(" ");
759 	if (type == 0) {
760 		noctets = 4;
761 		printf("%3s", " ");
762 	} else
763 	noctets = 16;
764 
765 	for (octet = 0; octet < noctets; octet++)
766 		printf("%02x", addr[octet]);
767 	printf("/");
768 	for (octet = 0; octet < noctets; octet++)
769 		printf("%02x", addrm[octet]);
770 }
771 
772 static void
773 do_show_one_filter_info(struct t4_filter *t, uint32_t mode)
774 {
775 	uint32_t i;
776 
777 	printf("%4d", t->idx);
778 	if (t->hits == UINT64_MAX)
779 		printf(" %8s", "-");
780 	else
781 		printf(" %8ju", t->hits);
782 
783 	/*
784 	 * Compressed header portion of filter.
785 	 */
786 	for (i = T4_FILTER_FCoE; i <= T4_FILTER_IP_FRAGMENT; i <<= 1) {
787 		switch (mode & i) {
788 		case T4_FILTER_FCoE:
789 			printf("  %1d/%1d", t->fs.val.fcoe, t->fs.mask.fcoe);
790 			break;
791 
792 		case T4_FILTER_PORT:
793 			printf("  %1d/%1d", t->fs.val.iport, t->fs.mask.iport);
794 			break;
795 
796 		case T4_FILTER_VNIC:
797 			if (mode & T4_FILTER_IC_VNIC) {
798 				printf(" %1d:%1x:%02x/%1d:%1x:%02x",
799 				    t->fs.val.pfvf_vld,
800 				    (t->fs.val.vnic >> 13) & 0x7,
801 				    t->fs.val.vnic & 0x1fff,
802 				    t->fs.mask.pfvf_vld,
803 				    (t->fs.mask.vnic >> 13) & 0x7,
804 				    t->fs.mask.vnic & 0x1fff);
805 			} else {
806 				printf(" %1d:%04x/%1d:%04x",
807 				    t->fs.val.ovlan_vld, t->fs.val.vnic,
808 				    t->fs.mask.ovlan_vld, t->fs.mask.vnic);
809 			}
810 			break;
811 
812 		case T4_FILTER_VLAN:
813 			printf(" %1d:%04x/%1d:%04x",
814 			    t->fs.val.vlan_vld, t->fs.val.vlan,
815 			    t->fs.mask.vlan_vld, t->fs.mask.vlan);
816 			break;
817 
818 		case T4_FILTER_IP_TOS:
819 			printf(" %02x/%02x", t->fs.val.tos, t->fs.mask.tos);
820 			break;
821 
822 		case T4_FILTER_IP_PROTO:
823 			printf(" %02x/%02x", t->fs.val.proto, t->fs.mask.proto);
824 			break;
825 
826 		case T4_FILTER_ETH_TYPE:
827 			printf(" %04x/%04x", t->fs.val.ethtype,
828 			    t->fs.mask.ethtype);
829 			break;
830 
831 		case T4_FILTER_MAC_IDX:
832 			printf(" %03x/%03x", t->fs.val.macidx,
833 			    t->fs.mask.macidx);
834 			break;
835 
836 		case T4_FILTER_MPS_HIT_TYPE:
837 			printf(" %1x/%1x", t->fs.val.matchtype,
838 			    t->fs.mask.matchtype);
839 			break;
840 
841 		case T4_FILTER_IP_FRAGMENT:
842 			printf("  %1d/%1d", t->fs.val.frag, t->fs.mask.frag);
843 			break;
844 
845 		default:
846 			/* compressed filter field not enabled */
847 			break;
848 		}
849 	}
850 
851 	/*
852 	 * Fixed portion of filter.
853 	 */
854 	filters_show_ipaddr(t->fs.type, t->fs.val.dip, t->fs.mask.dip);
855 	filters_show_ipaddr(t->fs.type, t->fs.val.sip, t->fs.mask.sip);
856 	printf(" %04x/%04x %04x/%04x",
857 		 t->fs.val.dport, t->fs.mask.dport,
858 		 t->fs.val.sport, t->fs.mask.sport);
859 
860 	/*
861 	 * Variable length filter action.
862 	 */
863 	if (t->fs.action == FILTER_DROP)
864 		printf(" Drop");
865 	else if (t->fs.action == FILTER_SWITCH) {
866 		printf(" Switch: port=%d", t->fs.eport);
867 	if (t->fs.newdmac)
868 		printf(
869 			", dmac=%02x:%02x:%02x:%02x:%02x:%02x "
870 			", l2tidx=%d",
871 			t->fs.dmac[0], t->fs.dmac[1],
872 			t->fs.dmac[2], t->fs.dmac[3],
873 			t->fs.dmac[4], t->fs.dmac[5],
874 			t->l2tidx);
875 	if (t->fs.newsmac)
876 		printf(
877 			", smac=%02x:%02x:%02x:%02x:%02x:%02x "
878 			", smtidx=%d",
879 			t->fs.smac[0], t->fs.smac[1],
880 			t->fs.smac[2], t->fs.smac[3],
881 			t->fs.smac[4], t->fs.smac[5],
882 			t->smtidx);
883 	if (t->fs.newvlan == VLAN_REMOVE)
884 		printf(", vlan=none");
885 	else if (t->fs.newvlan == VLAN_INSERT)
886 		printf(", vlan=insert(%x)", t->fs.vlan);
887 	else if (t->fs.newvlan == VLAN_REWRITE)
888 		printf(", vlan=rewrite(%x)", t->fs.vlan);
889 	} else {
890 		printf(" Pass: Q=");
891 		if (t->fs.dirsteer == 0) {
892 			printf("RSS");
893 			if (t->fs.maskhash)
894 				printf("(TCB=hash)");
895 		} else {
896 			printf("%d", t->fs.iq);
897 			if (t->fs.dirsteerhash == 0)
898 				printf("(QID)");
899 			else
900 				printf("(hash)");
901 		}
902 	}
903 	if (t->fs.prio)
904 		printf(" Prio");
905 	if (t->fs.rpttid)
906 		printf(" RptTID");
907 	printf("\n");
908 }
909 
910 static int
911 show_filters(void)
912 {
913 	uint32_t mode = 0, header = 0;
914 	struct t4_filter t;
915 	int rc;
916 
917 	/* Get the global filter mode first */
918 	rc = doit(CHELSIO_T4_GET_FILTER_MODE, &mode);
919 	if (rc != 0)
920 		return (rc);
921 
922 	t.idx = 0;
923 	for (t.idx = 0; ; t.idx++) {
924 		rc = doit(CHELSIO_T4_GET_FILTER, &t);
925 		if (rc != 0 || t.idx == 0xffffffff)
926 			break;
927 
928 		if (!header) {
929 			do_show_info_header(mode);
930 			header = 1;
931 		}
932 		do_show_one_filter_info(&t, mode);
933 	};
934 
935 	return (rc);
936 }
937 
938 static int
939 get_filter_mode(void)
940 {
941 	uint32_t mode = 0;
942 	int rc;
943 
944 	rc = doit(CHELSIO_T4_GET_FILTER_MODE, &mode);
945 	if (rc != 0)
946 		return (rc);
947 
948 	if (mode & T4_FILTER_IPv4)
949 		printf("ipv4 ");
950 
951 	if (mode & T4_FILTER_IPv6)
952 		printf("ipv6 ");
953 
954 	if (mode & T4_FILTER_IP_SADDR)
955 		printf("sip ");
956 
957 	if (mode & T4_FILTER_IP_DADDR)
958 		printf("dip ");
959 
960 	if (mode & T4_FILTER_IP_SPORT)
961 		printf("sport ");
962 
963 	if (mode & T4_FILTER_IP_DPORT)
964 		printf("dport ");
965 
966 	if (mode & T4_FILTER_IP_FRAGMENT)
967 		printf("frag ");
968 
969 	if (mode & T4_FILTER_MPS_HIT_TYPE)
970 		printf("matchtype ");
971 
972 	if (mode & T4_FILTER_MAC_IDX)
973 		printf("macidx ");
974 
975 	if (mode & T4_FILTER_ETH_TYPE)
976 		printf("ethtype ");
977 
978 	if (mode & T4_FILTER_IP_PROTO)
979 		printf("proto ");
980 
981 	if (mode & T4_FILTER_IP_TOS)
982 		printf("tos ");
983 
984 	if (mode & T4_FILTER_VLAN)
985 		printf("vlan ");
986 
987 	if (mode & T4_FILTER_VNIC) {
988 		if (mode & T4_FILTER_IC_VNIC)
989 			printf("vnic_id ");
990 		else
991 			printf("ovlan ");
992 	}
993 
994 	if (mode & T4_FILTER_PORT)
995 		printf("iport ");
996 
997 	if (mode & T4_FILTER_FCoE)
998 		printf("fcoe ");
999 
1000 	printf("\n");
1001 
1002 	return (0);
1003 }
1004 
1005 static int
1006 set_filter_mode(int argc, const char *argv[])
1007 {
1008 	uint32_t mode = 0;
1009 	int vnic = 0, ovlan = 0;
1010 
1011 	for (; argc; argc--, argv++) {
1012 		if (!strcmp(argv[0], "frag"))
1013 			mode |= T4_FILTER_IP_FRAGMENT;
1014 
1015 		if (!strcmp(argv[0], "matchtype"))
1016 			mode |= T4_FILTER_MPS_HIT_TYPE;
1017 
1018 		if (!strcmp(argv[0], "macidx"))
1019 			mode |= T4_FILTER_MAC_IDX;
1020 
1021 		if (!strcmp(argv[0], "ethtype"))
1022 			mode |= T4_FILTER_ETH_TYPE;
1023 
1024 		if (!strcmp(argv[0], "proto"))
1025 			mode |= T4_FILTER_IP_PROTO;
1026 
1027 		if (!strcmp(argv[0], "tos"))
1028 			mode |= T4_FILTER_IP_TOS;
1029 
1030 		if (!strcmp(argv[0], "vlan"))
1031 			mode |= T4_FILTER_VLAN;
1032 
1033 		if (!strcmp(argv[0], "ovlan")) {
1034 			mode |= T4_FILTER_VNIC;
1035 			ovlan++;
1036 		}
1037 
1038 		if (!strcmp(argv[0], "vnic_id")) {
1039 			mode |= T4_FILTER_VNIC;
1040 			mode |= T4_FILTER_IC_VNIC;
1041 			vnic++;
1042 		}
1043 
1044 		if (!strcmp(argv[0], "iport"))
1045 			mode |= T4_FILTER_PORT;
1046 
1047 		if (!strcmp(argv[0], "fcoe"))
1048 			mode |= T4_FILTER_FCoE;
1049 	}
1050 
1051 	if (vnic > 0 && ovlan > 0) {
1052 		warnx("\"vnic_id\" and \"ovlan\" are mutually exclusive.");
1053 		return (EINVAL);
1054 	}
1055 
1056 	return doit(CHELSIO_T4_SET_FILTER_MODE, &mode);
1057 }
1058 
1059 static int
1060 del_filter(uint32_t idx)
1061 {
1062 	struct t4_filter t;
1063 
1064 	t.idx = idx;
1065 
1066 	return doit(CHELSIO_T4_DEL_FILTER, &t);
1067 }
1068 
1069 static int
1070 set_filter(uint32_t idx, int argc, const char *argv[])
1071 {
1072 	int af = AF_UNSPEC, start_arg = 0;
1073 	struct t4_filter t;
1074 
1075 	if (argc < 2) {
1076 		warnc(EINVAL, "%s", __func__);
1077 		return (EINVAL);
1078 	};
1079 	bzero(&t, sizeof (t));
1080 	t.idx = idx;
1081 	t.fs.hitcnts = 1;
1082 
1083 	for (start_arg = 0; start_arg + 2 <= argc; start_arg += 2) {
1084 		const char **args = &argv[start_arg];
1085 		uint32_t val, mask;
1086 
1087 		if (!strcmp(argv[start_arg], "type")) {
1088 			int newaf;
1089 			if (!strcasecmp(argv[start_arg + 1], "ipv4"))
1090 				newaf = AF_INET;
1091 			else if (!strcasecmp(argv[start_arg + 1], "ipv6"))
1092 				newaf = AF_INET6;
1093 			else {
1094 				warnx("invalid type \"%s\"; "
1095 				    "must be one of \"ipv4\" or \"ipv6\"",
1096 				    argv[start_arg + 1]);
1097 				return (EINVAL);
1098 			}
1099 
1100 			if (af != AF_UNSPEC && af != newaf) {
1101 				warnx("conflicting IPv4/IPv6 specifications.");
1102 				return (EINVAL);
1103 			}
1104 			af = newaf;
1105 		} else if (!parse_val_mask("fcoe", args, &val, &mask)) {
1106 			t.fs.val.fcoe = val;
1107 			t.fs.mask.fcoe = mask;
1108 		} else if (!parse_val_mask("iport", args, &val, &mask)) {
1109 			t.fs.val.iport = val;
1110 			t.fs.mask.iport = mask;
1111 		} else if (!parse_val_mask("ovlan", args, &val, &mask)) {
1112 			t.fs.val.vnic = val;
1113 			t.fs.mask.vnic = mask;
1114 			t.fs.val.ovlan_vld = 1;
1115 			t.fs.mask.ovlan_vld = 1;
1116 		} else if (!parse_val_mask("ivlan", args, &val, &mask)) {
1117 			t.fs.val.vlan = val;
1118 			t.fs.mask.vlan = mask;
1119 			t.fs.val.vlan_vld = 1;
1120 			t.fs.mask.vlan_vld = 1;
1121 		} else if (!parse_val_mask("pf", args, &val, &mask)) {
1122 			t.fs.val.vnic &= 0x1fff;
1123 			t.fs.val.vnic |= (val & 0x7) << 13;
1124 			t.fs.mask.vnic &= 0x1fff;
1125 			t.fs.mask.vnic |= (mask & 0x7) << 13;
1126 			t.fs.val.pfvf_vld = 1;
1127 			t.fs.mask.pfvf_vld = 1;
1128 		} else if (!parse_val_mask("vf", args, &val, &mask)) {
1129 			t.fs.val.vnic &= 0xe000;
1130 			t.fs.val.vnic |= val & 0x1fff;
1131 			t.fs.mask.vnic &= 0xe000;
1132 			t.fs.mask.vnic |= mask & 0x1fff;
1133 			t.fs.val.pfvf_vld = 1;
1134 			t.fs.mask.pfvf_vld = 1;
1135 		} else if (!parse_val_mask("tos", args, &val, &mask)) {
1136 			t.fs.val.tos = val;
1137 			t.fs.mask.tos = mask;
1138 		} else if (!parse_val_mask("proto", args, &val, &mask)) {
1139 			t.fs.val.proto = val;
1140 			t.fs.mask.proto = mask;
1141 		} else if (!parse_val_mask("ethtype", args, &val, &mask)) {
1142 			t.fs.val.ethtype = val;
1143 			t.fs.mask.ethtype = mask;
1144 		} else if (!parse_val_mask("macidx", args, &val, &mask)) {
1145 			t.fs.val.macidx = val;
1146 			t.fs.mask.macidx = mask;
1147 		} else if (!parse_val_mask("matchtype", args, &val, &mask)) {
1148 			t.fs.val.matchtype = val;
1149 			t.fs.mask.matchtype = mask;
1150 		} else if (!parse_val_mask("frag", args, &val, &mask)) {
1151 			t.fs.val.frag = val;
1152 			t.fs.mask.frag = mask;
1153 		} else if (!parse_val_mask("dport", args, &val, &mask)) {
1154 			t.fs.val.dport = val;
1155 			t.fs.mask.dport = mask;
1156 		} else if (!parse_val_mask("sport", args, &val, &mask)) {
1157 			t.fs.val.sport = val;
1158 			t.fs.mask.sport = mask;
1159 		} else if (!parse_ipaddr("dip", args, &af, t.fs.val.dip,
1160 		    t.fs.mask.dip)) {
1161 			/* nada */;
1162 		} else if (!parse_ipaddr("sip", args, &af, t.fs.val.sip,
1163 		    t.fs.mask.sip)) {
1164 			/* nada */;
1165 		} else if (!strcmp(argv[start_arg], "action")) {
1166 			if (!strcmp(argv[start_arg + 1], "pass"))
1167 				t.fs.action = FILTER_PASS;
1168 			else if (!strcmp(argv[start_arg + 1], "drop"))
1169 				t.fs.action = FILTER_DROP;
1170 			else if (!strcmp(argv[start_arg + 1], "switch"))
1171 				t.fs.action = FILTER_SWITCH;
1172 			else {
1173 				warnx("invalid action \"%s\"; must be one of"
1174 				     " \"pass\", \"drop\" or \"switch\"",
1175 				     argv[start_arg + 1]);
1176 				return (EINVAL);
1177 			}
1178 		} else if (!parse_val("hitcnts", args, &val)) {
1179 			t.fs.hitcnts = val;
1180 		} else if (!parse_val("prio", args, &val)) {
1181 			t.fs.prio = val;
1182 		} else if (!parse_val("rpttid", args, &val)) {
1183 			t.fs.rpttid = 1;
1184 		} else if (!parse_val("queue", args, &val)) {
1185 			t.fs.dirsteer = 1;
1186 			t.fs.iq = val;
1187 		} else if (!parse_val("tcbhash", args, &val)) {
1188 			t.fs.maskhash = 1;
1189 			t.fs.dirsteerhash = 1;
1190 		} else if (!parse_val("eport", args, &val)) {
1191 			t.fs.eport = val;
1192 		} else if (!strcmp(argv[start_arg], "dmac")) {
1193 			struct ether_addr *daddr;
1194 
1195 			daddr = ether_aton(argv[start_arg + 1]);
1196 			if (daddr == NULL) {
1197 				warnx("invalid dmac address \"%s\"",
1198 				    argv[start_arg + 1]);
1199 				return (EINVAL);
1200 			}
1201 			memcpy(t.fs.dmac, daddr, ETHER_ADDR_LEN);
1202 			t.fs.newdmac = 1;
1203 		} else if (!strcmp(argv[start_arg], "smac")) {
1204 			struct ether_addr *saddr;
1205 
1206 			saddr = ether_aton(argv[start_arg + 1]);
1207 			if (saddr == NULL) {
1208 				warnx("invalid smac address \"%s\"",
1209 				    argv[start_arg + 1]);
1210 				return (EINVAL);
1211 			}
1212 			memcpy(t.fs.smac, saddr, ETHER_ADDR_LEN);
1213 			t.fs.newsmac = 1;
1214 		} else if (!strcmp(argv[start_arg], "vlan")) {
1215 			char *p;
1216 			if (!strcmp(argv[start_arg + 1], "none")) {
1217 				t.fs.newvlan = VLAN_REMOVE;
1218 			} else if (argv[start_arg + 1][0] == '=') {
1219 				t.fs.newvlan = VLAN_REWRITE;
1220 			} else if (argv[start_arg + 1][0] == '+') {
1221 				t.fs.newvlan = VLAN_INSERT;
1222 			} else if (isdigit(argv[start_arg + 1][0]) &&
1223 			    !parse_val_mask("vlan", args, &val, &mask)) {
1224 				t.fs.val.vlan = val;
1225 				t.fs.mask.vlan = mask;
1226 				t.fs.val.vlan_vld = 1;
1227 				t.fs.mask.vlan_vld = 1;
1228 			} else {
1229 				warnx("unknown vlan parameter \"%s\"; must"
1230 				     " be one of \"none\", \"=<vlan>\", "
1231 				     " \"+<vlan>\", or \"<vlan>\"",
1232 				     argv[start_arg + 1]);
1233 				return (EINVAL);
1234 			}
1235 			if (t.fs.newvlan == VLAN_REWRITE ||
1236 			    t.fs.newvlan == VLAN_INSERT) {
1237 				t.fs.vlan = strtoul(argv[start_arg + 1] + 1,
1238 				    &p, 0);
1239 				if (p == argv[start_arg + 1] + 1 || p[0] != 0) {
1240 					warnx("invalid vlan \"%s\"",
1241 					     argv[start_arg + 1]);
1242 					return (EINVAL);
1243 				}
1244 			}
1245 		} else {
1246 			warnx("invalid parameter \"%s\"", argv[start_arg]);
1247 			return (EINVAL);
1248 		}
1249 	}
1250 	if (start_arg != argc) {
1251 		warnx("no value for \"%s\"", argv[start_arg]);
1252 		return (EINVAL);
1253 	}
1254 
1255 	/*
1256 	 * Check basic sanity of option combinations.
1257 	 */
1258 	if (t.fs.action != FILTER_SWITCH &&
1259 	    (t.fs.eport || t.fs.newdmac || t.fs.newsmac || t.fs.newvlan)) {
1260 		warnx("prio, port dmac, smac and vlan only make sense with"
1261 		     " \"action switch\"");
1262 		return (EINVAL);
1263 	}
1264 	if (t.fs.action != FILTER_PASS &&
1265 	    (t.fs.rpttid || t.fs.dirsteer || t.fs.maskhash)) {
1266 		warnx("rpttid, queue and tcbhash don't make sense with"
1267 		     " action \"drop\" or \"switch\"");
1268 		return (EINVAL);
1269 	}
1270 	if (t.fs.val.ovlan_vld && t.fs.val.pfvf_vld) {
1271 		warnx("ovlan and vnic_id (pf/vf) are mutually exclusive");
1272 		return (EINVAL);
1273 	}
1274 
1275 	t.fs.type = (af == AF_INET6 ? 1 : 0); /* default IPv4 */
1276 	return doit(CHELSIO_T4_SET_FILTER, &t);
1277 }
1278 
1279 static int
1280 filter_cmd(int argc, const char *argv[])
1281 {
1282 	long long val;
1283 	uint32_t idx;
1284 	char *s;
1285 
1286 	if (argc == 0) {
1287 		warnx("filter: no arguments.");
1288 		return (EINVAL);
1289 	};
1290 
1291 	/* list */
1292 	if (strcmp(argv[0], "list") == 0) {
1293 		if (argc != 1)
1294 			warnx("trailing arguments after \"list\" ignored.");
1295 
1296 		return show_filters();
1297 	}
1298 
1299 	/* mode */
1300 	if (argc == 1 && strcmp(argv[0], "mode") == 0)
1301 		return get_filter_mode();
1302 
1303 	/* mode <mode> */
1304 	if (strcmp(argv[0], "mode") == 0)
1305 		return set_filter_mode(argc - 1, argv + 1);
1306 
1307 	/* <idx> ... */
1308 	s = str_to_number(argv[0], NULL, &val);
1309 	if (*s || val > 0xffffffffU) {
1310 		warnx("\"%s\" is neither an index nor a filter subcommand.",
1311 		    argv[0]);
1312 		return (EINVAL);
1313 	}
1314 	idx = (uint32_t) val;
1315 
1316 	/* <idx> delete|clear */
1317 	if (argc == 2 &&
1318 	    (strcmp(argv[1], "delete") == 0 || strcmp(argv[1], "clear") == 0)) {
1319 		return del_filter(idx);
1320 	}
1321 
1322 	/* <idx> [<param> <val>] ... */
1323 	return set_filter(idx, argc - 1, argv + 1);
1324 }
1325 
1326 /*
1327  * Shows the fields of a multi-word structure.  The structure is considered to
1328  * consist of @nwords 32-bit words (i.e, it's an (@nwords * 32)-bit structure)
1329  * whose fields are described by @fd.  The 32-bit words are given in @words
1330  * starting with the least significant 32-bit word.
1331  */
1332 static void
1333 show_struct(const uint32_t *words, int nwords, const struct field_desc *fd)
1334 {
1335 	unsigned int w = 0;
1336 	const struct field_desc *p;
1337 
1338 	for (p = fd; p->name; p++)
1339 		w = max(w, strlen(p->name));
1340 
1341 	while (fd->name) {
1342 		unsigned long long data;
1343 		int first_word = fd->start / 32;
1344 		int shift = fd->start % 32;
1345 		int width = fd->end - fd->start + 1;
1346 		unsigned long long mask = (1ULL << width) - 1;
1347 
1348 		data = (words[first_word] >> shift) |
1349 		       ((uint64_t)words[first_word + 1] << (32 - shift));
1350 		if (shift)
1351 		       data |= ((uint64_t)words[first_word + 2] << (64 - shift));
1352 		data &= mask;
1353 		if (fd->islog2)
1354 			data = 1 << data;
1355 		printf("%-*s ", w, fd->name);
1356 		printf(fd->hex ? "%#llx\n" : "%llu\n", data << fd->shift);
1357 		fd++;
1358 	}
1359 }
1360 
1361 #define FIELD(name, start, end) { name, start, end, 0, 0, 0 }
1362 #define FIELD1(name, start) FIELD(name, start, start)
1363 
1364 static void
1365 show_t5t6_ctxt(const struct t4_sge_context *p, int vers)
1366 {
1367 	static struct field_desc egress_t5[] = {
1368 		FIELD("DCA_ST:", 181, 191),
1369 		FIELD1("StatusPgNS:", 180),
1370 		FIELD1("StatusPgRO:", 179),
1371 		FIELD1("FetchNS:", 178),
1372 		FIELD1("FetchRO:", 177),
1373 		FIELD1("Valid:", 176),
1374 		FIELD("PCIeDataChannel:", 174, 175),
1375 		FIELD1("StatusPgTPHintEn:", 173),
1376 		FIELD("StatusPgTPHint:", 171, 172),
1377 		FIELD1("FetchTPHintEn:", 170),
1378 		FIELD("FetchTPHint:", 168, 169),
1379 		FIELD1("FCThreshOverride:", 167),
1380 		{ "WRLength:", 162, 166, 9, 0, 1 },
1381 		FIELD1("WRLengthKnown:", 161),
1382 		FIELD1("ReschedulePending:", 160),
1383 		FIELD1("OnChipQueue:", 159),
1384 		FIELD1("FetchSizeMode:", 158),
1385 		{ "FetchBurstMin:", 156, 157, 4, 0, 1 },
1386 		FIELD1("FLMPacking:", 155),
1387 		FIELD("FetchBurstMax:", 153, 154),
1388 		FIELD("uPToken:", 133, 152),
1389 		FIELD1("uPTokenEn:", 132),
1390 		FIELD1("UserModeIO:", 131),
1391 		FIELD("uPFLCredits:", 123, 130),
1392 		FIELD1("uPFLCreditEn:", 122),
1393 		FIELD("FID:", 111, 121),
1394 		FIELD("HostFCMode:", 109, 110),
1395 		FIELD1("HostFCOwner:", 108),
1396 		{ "CIDXFlushThresh:", 105, 107, 0, 0, 1 },
1397 		FIELD("CIDX:", 89, 104),
1398 		FIELD("PIDX:", 73, 88),
1399 		{ "BaseAddress:", 18, 72, 9, 1 },
1400 		FIELD("QueueSize:", 2, 17),
1401 		FIELD1("QueueType:", 1),
1402 		FIELD1("CachePriority:", 0),
1403 		{ NULL }
1404 	};
1405 	static struct field_desc egress_t6[] = {
1406 		FIELD("DCA_ST:", 181, 191),
1407 		FIELD1("StatusPgNS:", 180),
1408 		FIELD1("StatusPgRO:", 179),
1409 		FIELD1("FetchNS:", 178),
1410 		FIELD1("FetchRO:", 177),
1411 		FIELD1("Valid:", 176),
1412 		FIELD1("ReschedulePending_1:", 175),
1413 		FIELD1("PCIeDataChannel:", 174),
1414 		FIELD1("StatusPgTPHintEn:", 173),
1415 		FIELD("StatusPgTPHint:", 171, 172),
1416 		FIELD1("FetchTPHintEn:", 170),
1417 		FIELD("FetchTPHint:", 168, 169),
1418 		FIELD1("FCThreshOverride:", 167),
1419 		{ "WRLength:", 162, 166, 9, 0, 1 },
1420 		FIELD1("WRLengthKnown:", 161),
1421 		FIELD1("ReschedulePending:", 160),
1422 		FIELD("TimerIx:", 157, 159),
1423 		FIELD1("FetchBurstMin:", 156),
1424 		FIELD1("FLMPacking:", 155),
1425 		FIELD("FetchBurstMax:", 153, 154),
1426 		FIELD("uPToken:", 133, 152),
1427 		FIELD1("uPTokenEn:", 132),
1428 		FIELD1("UserModeIO:", 131),
1429 		FIELD("uPFLCredits:", 123, 130),
1430 		FIELD1("uPFLCreditEn:", 122),
1431 		FIELD("FID:", 111, 121),
1432 		FIELD("HostFCMode:", 109, 110),
1433 		FIELD1("HostFCOwner:", 108),
1434 		{ "CIDXFlushThresh:", 105, 107, 0, 0, 1 },
1435 		FIELD("CIDX:", 89, 104),
1436 		FIELD("PIDX:", 73, 88),
1437 		{ "BaseAddress:", 18, 72, 9, 1 },
1438 		FIELD("QueueSize:", 2, 17),
1439 		FIELD1("QueueType:", 1),
1440 		FIELD1("FetchSizeMode:", 0),
1441 		{ NULL }
1442 	};
1443 	static struct field_desc fl_t5[] = {
1444 		FIELD("DCA_ST:", 181, 191),
1445 		FIELD1("StatusPgNS:", 180),
1446 		FIELD1("StatusPgRO:", 179),
1447 		FIELD1("FetchNS:", 178),
1448 		FIELD1("FetchRO:", 177),
1449 		FIELD1("Valid:", 176),
1450 		FIELD("PCIeDataChannel:", 174, 175),
1451 		FIELD1("StatusPgTPHintEn:", 173),
1452 		FIELD("StatusPgTPHint:", 171, 172),
1453 		FIELD1("FetchTPHintEn:", 170),
1454 		FIELD("FetchTPHint:", 168, 169),
1455 		FIELD1("FCThreshOverride:", 167),
1456 		FIELD1("ReschedulePending:", 160),
1457 		FIELD1("OnChipQueue:", 159),
1458 		FIELD1("FetchSizeMode:", 158),
1459 		{ "FetchBurstMin:", 156, 157, 4, 0, 1 },
1460 		FIELD1("FLMPacking:", 155),
1461 		FIELD("FetchBurstMax:", 153, 154),
1462 		FIELD1("FLMcongMode:", 152),
1463 		FIELD("MaxuPFLCredits:", 144, 151),
1464 		FIELD("FLMcontextID:", 133, 143),
1465 		FIELD1("uPTokenEn:", 132),
1466 		FIELD1("UserModeIO:", 131),
1467 		FIELD("uPFLCredits:", 123, 130),
1468 		FIELD1("uPFLCreditEn:", 122),
1469 		FIELD("FID:", 111, 121),
1470 		FIELD("HostFCMode:", 109, 110),
1471 		FIELD1("HostFCOwner:", 108),
1472 		{ "CIDXFlushThresh:", 105, 107, 0, 0, 1 },
1473 		FIELD("CIDX:", 89, 104),
1474 		FIELD("PIDX:", 73, 88),
1475 		{ "BaseAddress:", 18, 72, 9, 1 },
1476 		FIELD("QueueSize:", 2, 17),
1477 		FIELD1("QueueType:", 1),
1478 		FIELD1("CachePriority:", 0),
1479 		{ NULL }
1480 	};
1481 	static struct field_desc ingress_t5[] = {
1482 		FIELD("DCA_ST:", 143, 153),
1483 		FIELD1("ISCSICoalescing:", 142),
1484 		FIELD1("Queue_Valid:", 141),
1485 		FIELD1("TimerPending:", 140),
1486 		FIELD1("DropRSS:", 139),
1487 		FIELD("PCIeChannel:", 137, 138),
1488 		FIELD1("SEInterruptArmed:", 136),
1489 		FIELD1("CongestionMgtEnable:", 135),
1490 		FIELD1("NoSnoop:", 134),
1491 		FIELD1("RelaxedOrdering:", 133),
1492 		FIELD1("GTSmode:", 132),
1493 		FIELD1("TPHintEn:", 131),
1494 		FIELD("TPHint:", 129, 130),
1495 		FIELD1("UpdateScheduling:", 128),
1496 		FIELD("UpdateDelivery:", 126, 127),
1497 		FIELD1("InterruptSent:", 125),
1498 		FIELD("InterruptIDX:", 114, 124),
1499 		FIELD1("InterruptDestination:", 113),
1500 		FIELD1("InterruptArmed:", 112),
1501 		FIELD("RxIntCounter:", 106, 111),
1502 		FIELD("RxIntCounterThreshold:", 104, 105),
1503 		FIELD1("Generation:", 103),
1504 		{ "BaseAddress:", 48, 102, 9, 1 },
1505 		FIELD("PIDX:", 32, 47),
1506 		FIELD("CIDX:", 16, 31),
1507 		{ "QueueSize:", 4, 15, 4, 0 },
1508 		{ "QueueEntrySize:", 2, 3, 4, 0, 1 },
1509 		FIELD1("QueueEntryOverride:", 1),
1510 		FIELD1("CachePriority:", 0),
1511 		{ NULL }
1512 	};
1513 	static struct field_desc ingress_t6[] = {
1514 		FIELD1("SP_NS:", 158),
1515 		FIELD1("SP_RO:", 157),
1516 		FIELD1("SP_TPHintEn:", 156),
1517 		FIELD("SP_TPHint:", 154, 155),
1518 		FIELD("DCA_ST:", 143, 153),
1519 		FIELD1("ISCSICoalescing:", 142),
1520 		FIELD1("Queue_Valid:", 141),
1521 		FIELD1("TimerPending:", 140),
1522 		FIELD1("DropRSS:", 139),
1523 		FIELD("PCIeChannel:", 137, 138),
1524 		FIELD1("SEInterruptArmed:", 136),
1525 		FIELD1("CongestionMgtEnable:", 135),
1526 		FIELD1("NoSnoop:", 134),
1527 		FIELD1("RelaxedOrdering:", 133),
1528 		FIELD1("GTSmode:", 132),
1529 		FIELD1("TPHintEn:", 131),
1530 		FIELD("TPHint:", 129, 130),
1531 		FIELD1("UpdateScheduling:", 128),
1532 		FIELD("UpdateDelivery:", 126, 127),
1533 		FIELD1("InterruptSent:", 125),
1534 		FIELD("InterruptIDX:", 114, 124),
1535 		FIELD1("InterruptDestination:", 113),
1536 		FIELD1("InterruptArmed:", 112),
1537 		FIELD("RxIntCounter:", 106, 111),
1538 		FIELD("RxIntCounterThreshold:", 104, 105),
1539 		FIELD1("Generation:", 103),
1540 		{ "BaseAddress:", 48, 102, 9, 1 },
1541 		FIELD("PIDX:", 32, 47),
1542 		FIELD("CIDX:", 16, 31),
1543 		{ "QueueSize:", 4, 15, 4, 0 },
1544 		{ "QueueEntrySize:", 2, 3, 4, 0, 1 },
1545 		FIELD1("QueueEntryOverride:", 1),
1546 		FIELD1("CachePriority:", 0),
1547 		{ NULL }
1548 	};
1549 	static struct field_desc flm_t5[] = {
1550 		FIELD1("Valid:", 89),
1551 		FIELD("SplitLenMode:", 87, 88),
1552 		FIELD1("TPHintEn:", 86),
1553 		FIELD("TPHint:", 84, 85),
1554 		FIELD1("NoSnoop:", 83),
1555 		FIELD1("RelaxedOrdering:", 82),
1556 		FIELD("DCA_ST:", 71, 81),
1557 		FIELD("EQid:", 54, 70),
1558 		FIELD("SplitEn:", 52, 53),
1559 		FIELD1("PadEn:", 51),
1560 		FIELD1("PackEn:", 50),
1561 		FIELD1("Cache_Lock :", 49),
1562 		FIELD1("CongDrop:", 48),
1563 		FIELD("PackOffset:", 16, 47),
1564 		FIELD("CIDX:", 8, 15),
1565 		FIELD("PIDX:", 0, 7),
1566 		{ NULL }
1567 	};
1568 	static struct field_desc flm_t6[] = {
1569 		FIELD1("Valid:", 89),
1570 		FIELD("SplitLenMode:", 87, 88),
1571 		FIELD1("TPHintEn:", 86),
1572 		FIELD("TPHint:", 84, 85),
1573 		FIELD1("NoSnoop:", 83),
1574 		FIELD1("RelaxedOrdering:", 82),
1575 		FIELD("DCA_ST:", 71, 81),
1576 		FIELD("EQid:", 54, 70),
1577 		FIELD("SplitEn:", 52, 53),
1578 		FIELD1("PadEn:", 51),
1579 		FIELD1("PackEn:", 50),
1580 		FIELD1("Cache_Lock :", 49),
1581 		FIELD1("CongDrop:", 48),
1582 		FIELD1("Inflight:", 47),
1583 		FIELD1("CongEn:", 46),
1584 		FIELD1("CongMode:", 45),
1585 		FIELD("PackOffset:", 20, 39),
1586 		FIELD("CIDX:", 8, 15),
1587 		FIELD("PIDX:", 0, 7),
1588 		{ NULL }
1589 	};
1590 	static struct field_desc conm_t5[] = {
1591 		FIELD1("CngMPSEnable:", 21),
1592 		FIELD("CngTPMode:", 19, 20),
1593 		FIELD1("CngDBPHdr:", 18),
1594 		FIELD1("CngDBPData:", 17),
1595 		FIELD1("CngIMSG:", 16),
1596 		{ "CngChMap:", 0, 15, 0, 1, 0 },
1597 		{ NULL }
1598 	};
1599 
1600 	if (p->mem_id == SGE_CONTEXT_EGRESS) {
1601 		if (p->data[0] & 2)
1602 			show_struct(p->data, 6, fl_t5);
1603 		else if (vers == 5)
1604 			show_struct(p->data, 6, egress_t5);
1605 		else
1606 			show_struct(p->data, 6, egress_t6);
1607 	} else if (p->mem_id == SGE_CONTEXT_FLM)
1608 		show_struct(p->data, 3, vers == 5 ? flm_t5 : flm_t6);
1609 	else if (p->mem_id == SGE_CONTEXT_INGRESS)
1610 		show_struct(p->data, 5, vers == 5 ? ingress_t5 : ingress_t6);
1611 	else if (p->mem_id == SGE_CONTEXT_CNM)
1612 		show_struct(p->data, 1, conm_t5);
1613 }
1614 
1615 static void
1616 show_t4_ctxt(const struct t4_sge_context *p)
1617 {
1618 	static struct field_desc egress_t4[] = {
1619 		FIELD1("StatusPgNS:", 180),
1620 		FIELD1("StatusPgRO:", 179),
1621 		FIELD1("FetchNS:", 178),
1622 		FIELD1("FetchRO:", 177),
1623 		FIELD1("Valid:", 176),
1624 		FIELD("PCIeDataChannel:", 174, 175),
1625 		FIELD1("DCAEgrQEn:", 173),
1626 		FIELD("DCACPUID:", 168, 172),
1627 		FIELD1("FCThreshOverride:", 167),
1628 		FIELD("WRLength:", 162, 166),
1629 		FIELD1("WRLengthKnown:", 161),
1630 		FIELD1("ReschedulePending:", 160),
1631 		FIELD1("OnChipQueue:", 159),
1632 		FIELD1("FetchSizeMode", 158),
1633 		{ "FetchBurstMin:", 156, 157, 4, 0, 1 },
1634 		{ "FetchBurstMax:", 153, 154, 6, 0, 1 },
1635 		FIELD("uPToken:", 133, 152),
1636 		FIELD1("uPTokenEn:", 132),
1637 		FIELD1("UserModeIO:", 131),
1638 		FIELD("uPFLCredits:", 123, 130),
1639 		FIELD1("uPFLCreditEn:", 122),
1640 		FIELD("FID:", 111, 121),
1641 		FIELD("HostFCMode:", 109, 110),
1642 		FIELD1("HostFCOwner:", 108),
1643 		{ "CIDXFlushThresh:", 105, 107, 0, 0, 1 },
1644 		FIELD("CIDX:", 89, 104),
1645 		FIELD("PIDX:", 73, 88),
1646 		{ "BaseAddress:", 18, 72, 9, 1 },
1647 		FIELD("QueueSize:", 2, 17),
1648 		FIELD1("QueueType:", 1),
1649 		FIELD1("CachePriority:", 0),
1650 		{ NULL }
1651 	};
1652 	static struct field_desc fl_t4[] = {
1653 		FIELD1("StatusPgNS:", 180),
1654 		FIELD1("StatusPgRO:", 179),
1655 		FIELD1("FetchNS:", 178),
1656 		FIELD1("FetchRO:", 177),
1657 		FIELD1("Valid:", 176),
1658 		FIELD("PCIeDataChannel:", 174, 175),
1659 		FIELD1("DCAEgrQEn:", 173),
1660 		FIELD("DCACPUID:", 168, 172),
1661 		FIELD1("FCThreshOverride:", 167),
1662 		FIELD1("ReschedulePending:", 160),
1663 		FIELD1("OnChipQueue:", 159),
1664 		FIELD1("FetchSizeMode", 158),
1665 		{ "FetchBurstMin:", 156, 157, 4, 0, 1 },
1666 		{ "FetchBurstMax:", 153, 154, 6, 0, 1 },
1667 		FIELD1("FLMcongMode:", 152),
1668 		FIELD("MaxuPFLCredits:", 144, 151),
1669 		FIELD("FLMcontextID:", 133, 143),
1670 		FIELD1("uPTokenEn:", 132),
1671 		FIELD1("UserModeIO:", 131),
1672 		FIELD("uPFLCredits:", 123, 130),
1673 		FIELD1("uPFLCreditEn:", 122),
1674 		FIELD("FID:", 111, 121),
1675 		FIELD("HostFCMode:", 109, 110),
1676 		FIELD1("HostFCOwner:", 108),
1677 		{ "CIDXFlushThresh:", 105, 107, 0, 0, 1 },
1678 		FIELD("CIDX:", 89, 104),
1679 		FIELD("PIDX:", 73, 88),
1680 		{ "BaseAddress:", 18, 72, 9, 1 },
1681 		FIELD("QueueSize:", 2, 17),
1682 		FIELD1("QueueType:", 1),
1683 		FIELD1("CachePriority:", 0),
1684 		{ NULL }
1685 	};
1686 	static struct field_desc ingress_t4[] = {
1687 		FIELD1("NoSnoop:", 145),
1688 		FIELD1("RelaxedOrdering:", 144),
1689 		FIELD1("GTSmode:", 143),
1690 		FIELD1("ISCSICoalescing:", 142),
1691 		FIELD1("Valid:", 141),
1692 		FIELD1("TimerPending:", 140),
1693 		FIELD1("DropRSS:", 139),
1694 		FIELD("PCIeChannel:", 137, 138),
1695 		FIELD1("SEInterruptArmed:", 136),
1696 		FIELD1("CongestionMgtEnable:", 135),
1697 		FIELD1("DCAIngQEnable:", 134),
1698 		FIELD("DCACPUID:", 129, 133),
1699 		FIELD1("UpdateScheduling:", 128),
1700 		FIELD("UpdateDelivery:", 126, 127),
1701 		FIELD1("InterruptSent:", 125),
1702 		FIELD("InterruptIDX:", 114, 124),
1703 		FIELD1("InterruptDestination:", 113),
1704 		FIELD1("InterruptArmed:", 112),
1705 		FIELD("RxIntCounter:", 106, 111),
1706 		FIELD("RxIntCounterThreshold:", 104, 105),
1707 		FIELD1("Generation:", 103),
1708 		{ "BaseAddress:", 48, 102, 9, 1 },
1709 		FIELD("PIDX:", 32, 47),
1710 		FIELD("CIDX:", 16, 31),
1711 		{ "QueueSize:", 4, 15, 4, 0 },
1712 		{ "QueueEntrySize:", 2, 3, 4, 0, 1 },
1713 		FIELD1("QueueEntryOverride:", 1),
1714 		FIELD1("CachePriority:", 0),
1715 		{ NULL }
1716 	};
1717 	static struct field_desc flm_t4[] = {
1718 		FIELD1("NoSnoop:", 79),
1719 		FIELD1("RelaxedOrdering:", 78),
1720 		FIELD1("Valid:", 77),
1721 		FIELD("DCACPUID:", 72, 76),
1722 		FIELD1("DCAFLEn:", 71),
1723 		FIELD("EQid:", 54, 70),
1724 		FIELD("SplitEn:", 52, 53),
1725 		FIELD1("PadEn:", 51),
1726 		FIELD1("PackEn:", 50),
1727 		FIELD1("DBpriority:", 48),
1728 		FIELD("PackOffset:", 16, 47),
1729 		FIELD("CIDX:", 8, 15),
1730 		FIELD("PIDX:", 0, 7),
1731 		{ NULL }
1732 	};
1733 	static struct field_desc conm_t4[] = {
1734 		FIELD1("CngDBPHdr:", 6),
1735 		FIELD1("CngDBPData:", 5),
1736 		FIELD1("CngIMSG:", 4),
1737 		{ "CngChMap:", 0, 3, 0, 1, 0},
1738 		{ NULL }
1739 	};
1740 
1741 	if (p->mem_id == SGE_CONTEXT_EGRESS)
1742 		show_struct(p->data, 6, (p->data[0] & 2) ? fl_t4 : egress_t4);
1743 	else if (p->mem_id == SGE_CONTEXT_FLM)
1744 		show_struct(p->data, 3, flm_t4);
1745 	else if (p->mem_id == SGE_CONTEXT_INGRESS)
1746 		show_struct(p->data, 5, ingress_t4);
1747 	else if (p->mem_id == SGE_CONTEXT_CNM)
1748 		show_struct(p->data, 1, conm_t4);
1749 }
1750 
1751 #undef FIELD
1752 #undef FIELD1
1753 
1754 static int
1755 get_sge_context(int argc, const char *argv[])
1756 {
1757 	int rc;
1758 	char *p;
1759 	long cid;
1760 	struct t4_sge_context cntxt = {0};
1761 
1762 	if (argc != 2) {
1763 		warnx("sge_context: incorrect number of arguments.");
1764 		return (EINVAL);
1765 	}
1766 
1767 	if (!strcmp(argv[0], "egress"))
1768 		cntxt.mem_id = SGE_CONTEXT_EGRESS;
1769 	else if (!strcmp(argv[0], "ingress"))
1770 		cntxt.mem_id = SGE_CONTEXT_INGRESS;
1771 	else if (!strcmp(argv[0], "fl"))
1772 		cntxt.mem_id = SGE_CONTEXT_FLM;
1773 	else if (!strcmp(argv[0], "cong"))
1774 		cntxt.mem_id = SGE_CONTEXT_CNM;
1775 	else {
1776 		warnx("unknown context type \"%s\"; known types are egress, "
1777 		    "ingress, fl, and cong.", argv[0]);
1778 		return (EINVAL);
1779 	}
1780 
1781 	p = str_to_number(argv[1], &cid, NULL);
1782 	if (*p) {
1783 		warnx("invalid context id \"%s\"", argv[1]);
1784 		return (EINVAL);
1785 	}
1786 	cntxt.cid = cid;
1787 
1788 	rc = doit(CHELSIO_T4_GET_SGE_CONTEXT, &cntxt);
1789 	if (rc != 0)
1790 		return (rc);
1791 
1792 	if (chip_id == 4)
1793 		show_t4_ctxt(&cntxt);
1794 	else
1795 		show_t5t6_ctxt(&cntxt, chip_id);
1796 
1797 	return (0);
1798 }
1799 
1800 static int
1801 loadfw(int argc, const char *argv[])
1802 {
1803 	int rc, fd;
1804 	struct t4_data data = {0};
1805 	const char *fname = argv[0];
1806 	struct stat st = {0};
1807 
1808 	if (argc != 1) {
1809 		warnx("loadfw: incorrect number of arguments.");
1810 		return (EINVAL);
1811 	}
1812 
1813 	fd = open(fname, O_RDONLY);
1814 	if (fd < 0) {
1815 		warn("open(%s)", fname);
1816 		return (errno);
1817 	}
1818 
1819 	if (fstat(fd, &st) < 0) {
1820 		warn("fstat");
1821 		close(fd);
1822 		return (errno);
1823 	}
1824 
1825 	data.len = st.st_size;
1826 	data.data = mmap(0, data.len, PROT_READ, MAP_PRIVATE, fd, 0);
1827 	if (data.data == MAP_FAILED) {
1828 		warn("mmap");
1829 		close(fd);
1830 		return (errno);
1831 	}
1832 
1833 	rc = doit(CHELSIO_T4_LOAD_FW, &data);
1834 	munmap(data.data, data.len);
1835 	close(fd);
1836 	return (rc);
1837 }
1838 
1839 static int
1840 loadcfg(int argc, const char *argv[])
1841 {
1842 	int rc, fd;
1843 	struct t4_data data = {0};
1844 	const char *fname = argv[0];
1845 	struct stat st = {0};
1846 
1847 	if (argc != 1) {
1848 		warnx("loadcfg: incorrect number of arguments.");
1849 		return (EINVAL);
1850 	}
1851 
1852 	if (strcmp(fname, "clear") == 0)
1853 		return (doit(CHELSIO_T4_LOAD_CFG, &data));
1854 
1855 	fd = open(fname, O_RDONLY);
1856 	if (fd < 0) {
1857 		warn("open(%s)", fname);
1858 		return (errno);
1859 	}
1860 
1861 	if (fstat(fd, &st) < 0) {
1862 		warn("fstat");
1863 		close(fd);
1864 		return (errno);
1865 	}
1866 
1867 	data.len = st.st_size;
1868 	data.len &= ~3;		/* Clip off to make it a multiple of 4 */
1869 	data.data = mmap(0, data.len, PROT_READ, MAP_PRIVATE, fd, 0);
1870 	if (data.data == MAP_FAILED) {
1871 		warn("mmap");
1872 		close(fd);
1873 		return (errno);
1874 	}
1875 
1876 	rc = doit(CHELSIO_T4_LOAD_CFG, &data);
1877 	munmap(data.data, data.len);
1878 	close(fd);
1879 	return (rc);
1880 }
1881 
1882 static int
1883 read_mem(uint32_t addr, uint32_t len, void (*output)(uint32_t *, uint32_t))
1884 {
1885 	int rc;
1886 	struct t4_mem_range mr;
1887 
1888 	mr.addr = addr;
1889 	mr.len = len;
1890 	mr.data = malloc(mr.len);
1891 
1892 	if (mr.data == 0) {
1893 		warn("read_mem: malloc");
1894 		return (errno);
1895 	}
1896 
1897 	rc = doit(CHELSIO_T4_GET_MEM, &mr);
1898 	if (rc != 0)
1899 		goto done;
1900 
1901 	if (output)
1902 		(*output)(mr.data, mr.len);
1903 done:
1904 	free(mr.data);
1905 	return (rc);
1906 }
1907 
1908 /*
1909  * Display memory as list of 'n' 4-byte values per line.
1910  */
1911 static void
1912 show_mem(uint32_t *buf, uint32_t len)
1913 {
1914 	const char *s;
1915 	int i, n = 8;
1916 
1917 	while (len) {
1918 		for (i = 0; len && i < n; i++, buf++, len -= 4) {
1919 			s = i ? " " : "";
1920 			printf("%s%08x", s, htonl(*buf));
1921 		}
1922 		printf("\n");
1923 	}
1924 }
1925 
1926 static int
1927 memdump(int argc, const char *argv[])
1928 {
1929 	char *p;
1930 	long l;
1931 	uint32_t addr, len;
1932 
1933 	if (argc != 2) {
1934 		warnx("incorrect number of arguments.");
1935 		return (EINVAL);
1936 	}
1937 
1938 	p = str_to_number(argv[0], &l, NULL);
1939 	if (*p) {
1940 		warnx("invalid address \"%s\"", argv[0]);
1941 		return (EINVAL);
1942 	}
1943 	addr = l;
1944 
1945 	p = str_to_number(argv[1], &l, NULL);
1946 	if (*p) {
1947 		warnx("memdump: invalid length \"%s\"", argv[1]);
1948 		return (EINVAL);
1949 	}
1950 	len = l;
1951 
1952 	return (read_mem(addr, len, show_mem));
1953 }
1954 
1955 /*
1956  * Display TCB as list of 'n' 4-byte values per line.
1957  */
1958 static void
1959 show_tcb(uint32_t *buf, uint32_t len)
1960 {
1961 	const char *s;
1962 	int i, n = 8;
1963 
1964 	while (len) {
1965 		for (i = 0; len && i < n; i++, buf++, len -= 4) {
1966 			s = i ? " " : "";
1967 			printf("%s%08x", s, htonl(*buf));
1968 		}
1969 		printf("\n");
1970 	}
1971 }
1972 
1973 #define A_TP_CMM_TCB_BASE 0x7d10
1974 #define TCB_SIZE 128
1975 static int
1976 read_tcb(int argc, const char *argv[])
1977 {
1978 	char *p;
1979 	long l;
1980 	long long val;
1981 	unsigned int tid;
1982 	uint32_t addr;
1983 	int rc;
1984 
1985 	if (argc != 1) {
1986 		warnx("incorrect number of arguments.");
1987 		return (EINVAL);
1988 	}
1989 
1990 	p = str_to_number(argv[0], &l, NULL);
1991 	if (*p) {
1992 		warnx("invalid tid \"%s\"", argv[0]);
1993 		return (EINVAL);
1994 	}
1995 	tid = l;
1996 
1997 	rc = read_reg(A_TP_CMM_TCB_BASE, 4, &val);
1998 	if (rc != 0)
1999 		return (rc);
2000 
2001 	addr = val + tid * TCB_SIZE;
2002 
2003 	return (read_mem(addr, TCB_SIZE, show_tcb));
2004 }
2005 
2006 static int
2007 read_i2c(int argc, const char *argv[])
2008 {
2009 	char *p;
2010 	long l;
2011 	struct t4_i2c_data i2cd;
2012 	int rc, i;
2013 
2014 	if (argc < 3 || argc > 4) {
2015 		warnx("incorrect number of arguments.");
2016 		return (EINVAL);
2017 	}
2018 
2019 	p = str_to_number(argv[0], &l, NULL);
2020 	if (*p || l > UCHAR_MAX) {
2021 		warnx("invalid port id \"%s\"", argv[0]);
2022 		return (EINVAL);
2023 	}
2024 	i2cd.port_id = l;
2025 
2026 	p = str_to_number(argv[1], &l, NULL);
2027 	if (*p || l > UCHAR_MAX) {
2028 		warnx("invalid i2c device address \"%s\"", argv[1]);
2029 		return (EINVAL);
2030 	}
2031 	i2cd.dev_addr = l;
2032 
2033 	p = str_to_number(argv[2], &l, NULL);
2034 	if (*p || l > UCHAR_MAX) {
2035 		warnx("invalid byte offset \"%s\"", argv[2]);
2036 		return (EINVAL);
2037 	}
2038 	i2cd.offset = l;
2039 
2040 	if (argc == 4) {
2041 		p = str_to_number(argv[3], &l, NULL);
2042 		if (*p || l > sizeof(i2cd.data)) {
2043 			warnx("invalid number of bytes \"%s\"", argv[3]);
2044 			return (EINVAL);
2045 		}
2046 		i2cd.len = l;
2047 	} else
2048 		i2cd.len = 1;
2049 
2050 	rc = doit(CHELSIO_T4_GET_I2C, &i2cd);
2051 	if (rc != 0)
2052 		return (rc);
2053 
2054 	for (i = 0; i < i2cd.len; i++)
2055 		printf("0x%x [%u]\n", i2cd.data[i], i2cd.data[i]);
2056 
2057 	return (0);
2058 }
2059 
2060 static int
2061 clearstats(int argc, const char *argv[])
2062 {
2063 	char *p;
2064 	long l;
2065 	uint32_t port;
2066 
2067 	if (argc != 1) {
2068 		warnx("incorrect number of arguments.");
2069 		return (EINVAL);
2070 	}
2071 
2072 	p = str_to_number(argv[0], &l, NULL);
2073 	if (*p) {
2074 		warnx("invalid port id \"%s\"", argv[0]);
2075 		return (EINVAL);
2076 	}
2077 	port = l;
2078 
2079 	return doit(CHELSIO_T4_CLEAR_STATS, &port);
2080 }
2081 
2082 static int
2083 show_tracers(void)
2084 {
2085 	struct t4_tracer t;
2086 	char *s;
2087 	int rc, port_idx, i;
2088 	long long val;
2089 
2090 	/* Magic values: MPS_TRC_CFG = 0x9800. MPS_TRC_CFG[1:1] = TrcEn */
2091 	rc = read_reg(0x9800, 4, &val);
2092 	if (rc != 0)
2093 		return (rc);
2094 	printf("tracing is %s\n", val & 2 ? "ENABLED" : "DISABLED");
2095 
2096 	t.idx = 0;
2097 	for (t.idx = 0; ; t.idx++) {
2098 		rc = doit(CHELSIO_T4_GET_TRACER, &t);
2099 		if (rc != 0 || t.idx == 0xff)
2100 			break;
2101 
2102 		if (t.tp.port < 4) {
2103 			s = "Rx";
2104 			port_idx = t.tp.port;
2105 		} else if (t.tp.port < 8) {
2106 			s = "Tx";
2107 			port_idx = t.tp.port - 4;
2108 		} else if (t.tp.port < 12) {
2109 			s = "loopback";
2110 			port_idx = t.tp.port - 8;
2111 		} else if (t.tp.port < 16) {
2112 			s = "MPS Rx";
2113 			port_idx = t.tp.port - 12;
2114 		} else if (t.tp.port < 20) {
2115 			s = "MPS Tx";
2116 			port_idx = t.tp.port - 16;
2117 		} else {
2118 			s = "unknown";
2119 			port_idx = t.tp.port;
2120 		}
2121 
2122 		printf("\ntracer %u (currently %s) captures ", t.idx,
2123 		    t.enabled ? "ENABLED" : "DISABLED");
2124 		if (t.tp.port < 8)
2125 			printf("port %u %s, ", port_idx, s);
2126 		else
2127 			printf("%s %u, ", s, port_idx);
2128 		printf("snap length: %u, min length: %u\n", t.tp.snap_len,
2129 		    t.tp.min_len);
2130 		printf("packets captured %smatch filter\n",
2131 		    t.tp.invert ? "do not " : "");
2132 		if (t.tp.skip_ofst) {
2133 			printf("filter pattern: ");
2134 			for (i = 0; i < t.tp.skip_ofst * 2; i += 2)
2135 				printf("%08x%08x", t.tp.data[i],
2136 				    t.tp.data[i + 1]);
2137 			printf("/");
2138 			for (i = 0; i < t.tp.skip_ofst * 2; i += 2)
2139 				printf("%08x%08x", t.tp.mask[i],
2140 				    t.tp.mask[i + 1]);
2141 			printf("@0\n");
2142 		}
2143 		printf("filter pattern: ");
2144 		for (i = t.tp.skip_ofst * 2; i < T4_TRACE_LEN / 4; i += 2)
2145 			printf("%08x%08x", t.tp.data[i], t.tp.data[i + 1]);
2146 		printf("/");
2147 		for (i = t.tp.skip_ofst * 2; i < T4_TRACE_LEN / 4; i += 2)
2148 			printf("%08x%08x", t.tp.mask[i], t.tp.mask[i + 1]);
2149 		printf("@%u\n", (t.tp.skip_ofst + t.tp.skip_len) * 8);
2150 	}
2151 
2152 	return (rc);
2153 }
2154 
2155 static int
2156 tracer_onoff(uint8_t idx, int enabled)
2157 {
2158 	struct t4_tracer t;
2159 
2160 	t.idx = idx;
2161 	t.enabled = enabled;
2162 	t.valid = 0;
2163 
2164 	return doit(CHELSIO_T4_SET_TRACER, &t);
2165 }
2166 
2167 static void
2168 create_tracing_ifnet()
2169 {
2170 	char *cmd[] = {
2171 		"/sbin/ifconfig", __DECONST(char *, nexus), "create", NULL
2172 	};
2173 	char *env[] = {NULL};
2174 
2175 	if (vfork() == 0) {
2176 		close(STDERR_FILENO);
2177 		execve(cmd[0], cmd, env);
2178 		_exit(0);
2179 	}
2180 }
2181 
2182 /*
2183  * XXX: Allow user to specify snaplen, minlen, and pattern (including inverted
2184  * matching).  Right now this is a quick-n-dirty implementation that traces the
2185  * first 128B of all tx or rx on a port
2186  */
2187 static int
2188 set_tracer(uint8_t idx, int argc, const char *argv[])
2189 {
2190 	struct t4_tracer t;
2191 	int len, port;
2192 
2193 	bzero(&t, sizeof (t));
2194 	t.idx = idx;
2195 	t.enabled = 1;
2196 	t.valid = 1;
2197 
2198 	if (argc != 1) {
2199 		warnx("must specify tx<n> or rx<n>.");
2200 		return (EINVAL);
2201 	}
2202 
2203 	len = strlen(argv[0]);
2204 	if (len != 3) {
2205 		warnx("argument must be 3 characters (tx<n> or rx<n>)");
2206 		return (EINVAL);
2207 	}
2208 
2209 	if (strncmp(argv[0], "tx", 2) == 0) {
2210 		port = argv[0][2] - '0';
2211 		if (port < 0 || port > 3) {
2212 			warnx("'%c' in %s is invalid", argv[0][2], argv[0]);
2213 			return (EINVAL);
2214 		}
2215 		port += 4;
2216 	} else if (strncmp(argv[0], "rx", 2) == 0) {
2217 		port = argv[0][2] - '0';
2218 		if (port < 0 || port > 3) {
2219 			warnx("'%c' in %s is invalid", argv[0][2], argv[0]);
2220 			return (EINVAL);
2221 		}
2222 	} else {
2223 		warnx("argument '%s' isn't tx<n> or rx<n>", argv[0]);
2224 		return (EINVAL);
2225 	}
2226 
2227 	t.tp.snap_len = 128;
2228 	t.tp.min_len = 0;
2229 	t.tp.skip_ofst = 0;
2230 	t.tp.skip_len = 0;
2231 	t.tp.invert = 0;
2232 	t.tp.port = port;
2233 
2234 	create_tracing_ifnet();
2235 	return doit(CHELSIO_T4_SET_TRACER, &t);
2236 }
2237 
2238 static int
2239 tracer_cmd(int argc, const char *argv[])
2240 {
2241 	long long val;
2242 	uint8_t idx;
2243 	char *s;
2244 
2245 	if (argc == 0) {
2246 		warnx("tracer: no arguments.");
2247 		return (EINVAL);
2248 	};
2249 
2250 	/* list */
2251 	if (strcmp(argv[0], "list") == 0) {
2252 		if (argc != 1)
2253 			warnx("trailing arguments after \"list\" ignored.");
2254 
2255 		return show_tracers();
2256 	}
2257 
2258 	/* <idx> ... */
2259 	s = str_to_number(argv[0], NULL, &val);
2260 	if (*s || val > 0xff) {
2261 		warnx("\"%s\" is neither an index nor a tracer subcommand.",
2262 		    argv[0]);
2263 		return (EINVAL);
2264 	}
2265 	idx = (int8_t)val;
2266 
2267 	/* <idx> disable */
2268 	if (argc == 2 && strcmp(argv[1], "disable") == 0)
2269 		return tracer_onoff(idx, 0);
2270 
2271 	/* <idx> enable */
2272 	if (argc == 2 && strcmp(argv[1], "enable") == 0)
2273 		return tracer_onoff(idx, 1);
2274 
2275 	/* <idx> ... */
2276 	return set_tracer(idx, argc - 1, argv + 1);
2277 }
2278 
2279 static int
2280 modinfo_raw(int port_id)
2281 {
2282 	uint8_t offset;
2283 	struct t4_i2c_data i2cd;
2284 	int rc;
2285 
2286 	for (offset = 0; offset < 96; offset += sizeof(i2cd.data)) {
2287 		bzero(&i2cd, sizeof(i2cd));
2288 		i2cd.port_id = port_id;
2289 		i2cd.dev_addr = 0xa0;
2290 		i2cd.offset = offset;
2291 		i2cd.len = sizeof(i2cd.data);
2292 		rc = doit(CHELSIO_T4_GET_I2C, &i2cd);
2293 		if (rc != 0)
2294 			return (rc);
2295 		printf("%02x:  %02x %02x %02x %02x  %02x %02x %02x %02x",
2296 		    offset, i2cd.data[0], i2cd.data[1], i2cd.data[2],
2297 		    i2cd.data[3], i2cd.data[4], i2cd.data[5], i2cd.data[6],
2298 		    i2cd.data[7]);
2299 
2300 		printf("  %c%c%c%c %c%c%c%c\n",
2301 		    isprint(i2cd.data[0]) ? i2cd.data[0] : '.',
2302 		    isprint(i2cd.data[1]) ? i2cd.data[1] : '.',
2303 		    isprint(i2cd.data[2]) ? i2cd.data[2] : '.',
2304 		    isprint(i2cd.data[3]) ? i2cd.data[3] : '.',
2305 		    isprint(i2cd.data[4]) ? i2cd.data[4] : '.',
2306 		    isprint(i2cd.data[5]) ? i2cd.data[5] : '.',
2307 		    isprint(i2cd.data[6]) ? i2cd.data[6] : '.',
2308 		    isprint(i2cd.data[7]) ? i2cd.data[7] : '.');
2309 	}
2310 
2311 	return (0);
2312 }
2313 
2314 static int
2315 modinfo(int argc, const char *argv[])
2316 {
2317 	long port;
2318 	char string[16], *p;
2319 	struct t4_i2c_data i2cd;
2320 	int rc, i;
2321 	uint16_t temp, vcc, tx_bias, tx_power, rx_power;
2322 
2323 	if (argc < 1) {
2324 		warnx("must supply a port");
2325 		return (EINVAL);
2326 	}
2327 
2328 	if (argc > 2) {
2329 		warnx("too many arguments");
2330 		return (EINVAL);
2331 	}
2332 
2333 	p = str_to_number(argv[0], &port, NULL);
2334 	if (*p || port > UCHAR_MAX) {
2335 		warnx("invalid port id \"%s\"", argv[0]);
2336 		return (EINVAL);
2337 	}
2338 
2339 	if (argc == 2) {
2340 		if (!strcmp(argv[1], "raw"))
2341 			return (modinfo_raw(port));
2342 		else {
2343 			warnx("second argument can only be \"raw\"");
2344 			return (EINVAL);
2345 		}
2346 	}
2347 
2348 	bzero(&i2cd, sizeof(i2cd));
2349 	i2cd.len = 1;
2350 	i2cd.port_id = port;
2351 	i2cd.dev_addr = SFF_8472_BASE;
2352 
2353 	i2cd.offset = SFF_8472_ID;
2354 	if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2355 		goto fail;
2356 
2357 	if (i2cd.data[0] > SFF_8472_ID_LAST)
2358 		printf("Unknown ID\n");
2359 	else
2360 		printf("ID: %s\n", sff_8472_id[i2cd.data[0]]);
2361 
2362 	bzero(&string, sizeof(string));
2363 	for (i = SFF_8472_VENDOR_START; i < SFF_8472_VENDOR_END; i++) {
2364 		i2cd.offset = i;
2365 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2366 			goto fail;
2367 		string[i - SFF_8472_VENDOR_START] = i2cd.data[0];
2368 	}
2369 	printf("Vendor %s\n", string);
2370 
2371 	bzero(&string, sizeof(string));
2372 	for (i = SFF_8472_SN_START; i < SFF_8472_SN_END; i++) {
2373 		i2cd.offset = i;
2374 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2375 			goto fail;
2376 		string[i - SFF_8472_SN_START] = i2cd.data[0];
2377 	}
2378 	printf("SN %s\n", string);
2379 
2380 	bzero(&string, sizeof(string));
2381 	for (i = SFF_8472_PN_START; i < SFF_8472_PN_END; i++) {
2382 		i2cd.offset = i;
2383 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2384 			goto fail;
2385 		string[i - SFF_8472_PN_START] = i2cd.data[0];
2386 	}
2387 	printf("PN %s\n", string);
2388 
2389 	bzero(&string, sizeof(string));
2390 	for (i = SFF_8472_REV_START; i < SFF_8472_REV_END; i++) {
2391 		i2cd.offset = i;
2392 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2393 			goto fail;
2394 		string[i - SFF_8472_REV_START] = i2cd.data[0];
2395 	}
2396 	printf("Rev %s\n", string);
2397 
2398 	i2cd.offset = SFF_8472_DIAG_TYPE;
2399 	if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2400 		goto fail;
2401 
2402 	if ((char )i2cd.data[0] & (SFF_8472_DIAG_IMPL |
2403 				   SFF_8472_DIAG_INTERNAL)) {
2404 
2405 		/* Switch to reading from the Diagnostic address. */
2406 		i2cd.dev_addr = SFF_8472_DIAG;
2407 		i2cd.len = 1;
2408 
2409 		i2cd.offset = SFF_8472_TEMP;
2410 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2411 			goto fail;
2412 		temp = i2cd.data[0] << 8;
2413 		printf("Temp: ");
2414 		if ((temp & SFF_8472_TEMP_SIGN) == SFF_8472_TEMP_SIGN)
2415 			printf("-");
2416 		else
2417 			printf("+");
2418 		printf("%dC\n", (temp & SFF_8472_TEMP_MSK) >>
2419 		    SFF_8472_TEMP_SHIFT);
2420 
2421 		i2cd.offset = SFF_8472_VCC;
2422 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2423 			goto fail;
2424 		vcc = i2cd.data[0] << 8;
2425 		printf("Vcc %fV\n", vcc / SFF_8472_VCC_FACTOR);
2426 
2427 		i2cd.offset = SFF_8472_TX_BIAS;
2428 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2429 			goto fail;
2430 		tx_bias = i2cd.data[0] << 8;
2431 		printf("TX Bias %fuA\n", tx_bias / SFF_8472_BIAS_FACTOR);
2432 
2433 		i2cd.offset = SFF_8472_TX_POWER;
2434 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2435 			goto fail;
2436 		tx_power = i2cd.data[0] << 8;
2437 		printf("TX Power %fmW\n", tx_power / SFF_8472_POWER_FACTOR);
2438 
2439 		i2cd.offset = SFF_8472_RX_POWER;
2440 		if ((rc = doit(CHELSIO_T4_GET_I2C, &i2cd)) != 0)
2441 			goto fail;
2442 		rx_power = i2cd.data[0] << 8;
2443 		printf("RX Power %fmW\n", rx_power / SFF_8472_POWER_FACTOR);
2444 
2445 	} else
2446 		printf("Diagnostics not supported.\n");
2447 
2448 	return(0);
2449 
2450 fail:
2451 	if (rc == EPERM)
2452 		warnx("No module/cable in port %ld", port);
2453 	return (rc);
2454 
2455 }
2456 
2457 /* XXX: pass in a low/high and do range checks as well */
2458 static int
2459 get_sched_param(const char *param, const char *args[], long *val)
2460 {
2461 	char *p;
2462 
2463 	if (strcmp(param, args[0]) != 0)
2464 		return (EINVAL);
2465 
2466 	p = str_to_number(args[1], val, NULL);
2467 	if (*p) {
2468 		warnx("parameter \"%s\" has bad value \"%s\"", args[0],
2469 		    args[1]);
2470 		return (EINVAL);
2471 	}
2472 
2473 	return (0);
2474 }
2475 
2476 static int
2477 sched_class(int argc, const char *argv[])
2478 {
2479 	struct t4_sched_params op;
2480 	int errs, i;
2481 
2482 	memset(&op, 0xff, sizeof(op));
2483 	op.subcmd = -1;
2484 	op.type = -1;
2485 	if (argc == 0) {
2486 		warnx("missing scheduling sub-command");
2487 		return (EINVAL);
2488 	}
2489 	if (!strcmp(argv[0], "config")) {
2490 		op.subcmd = SCHED_CLASS_SUBCMD_CONFIG;
2491 		op.u.config.minmax = -1;
2492 	} else if (!strcmp(argv[0], "params")) {
2493 		op.subcmd = SCHED_CLASS_SUBCMD_PARAMS;
2494 		op.u.params.level = op.u.params.mode = op.u.params.rateunit =
2495 		    op.u.params.ratemode = op.u.params.channel =
2496 		    op.u.params.cl = op.u.params.minrate = op.u.params.maxrate =
2497 		    op.u.params.weight = op.u.params.pktsize = -1;
2498 	} else {
2499 		warnx("invalid scheduling sub-command \"%s\"", argv[0]);
2500 		return (EINVAL);
2501 	}
2502 
2503 	/* Decode remaining arguments ... */
2504 	errs = 0;
2505 	for (i = 1; i < argc; i += 2) {
2506 		const char **args = &argv[i];
2507 		long l;
2508 
2509 		if (i + 1 == argc) {
2510 			warnx("missing argument for \"%s\"", args[0]);
2511 			errs++;
2512 			break;
2513 		}
2514 
2515 		if (!strcmp(args[0], "type")) {
2516 			if (!strcmp(args[1], "packet"))
2517 				op.type = SCHED_CLASS_TYPE_PACKET;
2518 			else {
2519 				warnx("invalid type parameter \"%s\"", args[1]);
2520 				errs++;
2521 			}
2522 
2523 			continue;
2524 		}
2525 
2526 		if (op.subcmd == SCHED_CLASS_SUBCMD_CONFIG) {
2527 			if(!get_sched_param("minmax", args, &l))
2528 				op.u.config.minmax = (int8_t)l;
2529 			else {
2530 				warnx("unknown scheduler config parameter "
2531 				    "\"%s\"", args[0]);
2532 				errs++;
2533 			}
2534 
2535 			continue;
2536 		}
2537 
2538 		/* Rest applies only to SUBCMD_PARAMS */
2539 		if (op.subcmd != SCHED_CLASS_SUBCMD_PARAMS)
2540 			continue;
2541 
2542 		if (!strcmp(args[0], "level")) {
2543 			if (!strcmp(args[1], "cl-rl"))
2544 				op.u.params.level = SCHED_CLASS_LEVEL_CL_RL;
2545 			else if (!strcmp(args[1], "cl-wrr"))
2546 				op.u.params.level = SCHED_CLASS_LEVEL_CL_WRR;
2547 			else if (!strcmp(args[1], "ch-rl"))
2548 				op.u.params.level = SCHED_CLASS_LEVEL_CH_RL;
2549 			else {
2550 				warnx("invalid level parameter \"%s\"",
2551 				    args[1]);
2552 				errs++;
2553 			}
2554 		} else if (!strcmp(args[0], "mode")) {
2555 			if (!strcmp(args[1], "class"))
2556 				op.u.params.mode = SCHED_CLASS_MODE_CLASS;
2557 			else if (!strcmp(args[1], "flow"))
2558 				op.u.params.mode = SCHED_CLASS_MODE_FLOW;
2559 			else {
2560 				warnx("invalid mode parameter \"%s\"", args[1]);
2561 				errs++;
2562 			}
2563 		} else if (!strcmp(args[0], "rate-unit")) {
2564 			if (!strcmp(args[1], "bits"))
2565 				op.u.params.rateunit = SCHED_CLASS_RATEUNIT_BITS;
2566 			else if (!strcmp(args[1], "pkts"))
2567 				op.u.params.rateunit = SCHED_CLASS_RATEUNIT_PKTS;
2568 			else {
2569 				warnx("invalid rate-unit parameter \"%s\"",
2570 				    args[1]);
2571 				errs++;
2572 			}
2573 		} else if (!strcmp(args[0], "rate-mode")) {
2574 			if (!strcmp(args[1], "relative"))
2575 				op.u.params.ratemode = SCHED_CLASS_RATEMODE_REL;
2576 			else if (!strcmp(args[1], "absolute"))
2577 				op.u.params.ratemode = SCHED_CLASS_RATEMODE_ABS;
2578 			else {
2579 				warnx("invalid rate-mode parameter \"%s\"",
2580 				    args[1]);
2581 				errs++;
2582 			}
2583 		} else if (!get_sched_param("channel", args, &l))
2584 			op.u.params.channel = (int8_t)l;
2585 		else if (!get_sched_param("class", args, &l))
2586 			op.u.params.cl = (int8_t)l;
2587 		else if (!get_sched_param("min-rate", args, &l))
2588 			op.u.params.minrate = (int32_t)l;
2589 		else if (!get_sched_param("max-rate", args, &l))
2590 			op.u.params.maxrate = (int32_t)l;
2591 		else if (!get_sched_param("weight", args, &l))
2592 			op.u.params.weight = (int16_t)l;
2593 		else if (!get_sched_param("pkt-size", args, &l))
2594 			op.u.params.pktsize = (int16_t)l;
2595 		else {
2596 			warnx("unknown scheduler parameter \"%s\"", args[0]);
2597 			errs++;
2598 		}
2599 	}
2600 
2601 	/*
2602 	 * Catch some logical fallacies in terms of argument combinations here
2603 	 * so we can offer more than just the EINVAL return from the driver.
2604 	 * The driver will be able to catch a lot more issues since it knows
2605 	 * the specifics of the device hardware capabilities like how many
2606 	 * channels, classes, etc. the device supports.
2607 	 */
2608 	if (op.type < 0) {
2609 		warnx("sched \"type\" parameter missing");
2610 		errs++;
2611 	}
2612 	if (op.subcmd == SCHED_CLASS_SUBCMD_CONFIG) {
2613 		if (op.u.config.minmax < 0) {
2614 			warnx("sched config \"minmax\" parameter missing");
2615 			errs++;
2616 		}
2617 	}
2618 	if (op.subcmd == SCHED_CLASS_SUBCMD_PARAMS) {
2619 		if (op.u.params.level < 0) {
2620 			warnx("sched params \"level\" parameter missing");
2621 			errs++;
2622 		}
2623 		if (op.u.params.mode < 0) {
2624 			warnx("sched params \"mode\" parameter missing");
2625 			errs++;
2626 		}
2627 		if (op.u.params.rateunit < 0) {
2628 			warnx("sched params \"rate-unit\" parameter missing");
2629 			errs++;
2630 		}
2631 		if (op.u.params.ratemode < 0) {
2632 			warnx("sched params \"rate-mode\" parameter missing");
2633 			errs++;
2634 		}
2635 		if (op.u.params.channel < 0) {
2636 			warnx("sched params \"channel\" missing");
2637 			errs++;
2638 		}
2639 		if (op.u.params.cl < 0) {
2640 			warnx("sched params \"class\" missing");
2641 			errs++;
2642 		}
2643 		if (op.u.params.maxrate < 0 &&
2644 		    (op.u.params.level == SCHED_CLASS_LEVEL_CL_RL ||
2645 		    op.u.params.level == SCHED_CLASS_LEVEL_CH_RL)) {
2646 			warnx("sched params \"max-rate\" missing for "
2647 			    "rate-limit level");
2648 			errs++;
2649 		}
2650 		if (op.u.params.weight < 0 &&
2651 		    op.u.params.level == SCHED_CLASS_LEVEL_CL_WRR) {
2652 			warnx("sched params \"weight\" missing for "
2653 			    "weighted-round-robin level");
2654 			errs++;
2655 		}
2656 		if (op.u.params.pktsize < 0 &&
2657 		    (op.u.params.level == SCHED_CLASS_LEVEL_CL_RL ||
2658 		    op.u.params.level == SCHED_CLASS_LEVEL_CH_RL)) {
2659 			warnx("sched params \"pkt-size\" missing for "
2660 			    "rate-limit level");
2661 			errs++;
2662 		}
2663 		if (op.u.params.mode == SCHED_CLASS_MODE_FLOW &&
2664 		    op.u.params.ratemode != SCHED_CLASS_RATEMODE_ABS) {
2665 			warnx("sched params mode flow needs rate-mode absolute");
2666 			errs++;
2667 		}
2668 		if (op.u.params.ratemode == SCHED_CLASS_RATEMODE_REL &&
2669 		    !in_range(op.u.params.maxrate, 1, 100)) {
2670                         warnx("sched params \"max-rate\" takes "
2671 			    "percentage value(1-100) for rate-mode relative");
2672                         errs++;
2673                 }
2674                 if (op.u.params.ratemode == SCHED_CLASS_RATEMODE_ABS &&
2675 		    !in_range(op.u.params.maxrate, 1, 100000000)) {
2676                         warnx("sched params \"max-rate\" takes "
2677 			    "value(1-100000000) for rate-mode absolute");
2678                         errs++;
2679                 }
2680                 if (op.u.params.maxrate > 0 &&
2681 		    op.u.params.maxrate < op.u.params.minrate) {
2682                         warnx("sched params \"max-rate\" is less than "
2683 			    "\"min-rate\"");
2684                         errs++;
2685                 }
2686 	}
2687 
2688 	if (errs > 0) {
2689 		warnx("%d error%s in sched-class command", errs,
2690 		    errs == 1 ? "" : "s");
2691 		return (EINVAL);
2692 	}
2693 
2694 	return doit(CHELSIO_T4_SCHED_CLASS, &op);
2695 }
2696 
2697 static int
2698 sched_queue(int argc, const char *argv[])
2699 {
2700 	struct t4_sched_queue op = {0};
2701 	char *p;
2702 	long val;
2703 
2704 	if (argc != 3) {
2705 		/* need "<port> <queue> <class> */
2706 		warnx("incorrect number of arguments.");
2707 		return (EINVAL);
2708 	}
2709 
2710 	p = str_to_number(argv[0], &val, NULL);
2711 	if (*p || val > UCHAR_MAX) {
2712 		warnx("invalid port id \"%s\"", argv[0]);
2713 		return (EINVAL);
2714 	}
2715 	op.port = (uint8_t)val;
2716 
2717 	if (!strcmp(argv[1], "all") || !strcmp(argv[1], "*"))
2718 		op.queue = -1;
2719 	else {
2720 		p = str_to_number(argv[1], &val, NULL);
2721 		if (*p || val < -1) {
2722 			warnx("invalid queue \"%s\"", argv[1]);
2723 			return (EINVAL);
2724 		}
2725 		op.queue = (int8_t)val;
2726 	}
2727 
2728 	if (!strcmp(argv[2], "unbind") || !strcmp(argv[2], "clear"))
2729 		op.cl = -1;
2730 	else {
2731 		p = str_to_number(argv[2], &val, NULL);
2732 		if (*p || val < -1) {
2733 			warnx("invalid class \"%s\"", argv[2]);
2734 			return (EINVAL);
2735 		}
2736 		op.cl = (int8_t)val;
2737 	}
2738 
2739 	return doit(CHELSIO_T4_SCHED_QUEUE, &op);
2740 }
2741 
2742 static int
2743 run_cmd(int argc, const char *argv[])
2744 {
2745 	int rc = -1;
2746 	const char *cmd = argv[0];
2747 
2748 	/* command */
2749 	argc--;
2750 	argv++;
2751 
2752 	if (!strcmp(cmd, "reg") || !strcmp(cmd, "reg32"))
2753 		rc = register_io(argc, argv, 4);
2754 	else if (!strcmp(cmd, "reg64"))
2755 		rc = register_io(argc, argv, 8);
2756 	else if (!strcmp(cmd, "regdump"))
2757 		rc = dump_regs(argc, argv);
2758 	else if (!strcmp(cmd, "filter"))
2759 		rc = filter_cmd(argc, argv);
2760 	else if (!strcmp(cmd, "context"))
2761 		rc = get_sge_context(argc, argv);
2762 	else if (!strcmp(cmd, "loadfw"))
2763 		rc = loadfw(argc, argv);
2764 	else if (!strcmp(cmd, "memdump"))
2765 		rc = memdump(argc, argv);
2766 	else if (!strcmp(cmd, "tcb"))
2767 		rc = read_tcb(argc, argv);
2768 	else if (!strcmp(cmd, "i2c"))
2769 		rc = read_i2c(argc, argv);
2770 	else if (!strcmp(cmd, "clearstats"))
2771 		rc = clearstats(argc, argv);
2772 	else if (!strcmp(cmd, "tracer"))
2773 		rc = tracer_cmd(argc, argv);
2774 	else if (!strcmp(cmd, "modinfo"))
2775 		rc = modinfo(argc, argv);
2776 	else if (!strcmp(cmd, "sched-class"))
2777 		rc = sched_class(argc, argv);
2778 	else if (!strcmp(cmd, "sched-queue"))
2779 		rc = sched_queue(argc, argv);
2780 	else if (!strcmp(cmd, "loadcfg"))
2781 		rc = loadcfg(argc, argv);
2782 	else {
2783 		rc = EINVAL;
2784 		warnx("invalid command \"%s\"", cmd);
2785 	}
2786 
2787 	return (rc);
2788 }
2789 
2790 #define MAX_ARGS 15
2791 static int
2792 run_cmd_loop(void)
2793 {
2794 	int i, rc = 0;
2795 	char buffer[128], *buf;
2796 	const char *args[MAX_ARGS + 1];
2797 
2798 	/*
2799 	 * Simple loop: displays a "> " prompt and processes any input as a
2800 	 * cxgbetool command.  You're supposed to enter only the part after
2801 	 * "cxgbetool t4nexX".  Use "quit" or "exit" to exit.
2802 	 */
2803 	for (;;) {
2804 		fprintf(stdout, "> ");
2805 		fflush(stdout);
2806 		buf = fgets(buffer, sizeof(buffer), stdin);
2807 		if (buf == NULL) {
2808 			if (ferror(stdin)) {
2809 				warn("stdin error");
2810 				rc = errno;	/* errno from fgets */
2811 			}
2812 			break;
2813 		}
2814 
2815 		i = 0;
2816 		while ((args[i] = strsep(&buf, " \t\n")) != NULL) {
2817 			if (args[i][0] != 0 && ++i == MAX_ARGS)
2818 				break;
2819 		}
2820 		args[i] = 0;
2821 
2822 		if (i == 0)
2823 			continue;	/* skip empty line */
2824 
2825 		if (!strcmp(args[0], "quit") || !strcmp(args[0], "exit"))
2826 			break;
2827 
2828 		rc = run_cmd(i, args);
2829 	}
2830 
2831 	/* rc normally comes from the last command (not including quit/exit) */
2832 	return (rc);
2833 }
2834 
2835 int
2836 main(int argc, const char *argv[])
2837 {
2838 	int rc = -1;
2839 
2840 	progname = argv[0];
2841 
2842 	if (argc == 2) {
2843 		if (!strcmp(argv[1], "-h") || !strcmp(argv[1], "--help")) {
2844 			usage(stdout);
2845 			exit(0);
2846 		}
2847 	}
2848 
2849 	if (argc < 3) {
2850 		usage(stderr);
2851 		exit(EINVAL);
2852 	}
2853 
2854 	nexus = argv[1];
2855 
2856 	/* progname and nexus */
2857 	argc -= 2;
2858 	argv += 2;
2859 
2860 	if (argc == 1 && !strcmp(argv[0], "stdio"))
2861 		rc = run_cmd_loop();
2862 	else
2863 		rc = run_cmd(argc, argv);
2864 
2865 	return (rc);
2866 }
2867