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