usr.sbin/cxgbetool/cxgbetool.c

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