sbin/ipfw/ipfw2.c

   1 /*
   2  * Copyright (c) 2002-2003 Luigi Rizzo
   3  * Copyright (c) 1996 Alex Nash, Paul Traina, Poul-Henning Kamp
   4  * Copyright (c) 1994 Ugen J.S.Antsilevich
   5  *
   6  * Idea and grammar partially left from:
   7  * Copyright (c) 1993 Daniel Boulet
   8  *
   9  * Redistribution and use in source forms, with and without modification,
  10  * are permitted provided that this entire comment appears intact.
  11  *
  12  * Redistribution in binary form may occur without any restrictions.
  13  * Obviously, it would be nice if you gave credit where credit is due
  14  * but requiring it would be too onerous.
  15  *
  16  * This software is provided ``AS IS'' without any warranties of any kind.
  17  *
  18  * NEW command line interface for IP firewall facility
  19  *
  20  * $FreeBSD$
  21  */
  22
  23 #include <sys/types.h>
  24 #include <sys/param.h>
  25 #include <sys/socket.h>
  26 #include <sys/sockio.h>
  27 #include <sys/sysctl.h>
  28
  29 #include "ipfw2.h"
  30
  31 #include <ctype.h>
  32 #include <err.h>
  33 #include <errno.h>
  34 #include <grp.h>
  35 #include <jail.h>
  36 #include <netdb.h>
  37 #include <pwd.h>
  38 #include <stdio.h>
  39 #include <stdarg.h>
  40 #include <stdint.h>
  41 #include <stdlib.h>
  42 #include <string.h>
  43 #include <sysexits.h>
  44 #include <time.h>       /* ctime */
  45 #include <timeconv.h>   /* _long_to_time */
  46 #include <unistd.h>
  47 #include <fcntl.h>
  48 #include <stddef.h>     /* offsetof */
  49
  50 #include <net/ethernet.h>
  51 #include <net/if.h>             /* only IFNAMSIZ */
  52 #include <netinet/in.h>
  53 #include <netinet/in_systm.h>   /* only n_short, n_long */
  54 #include <netinet/ip.h>
  55 #include <netinet/ip_icmp.h>
  56 #include <netinet/ip_fw.h>
  57 #include <netinet/tcp.h>
  58 #include <arpa/inet.h>
  59
  60 struct cmdline_opts co; /* global options */
  61
  62 struct format_opts {
  63         int bcwidth;
  64         int pcwidth;
  65         int show_counters;
  66         int show_time;          /* show timestamp */
  67         uint32_t set_mask;      /* enabled sets mask */
  68         uint32_t flags;         /* request flags */
  69         uint32_t first;         /* first rule to request */
  70         uint32_t last;          /* last rule to request */
  71         uint32_t dcnt;          /* number of dynamic states */
  72         ipfw_obj_ctlv *tstate;  /* table state data */
  73 };
  74
  75 int resvd_set_number = RESVD_SET;
  76
  77 int ipfw_socket = -1;
  78
  79 #define CHECK_LENGTH(v, len) do {                               \
  80         if ((v) < (len))                                        \
  81                 errx(EX_DATAERR, "Rule too long");              \
  82         } while (0)
  83 /*
  84  * Check if we have enough space in cmd buffer. Note that since
  85  * first 8? u32 words are reserved by reserved header, full cmd
  86  * buffer can't be used, so we need to protect from buffer overrun
  87  * only. At the beginning, cblen is less than actual buffer size by
  88  * size of ipfw_insn_u32 instruction + 1 u32 work. This eliminates need
  89  * for checking small instructions fitting in given range.
  90  * We also (ab)use the fact that ipfw_insn is always the first field
  91  * for any custom instruction.
  92  */
  93 #define CHECK_CMDLEN    CHECK_LENGTH(cblen, F_LEN((ipfw_insn *)cmd))
  94
  95 #define GET_UINT_ARG(arg, min, max, tok, s_x) do {                      \
  96         if (!av[0])                                                     \
  97                 errx(EX_USAGE, "%s: missing argument", match_value(s_x, tok)); \
  98         if (_substrcmp(*av, "tablearg") == 0) {                         \
  99                 arg = IP_FW_TARG;                                       \
 100                 break;                                                  \
 101         }                                                               \
 102                                                                         \
 103         {                                                               \
 104         long _xval;                                                     \
 105         char *end;                                                      \
 106                                                                         \
 107         _xval = strtol(*av, &end, 10);                                  \
 108                                                                         \
 109         if (!isdigit(**av) || *end != '\0' || (_xval == 0 && errno == EINVAL)) \
 110                 errx(EX_DATAERR, "%s: invalid argument: %s",            \
 111                     match_value(s_x, tok), *av);                        \
 112                                                                         \
 113         if (errno == ERANGE || _xval < min || _xval > max)              \
 114                 errx(EX_DATAERR, "%s: argument is out of range (%u..%u): %s", \
 115                     match_value(s_x, tok), min, max, *av);              \
 116                                                                         \
 117         if (_xval == IP_FW_TARG)                                        \
 118                 errx(EX_DATAERR, "%s: illegal argument value: %s",      \
 119                     match_value(s_x, tok), *av);                        \
 120         arg = _xval;                                                    \
 121         }                                                               \
 122 } while (0)
 123
 124 static struct _s_x f_tcpflags[] = {
 125         { "syn", TH_SYN },
 126         { "fin", TH_FIN },
 127         { "ack", TH_ACK },
 128         { "psh", TH_PUSH },
 129         { "rst", TH_RST },
 130         { "urg", TH_URG },
 131         { "tcp flag", 0 },
 132         { NULL, 0 }
 133 };
 134
 135 static struct _s_x f_tcpopts[] = {
 136         { "mss",        IP_FW_TCPOPT_MSS },
 137         { "maxseg",     IP_FW_TCPOPT_MSS },
 138         { "window",     IP_FW_TCPOPT_WINDOW },
 139         { "sack",       IP_FW_TCPOPT_SACK },
 140         { "ts",         IP_FW_TCPOPT_TS },
 141         { "timestamp",  IP_FW_TCPOPT_TS },
 142         { "cc",         IP_FW_TCPOPT_CC },
 143         { "tcp option", 0 },
 144         { NULL, 0 }
 145 };
 146
 147 /*
 148  * IP options span the range 0 to 255 so we need to remap them
 149  * (though in fact only the low 5 bits are significant).
 150  */
 151 static struct _s_x f_ipopts[] = {
 152         { "ssrr",       IP_FW_IPOPT_SSRR},
 153         { "lsrr",       IP_FW_IPOPT_LSRR},
 154         { "rr",         IP_FW_IPOPT_RR},
 155         { "ts",         IP_FW_IPOPT_TS},
 156         { "ip option",  0 },
 157         { NULL, 0 }
 158 };
 159
 160 static struct _s_x f_iptos[] = {
 161         { "lowdelay",   IPTOS_LOWDELAY},
 162         { "throughput", IPTOS_THROUGHPUT},
 163         { "reliability", IPTOS_RELIABILITY},
 164         { "mincost",    IPTOS_MINCOST},
 165         { "congestion", IPTOS_ECN_CE},
 166         { "ecntransport", IPTOS_ECN_ECT0},
 167         { "ip tos option", 0},
 168         { NULL, 0 }
 169 };
 170
 171 struct _s_x f_ipdscp[] = {
 172         { "af11", IPTOS_DSCP_AF11 >> 2 },       /* 001010 */
 173         { "af12", IPTOS_DSCP_AF12 >> 2 },       /* 001100 */
 174         { "af13", IPTOS_DSCP_AF13 >> 2 },       /* 001110 */
 175         { "af21", IPTOS_DSCP_AF21 >> 2 },       /* 010010 */
 176         { "af22", IPTOS_DSCP_AF22 >> 2 },       /* 010100 */
 177         { "af23", IPTOS_DSCP_AF23 >> 2 },       /* 010110 */
 178         { "af31", IPTOS_DSCP_AF31 >> 2 },       /* 011010 */
 179         { "af32", IPTOS_DSCP_AF32 >> 2 },       /* 011100 */
 180         { "af33", IPTOS_DSCP_AF33 >> 2 },       /* 011110 */
 181         { "af41", IPTOS_DSCP_AF41 >> 2 },       /* 100010 */
 182         { "af42", IPTOS_DSCP_AF42 >> 2 },       /* 100100 */
 183         { "af43", IPTOS_DSCP_AF43 >> 2 },       /* 100110 */
 184         { "be", IPTOS_DSCP_CS0 >> 2 },  /* 000000 */
 185         { "ef", IPTOS_DSCP_EF >> 2 },   /* 101110 */
 186         { "cs0", IPTOS_DSCP_CS0 >> 2 }, /* 000000 */
 187         { "cs1", IPTOS_DSCP_CS1 >> 2 }, /* 001000 */
 188         { "cs2", IPTOS_DSCP_CS2 >> 2 }, /* 010000 */
 189         { "cs3", IPTOS_DSCP_CS3 >> 2 }, /* 011000 */
 190         { "cs4", IPTOS_DSCP_CS4 >> 2 }, /* 100000 */
 191         { "cs5", IPTOS_DSCP_CS5 >> 2 }, /* 101000 */
 192         { "cs6", IPTOS_DSCP_CS6 >> 2 }, /* 110000 */
 193         { "cs7", IPTOS_DSCP_CS7 >> 2 }, /* 100000 */
 194         { NULL, 0 }
 195 };
 196
 197 static struct _s_x limit_masks[] = {
 198         {"all",         DYN_SRC_ADDR|DYN_SRC_PORT|DYN_DST_ADDR|DYN_DST_PORT},
 199         {"src-addr",    DYN_SRC_ADDR},
 200         {"src-port",    DYN_SRC_PORT},
 201         {"dst-addr",    DYN_DST_ADDR},
 202         {"dst-port",    DYN_DST_PORT},
 203         {NULL,          0}
 204 };
 205
 206 /*
 207  * we use IPPROTO_ETHERTYPE as a fake protocol id to call the print routines
 208  * This is only used in this code.
 209  */
 210 #define IPPROTO_ETHERTYPE       0x1000
 211 static struct _s_x ether_types[] = {
 212     /*
 213      * Note, we cannot use "-:&/" in the names because they are field
 214      * separators in the type specifications. Also, we use s = NULL as
 215      * end-delimiter, because a type of 0 can be legal.
 216      */
 217         { "ip",         0x0800 },
 218         { "ipv4",       0x0800 },
 219         { "ipv6",       0x86dd },
 220         { "arp",        0x0806 },
 221         { "rarp",       0x8035 },
 222         { "vlan",       0x8100 },
 223         { "loop",       0x9000 },
 224         { "trail",      0x1000 },
 225         { "at",         0x809b },
 226         { "atalk",      0x809b },
 227         { "aarp",       0x80f3 },
 228         { "pppoe_disc", 0x8863 },
 229         { "pppoe_sess", 0x8864 },
 230         { "ipx_8022",   0x00E0 },
 231         { "ipx_8023",   0x0000 },
 232         { "ipx_ii",     0x8137 },
 233         { "ipx_snap",   0x8137 },
 234         { "ipx",        0x8137 },
 235         { "ns",         0x0600 },
 236         { NULL,         0 }
 237 };
 238
 239 static struct _s_x rule_eactions[] = {
 240         { "nat64clat",          TOK_NAT64CLAT },
 241         { "nat64lsn",           TOK_NAT64LSN },
 242         { "nat64stl",           TOK_NAT64STL },
 243         { "nptv6",              TOK_NPTV6 },
 244         { "tcp-setmss",         TOK_TCPSETMSS },
 245         { NULL, 0 }     /* terminator */
 246 };
 247
 248 static struct _s_x rule_actions[] = {
 249         { "abort6",             TOK_ABORT6 },
 250         { "abort",              TOK_ABORT },
 251         { "accept",             TOK_ACCEPT },
 252         { "pass",               TOK_ACCEPT },
 253         { "allow",              TOK_ACCEPT },
 254         { "permit",             TOK_ACCEPT },
 255         { "count",              TOK_COUNT },
 256         { "pipe",               TOK_PIPE },
 257         { "queue",              TOK_QUEUE },
 258         { "divert",             TOK_DIVERT },
 259         { "tee",                TOK_TEE },
 260         { "netgraph",           TOK_NETGRAPH },
 261         { "ngtee",              TOK_NGTEE },
 262         { "fwd",                TOK_FORWARD },
 263         { "forward",            TOK_FORWARD },
 264         { "skipto",             TOK_SKIPTO },
 265         { "deny",               TOK_DENY },
 266         { "drop",               TOK_DENY },
 267         { "reject",             TOK_REJECT },
 268         { "reset6",             TOK_RESET6 },
 269         { "reset",              TOK_RESET },
 270         { "unreach6",           TOK_UNREACH6 },
 271         { "unreach",            TOK_UNREACH },
 272         { "check-state",        TOK_CHECKSTATE },
 273         { "//",                 TOK_COMMENT },
 274         { "nat",                TOK_NAT },
 275         { "reass",              TOK_REASS },
 276         { "setfib",             TOK_SETFIB },
 277         { "setdscp",            TOK_SETDSCP },
 278         { "call",               TOK_CALL },
 279         { "return",             TOK_RETURN },
 280         { "eaction",            TOK_EACTION },
 281         { "tcp-setmss",         TOK_TCPSETMSS },
 282         { NULL, 0 }     /* terminator */
 283 };
 284
 285 static struct _s_x rule_action_params[] = {
 286         { "altq",               TOK_ALTQ },
 287         { "log",                TOK_LOG },
 288         { "tag",                TOK_TAG },
 289         { "untag",              TOK_UNTAG },
 290         { NULL, 0 }     /* terminator */
 291 };
 292
 293 /*
 294  * The 'lookup' instruction accepts one of the following arguments.
 295  * -1 is a terminator for the list.
 296  * Arguments are passed as v[1] in O_DST_LOOKUP options.
 297  */
 298 static int lookup_key[] = {
 299         TOK_DSTIP, TOK_SRCIP, TOK_DSTPORT, TOK_SRCPORT,
 300         TOK_UID, TOK_JAIL, TOK_DSCP, -1 };
 301
 302 static struct _s_x rule_options[] = {
 303         { "tagged",             TOK_TAGGED },
 304         { "uid",                TOK_UID },
 305         { "gid",                TOK_GID },
 306         { "jail",               TOK_JAIL },
 307         { "in",                 TOK_IN },
 308         { "limit",              TOK_LIMIT },
 309         { "set-limit",          TOK_SETLIMIT },
 310         { "keep-state",         TOK_KEEPSTATE },
 311         { "record-state",       TOK_RECORDSTATE },
 312         { "bridged",            TOK_LAYER2 },
 313         { "layer2",             TOK_LAYER2 },
 314         { "out",                TOK_OUT },
 315         { "diverted",           TOK_DIVERTED },
 316         { "diverted-loopback",  TOK_DIVERTEDLOOPBACK },
 317         { "diverted-output",    TOK_DIVERTEDOUTPUT },
 318         { "xmit",               TOK_XMIT },
 319         { "recv",               TOK_RECV },
 320         { "via",                TOK_VIA },
 321         { "fragment",           TOK_FRAG },
 322         { "frag",               TOK_FRAG },
 323         { "fib",                TOK_FIB },
 324         { "ipoptions",          TOK_IPOPTS },
 325         { "ipopts",             TOK_IPOPTS },
 326         { "iplen",              TOK_IPLEN },
 327         { "ipid",               TOK_IPID },
 328         { "ipprecedence",       TOK_IPPRECEDENCE },
 329         { "dscp",               TOK_DSCP },
 330         { "iptos",              TOK_IPTOS },
 331         { "ipttl",              TOK_IPTTL },
 332         { "ipversion",          TOK_IPVER },
 333         { "ipver",              TOK_IPVER },
 334         { "estab",              TOK_ESTAB },
 335         { "established",        TOK_ESTAB },
 336         { "setup",              TOK_SETUP },
 337         { "sockarg",            TOK_SOCKARG },
 338         { "tcpdatalen",         TOK_TCPDATALEN },
 339         { "tcpflags",           TOK_TCPFLAGS },
 340         { "tcpflgs",            TOK_TCPFLAGS },
 341         { "tcpoptions",         TOK_TCPOPTS },
 342         { "tcpopts",            TOK_TCPOPTS },
 343         { "tcpseq",             TOK_TCPSEQ },
 344         { "tcpack",             TOK_TCPACK },
 345         { "tcpwin",             TOK_TCPWIN },
 346         { "icmptype",           TOK_ICMPTYPES },
 347         { "icmptypes",          TOK_ICMPTYPES },
 348         { "dst-ip",             TOK_DSTIP },
 349         { "src-ip",             TOK_SRCIP },
 350         { "dst-port",           TOK_DSTPORT },
 351         { "src-port",           TOK_SRCPORT },
 352         { "proto",              TOK_PROTO },
 353         { "MAC",                TOK_MAC },
 354         { "mac",                TOK_MAC },
 355         { "mac-type",           TOK_MACTYPE },
 356         { "verrevpath",         TOK_VERREVPATH },
 357         { "versrcreach",        TOK_VERSRCREACH },
 358         { "antispoof",          TOK_ANTISPOOF },
 359         { "ipsec",              TOK_IPSEC },
 360         { "icmp6type",          TOK_ICMP6TYPES },
 361         { "icmp6types",         TOK_ICMP6TYPES },
 362         { "ext6hdr",            TOK_EXT6HDR},
 363         { "flow-id",            TOK_FLOWID},
 364         { "ipv6",               TOK_IPV6},
 365         { "ip6",                TOK_IPV6},
 366         { "ipv4",               TOK_IPV4},
 367         { "ip4",                TOK_IPV4},
 368         { "dst-ipv6",           TOK_DSTIP6},
 369         { "dst-ip6",            TOK_DSTIP6},
 370         { "src-ipv6",           TOK_SRCIP6},
 371         { "src-ip6",            TOK_SRCIP6},
 372         { "lookup",             TOK_LOOKUP},
 373         { "flow",               TOK_FLOW},
 374         { "defer-action",       TOK_SKIPACTION },
 375         { "defer-immediate-action",     TOK_SKIPACTION },
 376         { "//",                 TOK_COMMENT },
 377
 378         { "not",                TOK_NOT },              /* pseudo option */
 379         { "!", /* escape ? */   TOK_NOT },              /* pseudo option */
 380         { "or",                 TOK_OR },               /* pseudo option */
 381         { "|", /* escape */     TOK_OR },               /* pseudo option */
 382         { "{",                  TOK_STARTBRACE },       /* pseudo option */
 383         { "(",                  TOK_STARTBRACE },       /* pseudo option */
 384         { "}",                  TOK_ENDBRACE },         /* pseudo option */
 385         { ")",                  TOK_ENDBRACE },         /* pseudo option */
 386         { NULL, 0 }     /* terminator */
 387 };
 388
 389 void bprint_uint_arg(struct buf_pr *bp, const char *str, uint32_t arg);
 390 static int ipfw_get_config(struct cmdline_opts *co, struct format_opts *fo,
 391     ipfw_cfg_lheader **pcfg, size_t *psize);
 392 static int ipfw_show_config(struct cmdline_opts *co, struct format_opts *fo,
 393     ipfw_cfg_lheader *cfg, size_t sz, int ac, char **av);
 394 static void ipfw_list_tifaces(void);
 395
 396 struct tidx;
 397 static uint16_t pack_object(struct tidx *tstate, char *name, int otype);
 398 static uint16_t pack_table(struct tidx *tstate, char *name);
 399
 400 static char *table_search_ctlv(ipfw_obj_ctlv *ctlv, uint16_t idx);
 401 static void object_sort_ctlv(ipfw_obj_ctlv *ctlv);
 402 static char *object_search_ctlv(ipfw_obj_ctlv *ctlv, uint16_t idx,
 403     uint16_t type);
 404
 405 /*
 406  * Simple string buffer API.
 407  * Used to simplify buffer passing between function and for
 408  * transparent overrun handling.
 409  */
 410
 411 /*
 412  * Allocates new buffer of given size @sz.
 413  *
 414  * Returns 0 on success.
 415  */
 416 int
 417 bp_alloc(struct buf_pr *b, size_t size)
 418 {
 419         memset(b, 0, sizeof(struct buf_pr));
 420
 421         if ((b->buf = calloc(1, size)) == NULL)
 422                 return (ENOMEM);
 423
 424         b->ptr = b->buf;
 425         b->size = size;
 426         b->avail = b->size;
 427
 428         return (0);
 429 }
 430
 431 void
 432 bp_free(struct buf_pr *b)
 433 {
 434
 435         free(b->buf);
 436 }
 437
 438 /*
 439  * Flushes buffer so new writer start from beginning.
 440  */
 441 void
 442 bp_flush(struct buf_pr *b)
 443 {
 444
 445         b->ptr = b->buf;
 446         b->avail = b->size;
 447         b->buf[0] = '\0';
 448 }
 449
 450 /*
 451  * Print message specified by @format and args.
 452  * Automatically manage buffer space and transparently handle
 453  * buffer overruns.
 454  *
 455  * Returns number of bytes that should have been printed.
 456  */
 457 int
 458 bprintf(struct buf_pr *b, char *format, ...)
 459 {
 460         va_list args;
 461         int i;
 462
 463         va_start(args, format);
 464
 465         i = vsnprintf(b->ptr, b->avail, format, args);
 466         va_end(args);
 467
 468         if (i > b->avail || i < 0) {
 469                 /* Overflow or print error */
 470                 b->avail = 0;
 471         } else {
 472                 b->ptr += i;
 473                 b->avail -= i;
 474         }
 475
 476         b->needed += i;
 477
 478         return (i);
 479 }
 480
 481 /*
 482  * Special values printer for tablearg-aware opcodes.
 483  */
 484 void
 485 bprint_uint_arg(struct buf_pr *bp, const char *str, uint32_t arg)
 486 {
 487
 488         if (str != NULL)
 489                 bprintf(bp, "%s", str);
 490         if (arg == IP_FW_TARG)
 491                 bprintf(bp, "tablearg");
 492         else
 493                 bprintf(bp, "%u", arg);
 494 }
 495
 496 /*
 497  * Helper routine to print a possibly unaligned uint64_t on
 498  * various platform. If width > 0, print the value with
 499  * the desired width, followed by a space;
 500  * otherwise, return the required width.
 501  */
 502 int
 503 pr_u64(struct buf_pr *b, uint64_t *pd, int width)
 504 {
 505 #ifdef TCC
 506 #define U64_FMT "I64"
 507 #else
 508 #define U64_FMT "llu"
 509 #endif
 510         uint64_t u;
 511         unsigned long long d;
 512
 513         bcopy (pd, &u, sizeof(u));
 514         d = u;
 515         return (width > 0) ?
 516                 bprintf(b, "%*" U64_FMT " ", width, d) :
 517                 snprintf(NULL, 0, "%" U64_FMT, d) ;
 518 #undef U64_FMT
 519 }
 520
 521
 522 void *
 523 safe_calloc(size_t number, size_t size)
 524 {
 525         void *ret = calloc(number, size);
 526
 527         if (ret == NULL)
 528                 err(EX_OSERR, "calloc");
 529         return ret;
 530 }
 531
 532 void *
 533 safe_realloc(void *ptr, size_t size)
 534 {
 535         void *ret = realloc(ptr, size);
 536
 537         if (ret == NULL)
 538                 err(EX_OSERR, "realloc");
 539         return ret;
 540 }
 541
 542 /*
 543  * Compare things like interface or table names.
 544  */
 545 int
 546 stringnum_cmp(const char *a, const char *b)
 547 {
 548         int la, lb;
 549
 550         la = strlen(a);
 551         lb = strlen(b);
 552
 553         if (la > lb)
 554                 return (1);
 555         else if (la < lb)
 556                 return (-01);
 557
 558         return (strcmp(a, b));
 559 }
 560
 561
 562 /*
 563  * conditionally runs the command.
 564  * Selected options or negative -> getsockopt
 565  */
 566 int
 567 do_cmd(int optname, void *optval, uintptr_t optlen)
 568 {
 569         int i;
 570
 571         if (co.test_only)
 572                 return 0;
 573
 574         if (ipfw_socket == -1)
 575                 ipfw_socket = socket(AF_INET, SOCK_RAW, IPPROTO_RAW);
 576         if (ipfw_socket < 0)
 577                 err(EX_UNAVAILABLE, "socket");
 578
 579         if (optname == IP_FW_GET || optname == IP_DUMMYNET_GET ||
 580             optname == IP_FW_ADD || optname == IP_FW3 ||
 581             optname == IP_FW_NAT_GET_CONFIG ||
 582             optname < 0 ||
 583             optname == IP_FW_NAT_GET_LOG) {
 584                 if (optname < 0)
 585                         optname = -optname;
 586                 i = getsockopt(ipfw_socket, IPPROTO_IP, optname, optval,
 587                         (socklen_t *)optlen);
 588         } else {
 589                 i = setsockopt(ipfw_socket, IPPROTO_IP, optname, optval, optlen);
 590         }
 591         return i;
 592 }
 593
 594 /*
 595  * do_set3 - pass ipfw control cmd to kernel
 596  * @optname: option name
 597  * @optval: pointer to option data
 598  * @optlen: option length
 599  *
 600  * Assumes op3 header is already embedded.
 601  * Calls setsockopt() with IP_FW3 as kernel-visible opcode.
 602  * Returns 0 on success or errno otherwise.
 603  */
 604 int
 605 do_set3(int optname, ip_fw3_opheader *op3, size_t optlen)
 606 {
 607
 608         if (co.test_only)
 609                 return (0);
 610
 611         if (ipfw_socket == -1)
 612                 ipfw_socket = socket(AF_INET, SOCK_RAW, IPPROTO_RAW);
 613         if (ipfw_socket < 0)
 614                 err(EX_UNAVAILABLE, "socket");
 615
 616         op3->opcode = optname;
 617
 618         return (setsockopt(ipfw_socket, IPPROTO_IP, IP_FW3, op3, optlen));
 619 }
 620
 621 /*
 622  * do_get3 - pass ipfw control cmd to kernel
 623  * @optname: option name
 624  * @optval: pointer to option data
 625  * @optlen: pointer to option length
 626  *
 627  * Assumes op3 header is already embedded.
 628  * Calls getsockopt() with IP_FW3 as kernel-visible opcode.
 629  * Returns 0 on success or errno otherwise.
 630  */
 631 int
 632 do_get3(int optname, ip_fw3_opheader *op3, size_t *optlen)
 633 {
 634         int error;
 635         socklen_t len;
 636
 637         if (co.test_only)
 638                 return (0);
 639
 640         if (ipfw_socket == -1)
 641                 ipfw_socket = socket(AF_INET, SOCK_RAW, IPPROTO_RAW);
 642         if (ipfw_socket < 0)
 643                 err(EX_UNAVAILABLE, "socket");
 644
 645         op3->opcode = optname;
 646
 647         len = *optlen;
 648         error = getsockopt(ipfw_socket, IPPROTO_IP, IP_FW3, op3, &len);
 649         *optlen = len;
 650
 651         return (error);
 652 }
 653
 654 /**
 655  * match_token takes a table and a string, returns the value associated
 656  * with the string (-1 in case of failure).
 657  */
 658 int
 659 match_token(struct _s_x *table, const char *string)
 660 {
 661         struct _s_x *pt;
 662         uint i = strlen(string);
 663
 664         for (pt = table ; i && pt->s != NULL ; pt++)
 665                 if (strlen(pt->s) == i && !bcmp(string, pt->s, i))
 666                         return pt->x;
 667         return (-1);
 668 }
 669
 670 /**
 671  * match_token_relaxed takes a table and a string, returns the value associated
 672  * with the string for the best match.
 673  *
 674  * Returns:
 675  * value from @table for matched records
 676  * -1 for non-matched records
 677  * -2 if more than one records match @string.
 678  */
 679 int
 680 match_token_relaxed(struct _s_x *table, const char *string)
 681 {
 682         struct _s_x *pt, *m;
 683         int i, c;
 684
 685         i = strlen(string);
 686         c = 0;
 687
 688         for (pt = table ; i != 0 && pt->s != NULL ; pt++) {
 689                 if (strncmp(pt->s, string, i) != 0)
 690                         continue;
 691                 m = pt;
 692                 c++;
 693         }
 694
 695         if (c == 1)
 696                 return (m->x);
 697
 698         return (c > 0 ? -2: -1);
 699 }
 700
 701 int
 702 get_token(struct _s_x *table, const char *string, const char *errbase)
 703 {
 704         int tcmd;
 705
 706         if ((tcmd = match_token_relaxed(table, string)) < 0)
 707                 errx(EX_USAGE, "%s %s %s",
 708                     (tcmd == 0) ? "invalid" : "ambiguous", errbase, string);
 709
 710         return (tcmd);
 711 }
 712
 713 /**
 714  * match_value takes a table and a value, returns the string associated
 715  * with the value (NULL in case of failure).
 716  */
 717 char const *
 718 match_value(struct _s_x *p, int value)
 719 {
 720         for (; p->s != NULL; p++)
 721                 if (p->x == value)
 722                         return p->s;
 723         return NULL;
 724 }
 725
 726 size_t
 727 concat_tokens(char *buf, size_t bufsize, struct _s_x *table, char *delimiter)
 728 {
 729         struct _s_x *pt;
 730         int l;
 731         size_t sz;
 732
 733         for (sz = 0, pt = table ; pt->s != NULL; pt++) {
 734                 l = snprintf(buf + sz, bufsize - sz, "%s%s",
 735                     (sz == 0) ? "" : delimiter, pt->s);
 736                 sz += l;
 737                 bufsize += l;
 738                 if (sz > bufsize)
 739                         return (bufsize);
 740         }
 741
 742         return (sz);
 743 }
 744
 745 /*
 746  * helper function to process a set of flags and set bits in the
 747  * appropriate masks.
 748  */
 749 int
 750 fill_flags(struct _s_x *flags, char *p, char **e, uint32_t *set,
 751     uint32_t *clear)
 752 {
 753         char *q;        /* points to the separator */
 754         int val;
 755         uint32_t *which;        /* mask we are working on */
 756
 757         while (p && *p) {
 758                 if (*p == '!') {
 759                         p++;
 760                         which = clear;
 761                 } else
 762                         which = set;
 763                 q = strchr(p, ',');
 764                 if (q)
 765                         *q++ = '\0';
 766                 val = match_token(flags, p);
 767                 if (val <= 0) {
 768                         if (e != NULL)
 769                                 *e = p;
 770                         return (-1);
 771                 }
 772                 *which |= (uint32_t)val;
 773                 p = q;
 774         }
 775         return (0);
 776 }
 777
 778 void
 779 print_flags_buffer(char *buf, size_t sz, struct _s_x *list, uint32_t set)
 780 {
 781         char const *comma = "";
 782         int i, l;
 783
 784         for (i = 0; list[i].x != 0; i++) {
 785                 if ((set & list[i].x) == 0)
 786                         continue;
 787
 788                 set &= ~list[i].x;
 789                 l = snprintf(buf, sz, "%s%s", comma, list[i].s);
 790                 if (l >= sz)
 791                         return;
 792                 comma = ",";
 793                 buf += l;
 794                 sz -=l;
 795         }
 796 }
 797
 798 /*
 799  * _substrcmp takes two strings and returns 1 if they do not match,
 800  * and 0 if they match exactly or the first string is a sub-string
 801  * of the second.  A warning is printed to stderr in the case that the
 802  * first string is a sub-string of the second.
 803  *
 804  * This function will be removed in the future through the usual
 805  * deprecation process.
 806  */
 807 int
 808 _substrcmp(const char *str1, const char* str2)
 809 {
 810
 811         if (strncmp(str1, str2, strlen(str1)) != 0)
 812                 return 1;
 813
 814         if (strlen(str1) != strlen(str2))
 815                 warnx("DEPRECATED: '%s' matched '%s' as a sub-string",
 816                     str1, str2);
 817         return 0;
 818 }
 819
 820 /*
 821  * _substrcmp2 takes three strings and returns 1 if the first two do not match,
 822  * and 0 if they match exactly or the second string is a sub-string
 823  * of the first.  A warning is printed to stderr in the case that the
 824  * first string does not match the third.
 825  *
 826  * This function exists to warn about the bizarre construction
 827  * strncmp(str, "by", 2) which is used to allow people to use a shortcut
 828  * for "bytes".  The problem is that in addition to accepting "by",
 829  * "byt", "byte", and "bytes", it also excepts "by_rabid_dogs" and any
 830  * other string beginning with "by".
 831  *
 832  * This function will be removed in the future through the usual
 833  * deprecation process.
 834  */
 835 int
 836 _substrcmp2(const char *str1, const char* str2, const char* str3)
 837 {
 838
 839         if (strncmp(str1, str2, strlen(str2)) != 0)
 840                 return 1;
 841
 842         if (strcmp(str1, str3) != 0)
 843                 warnx("DEPRECATED: '%s' matched '%s'",
 844                     str1, str3);
 845         return 0;
 846 }
 847
 848 /*
 849  * prints one port, symbolic or numeric
 850  */
 851 static void
 852 print_port(struct buf_pr *bp, int proto, uint16_t port)
 853 {
 854
 855         if (proto == IPPROTO_ETHERTYPE) {
 856                 char const *s;
 857
 858                 if (co.do_resolv && (s = match_value(ether_types, port)) )
 859                         bprintf(bp, "%s", s);
 860                 else
 861                         bprintf(bp, "0x%04x", port);
 862         } else {
 863                 struct servent *se = NULL;
 864                 if (co.do_resolv) {
 865                         struct protoent *pe = getprotobynumber(proto);
 866
 867                         se = getservbyport(htons(port), pe ? pe->p_name : NULL);
 868                 }
 869                 if (se)
 870                         bprintf(bp, "%s", se->s_name);
 871                 else
 872                         bprintf(bp, "%d", port);
 873         }
 874 }
 875
 876 static struct _s_x _port_name[] = {
 877         {"dst-port",    O_IP_DSTPORT},
 878         {"src-port",    O_IP_SRCPORT},
 879         {"ipid",        O_IPID},
 880         {"iplen",       O_IPLEN},
 881         {"ipttl",       O_IPTTL},
 882         {"mac-type",    O_MAC_TYPE},
 883         {"tcpdatalen",  O_TCPDATALEN},
 884         {"tcpwin",      O_TCPWIN},
 885         {"tagged",      O_TAGGED},
 886         {NULL,          0}
 887 };
 888
 889 /*
 890  * Print the values in a list 16-bit items of the types above.
 891  * XXX todo: add support for mask.
 892  */
 893 static void
 894 print_newports(struct buf_pr *bp, ipfw_insn_u16 *cmd, int proto, int opcode)
 895 {
 896         uint16_t *p = cmd->ports;
 897         int i;
 898         char const *sep;
 899
 900         if (opcode != 0) {
 901                 sep = match_value(_port_name, opcode);
 902                 if (sep == NULL)
 903                         sep = "???";
 904                 bprintf(bp, " %s", sep);
 905         }
 906         sep = " ";
 907         for (i = F_LEN((ipfw_insn *)cmd) - 1; i > 0; i--, p += 2) {
 908                 bprintf(bp, "%s", sep);
 909                 print_port(bp, proto, p[0]);
 910                 if (p[0] != p[1]) {
 911                         bprintf(bp, "-");
 912                         print_port(bp, proto, p[1]);
 913                 }
 914                 sep = ",";
 915         }
 916 }
 917
 918 /*
 919  * Like strtol, but also translates service names into port numbers
 920  * for some protocols.
 921  * In particular:
 922  *      proto == -1 disables the protocol check;
 923  *      proto == IPPROTO_ETHERTYPE looks up an internal table
 924  *      proto == <some value in /etc/protocols> matches the values there.
 925  * Returns *end == s in case the parameter is not found.
 926  */
 927 static int
 928 strtoport(char *s, char **end, int base, int proto)
 929 {
 930         char *p, *buf;
 931         char *s1;
 932         int i;
 933
 934         *end = s;               /* default - not found */
 935         if (*s == '\0')
 936                 return 0;       /* not found */
 937
 938         if (isdigit(*s))
 939                 return strtol(s, end, base);
 940
 941         /*
 942          * find separator. '\\' escapes the next char.
 943          */
 944         for (s1 = s; *s1 && (isalnum(*s1) || *s1 == '\\' ||
 945             *s1 == '_' || *s1 == '.') ; s1++)
 946                 if (*s1 == '\\' && s1[1] != '\0')
 947                         s1++;
 948
 949         buf = safe_calloc(s1 - s + 1, 1);
 950
 951         /*
 952          * copy into a buffer skipping backslashes
 953          */
 954         for (p = s, i = 0; p != s1 ; p++)
 955                 if (*p != '\\')
 956                         buf[i++] = *p;
 957         buf[i++] = '\0';
 958
 959         if (proto == IPPROTO_ETHERTYPE) {
 960                 i = match_token(ether_types, buf);
 961                 free(buf);
 962                 if (i != -1) {  /* found */
 963                         *end = s1;
 964                         return i;
 965                 }
 966         } else {
 967                 struct protoent *pe = NULL;
 968                 struct servent *se;
 969
 970                 if (proto != 0)
 971                         pe = getprotobynumber(proto);
 972                 setservent(1);
 973                 se = getservbyname(buf, pe ? pe->p_name : NULL);
 974                 free(buf);
 975                 if (se != NULL) {
 976                         *end = s1;
 977                         return ntohs(se->s_port);
 978                 }
 979         }
 980         return 0;       /* not found */
 981 }
 982
 983 /*
 984  * Fill the body of the command with the list of port ranges.
 985  */
 986 static int
 987 fill_newports(ipfw_insn_u16 *cmd, char *av, int proto, int cblen)
 988 {
 989         uint16_t a, b, *p = cmd->ports;
 990         int i = 0;
 991         char *s = av;
 992
 993         while (*s) {
 994                 a = strtoport(av, &s, 0, proto);
 995                 if (s == av)                    /* empty or invalid argument */
 996                         return (0);
 997
 998                 CHECK_LENGTH(cblen, i + 2);
 999
1000                 switch (*s) {
1001                 case '-':                       /* a range */
1002                         av = s + 1;
1003                         b = strtoport(av, &s, 0, proto);
1004                         /* Reject expressions like '1-abc' or '1-2-3'. */
1005                         if (s == av || (*s != ',' && *s != '\0'))
1006                                 return (0);
1007                         p[0] = a;
1008                         p[1] = b;
1009                         break;
1010                 case ',':                       /* comma separated list */
1011                 case '\0':
1012                         p[0] = p[1] = a;
1013                         break;
1014                 default:
1015                         warnx("port list: invalid separator <%c> in <%s>",
1016                                 *s, av);
1017                         return (0);
1018                 }
1019
1020                 i++;
1021                 p += 2;
1022                 av = s + 1;
1023         }
1024         if (i > 0) {
1025                 if (i + 1 > F_LEN_MASK)
1026                         errx(EX_DATAERR, "too many ports/ranges\n");
1027                 cmd->o.len |= i + 1;    /* leave F_NOT and F_OR untouched */
1028         }
1029         return (i);
1030 }
1031
1032 /*
1033  * Fill the body of the command with the list of DiffServ codepoints.
1034  */
1035 static void
1036 fill_dscp(ipfw_insn *cmd, char *av, int cblen)
1037 {
1038         uint32_t *low, *high;
1039         char *s = av, *a;
1040         int code;
1041
1042         cmd->opcode = O_DSCP;
1043         cmd->len |= F_INSN_SIZE(ipfw_insn_u32) + 1;
1044
1045         CHECK_CMDLEN;
1046
1047         low = (uint32_t *)(cmd + 1);
1048         high = low + 1;
1049
1050         *low = 0;
1051         *high = 0;
1052
1053         while (s != NULL) {
1054                 a = strchr(s, ',');
1055
1056                 if (a != NULL)
1057                         *a++ = '\0';
1058
1059                 if (isalpha(*s)) {
1060                         if ((code = match_token(f_ipdscp, s)) == -1)
1061                                 errx(EX_DATAERR, "Unknown DSCP code");
1062                 } else {
1063                         code = strtoul(s, NULL, 10);
1064                         if (code < 0 || code > 63)
1065                                 errx(EX_DATAERR, "Invalid DSCP value");
1066                 }
1067
1068                 if (code >= 32)
1069                         *high |= 1 << (code - 32);
1070                 else
1071                         *low |= 1 << code;
1072
1073                 s = a;
1074         }
1075 }
1076
1077 static struct _s_x icmpcodes[] = {
1078       { "net",                  ICMP_UNREACH_NET },
1079       { "host",                 ICMP_UNREACH_HOST },
1080       { "protocol",             ICMP_UNREACH_PROTOCOL },
1081       { "port",                 ICMP_UNREACH_PORT },
1082       { "needfrag",             ICMP_UNREACH_NEEDFRAG },
1083       { "srcfail",              ICMP_UNREACH_SRCFAIL },
1084       { "net-unknown",          ICMP_UNREACH_NET_UNKNOWN },
1085       { "host-unknown",         ICMP_UNREACH_HOST_UNKNOWN },
1086       { "isolated",             ICMP_UNREACH_ISOLATED },
1087       { "net-prohib",           ICMP_UNREACH_NET_PROHIB },
1088       { "host-prohib",          ICMP_UNREACH_HOST_PROHIB },
1089       { "tosnet",               ICMP_UNREACH_TOSNET },
1090       { "toshost",              ICMP_UNREACH_TOSHOST },
1091       { "filter-prohib",        ICMP_UNREACH_FILTER_PROHIB },
1092       { "host-precedence",      ICMP_UNREACH_HOST_PRECEDENCE },
1093       { "precedence-cutoff",    ICMP_UNREACH_PRECEDENCE_CUTOFF },
1094       { NULL, 0 }
1095 };
1096
1097 static void
1098 fill_reject_code(u_short *codep, char *str)
1099 {
1100         int val;
1101         char *s;
1102
1103         val = strtoul(str, &s, 0);
1104         if (s == str || *s != '\0' || val >= 0x100)
1105                 val = match_token(icmpcodes, str);
1106         if (val < 0)
1107                 errx(EX_DATAERR, "unknown ICMP unreachable code ``%s''", str);
1108         *codep = val;
1109         return;
1110 }
1111
1112 static void
1113 print_reject_code(struct buf_pr *bp, uint16_t code)
1114 {
1115         char const *s;
1116
1117         if ((s = match_value(icmpcodes, code)) != NULL)
1118                 bprintf(bp, "unreach %s", s);
1119         else
1120                 bprintf(bp, "unreach %u", code);
1121 }
1122
1123 /*
1124  * Returns the number of bits set (from left) in a contiguous bitmask,
1125  * or -1 if the mask is not contiguous.
1126  * XXX this needs a proper fix.
1127  * This effectively works on masks in big-endian (network) format.
1128  * when compiled on little endian architectures.
1129  *
1130  * First bit is bit 7 of the first byte -- note, for MAC addresses,
1131  * the first bit on the wire is bit 0 of the first byte.
1132  * len is the max length in bits.
1133  */
1134 int
1135 contigmask(uint8_t *p, int len)
1136 {
1137         int i, n;
1138
1139         for (i=0; i<len ; i++)
1140                 if ( (p[i/8] & (1 << (7 - (i%8)))) == 0) /* first bit unset */
1141                         break;
1142         for (n=i+1; n < len; n++)
1143                 if ( (p[n/8] & (1 << (7 - (n%8)))) != 0)
1144                         return -1; /* mask not contiguous */
1145         return i;
1146 }
1147
1148 /*
1149  * print flags set/clear in the two bitmasks passed as parameters.
1150  * There is a specialized check for f_tcpflags.
1151  */
1152 static void
1153 print_flags(struct buf_pr *bp, char const *name, ipfw_insn *cmd,
1154     struct _s_x *list)
1155 {
1156         char const *comma = "";
1157         int i;
1158         uint8_t set = cmd->arg1 & 0xff;
1159         uint8_t clear = (cmd->arg1 >> 8) & 0xff;
1160
1161         if (list == f_tcpflags && set == TH_SYN && clear == TH_ACK) {
1162                 bprintf(bp, " setup");
1163                 return;
1164         }
1165
1166         bprintf(bp, " %s ", name);
1167         for (i=0; list[i].x != 0; i++) {
1168                 if (set & list[i].x) {
1169                         set &= ~list[i].x;
1170                         bprintf(bp, "%s%s", comma, list[i].s);
1171                         comma = ",";
1172                 }
1173                 if (clear & list[i].x) {
1174                         clear &= ~list[i].x;
1175                         bprintf(bp, "%s!%s", comma, list[i].s);
1176                         comma = ",";
1177                 }
1178         }
1179 }
1180
1181
1182 /*
1183  * Print the ip address contained in a command.
1184  */
1185 static void
1186 print_ip(struct buf_pr *bp, const struct format_opts *fo, ipfw_insn_ip *cmd)
1187 {
1188         struct hostent *he = NULL;
1189         struct in_addr *ia;
1190         uint32_t len = F_LEN((ipfw_insn *)cmd);
1191         uint32_t *a = ((ipfw_insn_u32 *)cmd)->d;
1192         char *t;
1193
1194         bprintf(bp, " ");
1195         if (cmd->o.opcode == O_IP_DST_LOOKUP && len > F_INSN_SIZE(ipfw_insn_u32)) {
1196                 uint32_t d = a[1];
1197                 const char *arg = "<invalid>";
1198
1199                 if (d < sizeof(lookup_key)/sizeof(lookup_key[0]))
1200                         arg = match_value(rule_options, lookup_key[d]);
1201                 t = table_search_ctlv(fo->tstate, ((ipfw_insn *)cmd)->arg1);
1202                 bprintf(bp, "lookup %s %s", arg, t);
1203                 return;
1204         }
1205         if (cmd->o.opcode == O_IP_SRC_ME || cmd->o.opcode == O_IP_DST_ME) {
1206                 bprintf(bp, "me");
1207                 return;
1208         }
1209         if (cmd->o.opcode == O_IP_SRC_LOOKUP ||
1210             cmd->o.opcode == O_IP_DST_LOOKUP) {
1211                 t = table_search_ctlv(fo->tstate, ((ipfw_insn *)cmd)->arg1);
1212                 bprintf(bp, "table(%s", t);
1213                 if (len == F_INSN_SIZE(ipfw_insn_u32))
1214                         bprintf(bp, ",%u", *a);
1215                 bprintf(bp, ")");
1216                 return;
1217         }
1218         if (cmd->o.opcode == O_IP_SRC_SET || cmd->o.opcode == O_IP_DST_SET) {
1219                 uint32_t x, *map = (uint32_t *)&(cmd->mask);
1220                 int i, j;
1221                 char comma = '{';
1222
1223                 x = cmd->o.arg1 - 1;
1224                 x = htonl( ~x );
1225                 cmd->addr.s_addr = htonl(cmd->addr.s_addr);
1226                 bprintf(bp, "%s/%d", inet_ntoa(cmd->addr),
1227                         contigmask((uint8_t *)&x, 32));
1228                 x = cmd->addr.s_addr = htonl(cmd->addr.s_addr);
1229                 x &= 0xff; /* base */
1230                 /*
1231                  * Print bits and ranges.
1232                  * Locate first bit set (i), then locate first bit unset (j).
1233                  * If we have 3+ consecutive bits set, then print them as a
1234                  * range, otherwise only print the initial bit and rescan.
1235                  */
1236                 for (i=0; i < cmd->o.arg1; i++)
1237                         if (map[i/32] & (1<<(i & 31))) {
1238                                 for (j=i+1; j < cmd->o.arg1; j++)
1239                                         if (!(map[ j/32] & (1<<(j & 31))))
1240                                                 break;
1241                                 bprintf(bp, "%c%d", comma, i+x);
1242                                 if (j>i+2) { /* range has at least 3 elements */
1243                                         bprintf(bp, "-%d", j-1+x);
1244                                         i = j-1;
1245                                 }
1246                                 comma = ',';
1247                         }
1248                 bprintf(bp, "}");
1249                 return;
1250         }
1251         /*
1252          * len == 2 indicates a single IP, whereas lists of 1 or more
1253          * addr/mask pairs have len = (2n+1). We convert len to n so we
1254          * use that to count the number of entries.
1255          */
1256     for (len = len / 2; len > 0; len--, a += 2) {
1257         int mb =        /* mask length */
1258             (cmd->o.opcode == O_IP_SRC || cmd->o.opcode == O_IP_DST) ?
1259                 32 : contigmask((uint8_t *)&(a[1]), 32);
1260         if (mb == 32 && co.do_resolv)
1261                 he = gethostbyaddr((char *)&(a[0]), sizeof(in_addr_t),
1262                     AF_INET);
1263         if (he != NULL)         /* resolved to name */
1264                 bprintf(bp, "%s", he->h_name);
1265         else if (mb == 0)       /* any */
1266                 bprintf(bp, "any");
1267         else {          /* numeric IP followed by some kind of mask */
1268                 ia = (struct in_addr *)&a[0];
1269                 bprintf(bp, "%s", inet_ntoa(*ia));
1270                 if (mb < 0) {
1271                         ia = (struct in_addr *)&a[1];
1272                         bprintf(bp, ":%s", inet_ntoa(*ia));
1273                 } else if (mb < 32)
1274                         bprintf(bp, "/%d", mb);
1275         }
1276         if (len > 1)
1277                 bprintf(bp, ",");
1278     }
1279 }
1280
1281 /*
1282  * prints a MAC address/mask pair
1283  */
1284 static void
1285 format_mac(struct buf_pr *bp, uint8_t *addr, uint8_t *mask)
1286 {
1287         int l = contigmask(mask, 48);
1288
1289         if (l == 0)
1290                 bprintf(bp, " any");
1291         else {
1292                 bprintf(bp, " %02x:%02x:%02x:%02x:%02x:%02x",
1293                     addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]);
1294                 if (l == -1)
1295                         bprintf(bp, "&%02x:%02x:%02x:%02x:%02x:%02x",
1296                             mask[0], mask[1], mask[2],
1297                             mask[3], mask[4], mask[5]);
1298                 else if (l < 48)
1299                         bprintf(bp, "/%d", l);
1300         }
1301 }
1302
1303 static void
1304 print_mac(struct buf_pr *bp, ipfw_insn_mac *mac)
1305 {
1306
1307         bprintf(bp, " MAC");
1308         format_mac(bp, mac->addr, mac->mask);
1309         format_mac(bp, mac->addr + 6, mac->mask + 6);
1310 }
1311
1312 static void
1313 fill_icmptypes(ipfw_insn_u32 *cmd, char *av)
1314 {
1315         uint8_t type;
1316
1317         cmd->d[0] = 0;
1318         while (*av) {
1319                 if (*av == ',')
1320                         av++;
1321
1322                 type = strtoul(av, &av, 0);
1323
1324                 if (*av != ',' && *av != '\0')
1325                         errx(EX_DATAERR, "invalid ICMP type");
1326
1327                 if (type > 31)
1328                         errx(EX_DATAERR, "ICMP type out of range");
1329
1330                 cmd->d[0] |= 1 << type;
1331         }
1332         cmd->o.opcode = O_ICMPTYPE;
1333         cmd->o.len |= F_INSN_SIZE(ipfw_insn_u32);
1334 }
1335
1336 static void
1337 print_icmptypes(struct buf_pr *bp, ipfw_insn_u32 *cmd)
1338 {
1339         int i;
1340         char sep= ' ';
1341
1342         bprintf(bp, " icmptypes");
1343         for (i = 0; i < 32; i++) {
1344                 if ( (cmd->d[0] & (1 << (i))) == 0)
1345                         continue;
1346                 bprintf(bp, "%c%d", sep, i);
1347                 sep = ',';
1348         }
1349 }
1350
1351 static void
1352 print_dscp(struct buf_pr *bp, ipfw_insn_u32 *cmd)
1353 {
1354         int i = 0;
1355         uint32_t *v;
1356         char sep= ' ';
1357         const char *code;
1358
1359         bprintf(bp, " dscp");
1360         v = cmd->d;
1361         while (i < 64) {
1362                 if (*v & (1 << i)) {
1363                         if ((code = match_value(f_ipdscp, i)) != NULL)
1364                                 bprintf(bp, "%c%s", sep, code);
1365                         else
1366                                 bprintf(bp, "%c%d", sep, i);
1367                         sep = ',';
1368                 }
1369
1370                 if ((++i % 32) == 0)
1371                         v++;
1372         }
1373 }
1374
1375 #define insntod(cmd, type)      ((ipfw_insn_ ## type *)(cmd))
1376 struct show_state {
1377         struct ip_fw_rule       *rule;
1378         const ipfw_insn         *eaction;
1379         uint8_t                 *printed;
1380         int                     flags;
1381 #define HAVE_PROTO              0x0001
1382 #define HAVE_SRCIP              0x0002
1383 #define HAVE_DSTIP              0x0004
1384 #define HAVE_PROBE_STATE        0x0008
1385         int                     proto;
1386         int                     or_block;
1387 };
1388
1389 static int
1390 init_show_state(struct show_state *state, struct ip_fw_rule *rule)
1391 {
1392
1393         state->printed = calloc(rule->cmd_len, sizeof(uint8_t));
1394         if (state->printed == NULL)
1395                 return (ENOMEM);
1396         state->rule = rule;
1397         state->eaction = NULL;
1398         state->flags = 0;
1399         state->proto = 0;
1400         state->or_block = 0;
1401         return (0);
1402 }
1403
1404 static void
1405 free_show_state(struct show_state *state)
1406 {
1407
1408         free(state->printed);
1409 }
1410
1411 static uint8_t
1412 is_printed_opcode(struct show_state *state, const ipfw_insn *cmd)
1413 {
1414
1415         return (state->printed[cmd - state->rule->cmd]);
1416 }
1417
1418 static void
1419 mark_printed(struct show_state *state, const ipfw_insn *cmd)
1420 {
1421
1422         state->printed[cmd - state->rule->cmd] = 1;
1423 }
1424
1425 static void
1426 print_limit_mask(struct buf_pr *bp, const ipfw_insn_limit *limit)
1427 {
1428         struct _s_x *p = limit_masks;
1429         char const *comma = " ";
1430         uint8_t x;
1431
1432         for (x = limit->limit_mask; p->x != 0; p++) {
1433                 if ((x & p->x) == p->x) {
1434                         x &= ~p->x;
1435                         bprintf(bp, "%s%s", comma, p->s);
1436                         comma = ",";
1437                 }
1438         }
1439         bprint_uint_arg(bp, " ", limit->conn_limit);
1440 }
1441
1442 static int
1443 print_instruction(struct buf_pr *bp, const struct format_opts *fo,
1444     struct show_state *state, ipfw_insn *cmd)
1445 {
1446         struct protoent *pe;
1447         struct passwd *pwd;
1448         struct group *grp;
1449         const char *s;
1450         double d;
1451
1452         if (is_printed_opcode(state, cmd))
1453                 return (0);
1454         if ((cmd->len & F_OR) != 0 && state->or_block == 0)
1455                 bprintf(bp, " {");
1456         if (cmd->opcode != O_IN && (cmd->len & F_NOT) != 0)
1457                 bprintf(bp, " not");
1458
1459         switch (cmd->opcode) {
1460         case O_PROB:
1461                 d = 1.0 * insntod(cmd, u32)->d[0] / 0x7fffffff;
1462                 bprintf(bp, "prob %f ", d);
1463                 break;
1464         case O_PROBE_STATE: /* no need to print anything here */
1465                 state->flags |= HAVE_PROBE_STATE;
1466                 break;
1467         case O_IP_SRC:
1468         case O_IP_SRC_LOOKUP:
1469         case O_IP_SRC_MASK:
1470         case O_IP_SRC_ME:
1471         case O_IP_SRC_SET:
1472                 if (state->flags & HAVE_SRCIP)
1473                         bprintf(bp, " src-ip");
1474                 print_ip(bp, fo, insntod(cmd, ip));
1475                 break;
1476         case O_IP_DST:
1477         case O_IP_DST_LOOKUP:
1478         case O_IP_DST_MASK:
1479         case O_IP_DST_ME:
1480         case O_IP_DST_SET:
1481                 if (state->flags & HAVE_DSTIP)
1482                         bprintf(bp, " dst-ip");
1483                 print_ip(bp, fo, insntod(cmd, ip));
1484                 break;
1485         case O_IP6_SRC:
1486         case O_IP6_SRC_MASK:
1487         case O_IP6_SRC_ME:
1488                 if (state->flags & HAVE_SRCIP)
1489                         bprintf(bp, " src-ip6");
1490                 print_ip6(bp, insntod(cmd, ip6));
1491                 break;
1492         case O_IP6_DST:
1493         case O_IP6_DST_MASK:
1494         case O_IP6_DST_ME:
1495                 if (state->flags & HAVE_DSTIP)
1496                         bprintf(bp, " dst-ip6");
1497                 print_ip6(bp, insntod(cmd, ip6));
1498                 break;
1499         case O_FLOW6ID:
1500                 print_flow6id(bp, insntod(cmd, u32));
1501                 break;
1502         case O_IP_DSTPORT:
1503         case O_IP_SRCPORT:
1504                 print_newports(bp, insntod(cmd, u16), state->proto,
1505                     (state->flags & (HAVE_SRCIP | HAVE_DSTIP)) ==
1506                     (HAVE_SRCIP | HAVE_DSTIP) ?  cmd->opcode: 0);
1507                 break;
1508         case O_PROTO:
1509                 pe = getprotobynumber(cmd->arg1);
1510                 if (state->flags & HAVE_PROTO)
1511                         bprintf(bp, " proto");
1512                 if (pe != NULL)
1513                         bprintf(bp, " %s", pe->p_name);
1514                 else
1515                         bprintf(bp, " %u", cmd->arg1);
1516                 state->proto = cmd->arg1;
1517                 break;
1518         case O_MACADDR2:
1519                 print_mac(bp, insntod(cmd, mac));
1520                 break;
1521         case O_MAC_TYPE:
1522                 print_newports(bp, insntod(cmd, u16),
1523                     IPPROTO_ETHERTYPE, cmd->opcode);
1524                 break;
1525         case O_FRAG:
1526                 bprintf(bp, " frag");
1527                 break;
1528         case O_FIB:
1529                 bprintf(bp, " fib %u", cmd->arg1);
1530                 break;
1531         case O_SOCKARG:
1532                 bprintf(bp, " sockarg");
1533                 break;
1534         case O_IN:
1535                 bprintf(bp, cmd->len & F_NOT ? " out" : " in");
1536                 break;
1537         case O_DIVERTED:
1538                 switch (cmd->arg1) {
1539                 case 3:
1540                         bprintf(bp, " diverted");
1541                         break;
1542                 case 2:
1543                         bprintf(bp, " diverted-output");
1544                         break;
1545                 case 1:
1546                         bprintf(bp, " diverted-loopback");
1547                         break;
1548                 default:
1549                         bprintf(bp, " diverted-?<%u>", cmd->arg1);
1550                         break;
1551                 }
1552                 break;
1553         case O_LAYER2:
1554                 bprintf(bp, " layer2");
1555                 break;
1556         case O_XMIT:
1557         case O_RECV:
1558         case O_VIA:
1559                 if (cmd->opcode == O_XMIT)
1560                         s = "xmit";
1561                 else if (cmd->opcode == O_RECV)
1562                         s = "recv";
1563                 else /* if (cmd->opcode == O_VIA) */
1564                         s = "via";
1565                 switch (insntod(cmd, if)->name[0]) {
1566                 case '\0':
1567                         bprintf(bp, " %s %s", s,
1568                             inet_ntoa(insntod(cmd, if)->p.ip));
1569                         break;
1570                 case '\1':
1571                         bprintf(bp, " %s table(%s)", s,
1572                             table_search_ctlv(fo->tstate,
1573                             insntod(cmd, if)->p.kidx));
1574                         break;
1575                 default:
1576                         bprintf(bp, " %s %s", s,
1577                             insntod(cmd, if)->name);
1578                 }
1579                 break;
1580         case O_IP_FLOW_LOOKUP:
1581                 s = table_search_ctlv(fo->tstate, cmd->arg1);
1582                 bprintf(bp, " flow table(%s", s);
1583                 if (F_LEN(cmd) == F_INSN_SIZE(ipfw_insn_u32))
1584                         bprintf(bp, ",%u", insntod(cmd, u32)->d[0]);
1585                 bprintf(bp, ")");
1586                 break;
1587         case O_IPID:
1588         case O_IPTTL:
1589         case O_IPLEN:
1590         case O_TCPDATALEN:
1591         case O_TCPWIN:
1592                 if (F_LEN(cmd) == 1) {
1593                         switch (cmd->opcode) {
1594                         case O_IPID:
1595                                 s = "ipid";
1596                                 break;
1597                         case O_IPTTL:
1598                                 s = "ipttl";
1599                                 break;
1600                         case O_IPLEN:
1601                                 s = "iplen";
1602                                 break;
1603                         case O_TCPDATALEN:
1604                                 s = "tcpdatalen";
1605                                 break;
1606                         case O_TCPWIN:
1607                                 s = "tcpwin";
1608                                 break;
1609                         }
1610                         bprintf(bp, " %s %u", s, cmd->arg1);
1611                 } else
1612                         print_newports(bp, insntod(cmd, u16), 0,
1613                             cmd->opcode);
1614                 break;
1615         case O_IPVER:
1616                 bprintf(bp, " ipver %u", cmd->arg1);
1617                 break;
1618         case O_IPPRECEDENCE:
1619                 bprintf(bp, " ipprecedence %u", cmd->arg1 >> 5);
1620                 break;
1621         case O_DSCP:
1622                 print_dscp(bp, insntod(cmd, u32));
1623                 break;
1624         case O_IPOPT:
1625                 print_flags(bp, "ipoptions", cmd, f_ipopts);
1626                 break;
1627         case O_IPTOS:
1628                 print_flags(bp, "iptos", cmd, f_iptos);
1629                 break;
1630         case O_ICMPTYPE:
1631                 print_icmptypes(bp, insntod(cmd, u32));
1632                 break;
1633         case O_ESTAB:
1634                 bprintf(bp, " established");
1635                 break;
1636         case O_TCPFLAGS:
1637                 print_flags(bp, "tcpflags", cmd, f_tcpflags);
1638                 break;
1639         case O_TCPOPTS:
1640                 print_flags(bp, "tcpoptions", cmd, f_tcpopts);
1641                 break;
1642         case O_TCPACK:
1643                 bprintf(bp, " tcpack %d",
1644                     ntohl(insntod(cmd, u32)->d[0]));
1645                 break;
1646         case O_TCPSEQ:
1647                 bprintf(bp, " tcpseq %d",
1648                     ntohl(insntod(cmd, u32)->d[0]));
1649                 break;
1650         case O_UID:
1651                 pwd = getpwuid(insntod(cmd, u32)->d[0]);
1652                 if (pwd != NULL)
1653                         bprintf(bp, " uid %s", pwd->pw_name);
1654                 else
1655                         bprintf(bp, " uid %u",
1656                             insntod(cmd, u32)->d[0]);
1657                 break;
1658         case O_GID:
1659                 grp = getgrgid(insntod(cmd, u32)->d[0]);
1660                 if (grp != NULL)
1661                         bprintf(bp, " gid %s", grp->gr_name);
1662                 else
1663                         bprintf(bp, " gid %u",
1664                             insntod(cmd, u32)->d[0]);
1665                 break;
1666         case O_JAIL:
1667                 bprintf(bp, " jail %d", insntod(cmd, u32)->d[0]);
1668                 break;
1669         case O_VERREVPATH:
1670                 bprintf(bp, " verrevpath");
1671                 break;
1672         case O_VERSRCREACH:
1673                 bprintf(bp, " versrcreach");
1674                 break;
1675         case O_ANTISPOOF:
1676                 bprintf(bp, " antispoof");
1677                 break;
1678         case O_IPSEC:
1679                 bprintf(bp, " ipsec");
1680                 break;
1681         case O_NOP:
1682                 bprintf(bp, " // %s", (char *)(cmd + 1));
1683                 break;
1684         case O_KEEP_STATE:
1685                 if (state->flags & HAVE_PROBE_STATE)
1686                         bprintf(bp, " keep-state");
1687                 else
1688                         bprintf(bp, " record-state");
1689                 bprintf(bp, " :%s",
1690                     object_search_ctlv(fo->tstate, cmd->arg1,
1691                     IPFW_TLV_STATE_NAME));
1692                 break;
1693         case O_LIMIT:
1694                 if (state->flags & HAVE_PROBE_STATE)
1695                         bprintf(bp, " limit");
1696                 else
1697                         bprintf(bp, " set-limit");
1698                 print_limit_mask(bp, insntod(cmd, limit));
1699                 bprintf(bp, " :%s",
1700                     object_search_ctlv(fo->tstate, cmd->arg1,
1701                     IPFW_TLV_STATE_NAME));
1702                 break;
1703         case O_IP6:
1704                 if (state->flags & HAVE_PROTO)
1705                         bprintf(bp, " proto");
1706                 bprintf(bp, " ip6");
1707                 break;
1708         case O_IP4:
1709                 if (state->flags & HAVE_PROTO)
1710                         bprintf(bp, " proto");
1711                 bprintf(bp, " ip4");
1712                 break;
1713         case O_ICMP6TYPE:
1714                 print_icmp6types(bp, insntod(cmd, u32));
1715                 break;
1716         case O_EXT_HDR:
1717                 print_ext6hdr(bp, cmd);
1718                 break;
1719         case O_TAGGED:
1720                 if (F_LEN(cmd) == 1)
1721                         bprint_uint_arg(bp, " tagged ", cmd->arg1);
1722                 else
1723                         print_newports(bp, insntod(cmd, u16),
1724                                     0, O_TAGGED);
1725                 break;
1726         case O_SKIP_ACTION:
1727                 bprintf(bp, " defer-immediate-action");
1728                 break;
1729         default:
1730                 bprintf(bp, " [opcode %d len %d]", cmd->opcode,
1731                     cmd->len);
1732         }
1733         if (cmd->len & F_OR) {
1734                 bprintf(bp, " or");
1735                 state->or_block = 1;
1736         } else if (state->or_block != 0) {
1737                 bprintf(bp, " }");
1738                 state->or_block = 0;
1739         }
1740         mark_printed(state, cmd);
1741
1742         return (1);
1743 }
1744
1745 static ipfw_insn *
1746 print_opcode(struct buf_pr *bp, struct format_opts *fo,
1747     struct show_state *state, int opcode)
1748 {
1749         ipfw_insn *cmd;
1750         int l;
1751
1752         for (l = state->rule->act_ofs, cmd = state->rule->cmd;
1753             l > 0; l -= F_LEN(cmd), cmd += F_LEN(cmd)) {
1754                 /* We use zero opcode to print the rest of options */
1755                 if (opcode >= 0 && cmd->opcode != opcode)
1756                         continue;
1757                 /*
1758                  * Skip O_NOP, when we printing the rest
1759                  * of options, it will be handled separately.
1760                  */
1761                 if (cmd->opcode == O_NOP && opcode != O_NOP)
1762                         continue;
1763                 if (!print_instruction(bp, fo, state, cmd))
1764                         continue;
1765                 return (cmd);
1766         }
1767         return (NULL);
1768 }
1769
1770 static void
1771 print_fwd(struct buf_pr *bp, const ipfw_insn *cmd)
1772 {
1773         char buf[INET6_ADDRSTRLEN + IF_NAMESIZE + 2];
1774         ipfw_insn_sa6 *sa6;
1775         ipfw_insn_sa *sa;
1776         uint16_t port;
1777
1778         if (cmd->opcode == O_FORWARD_IP) {
1779                 sa = insntod(cmd, sa);
1780                 port = sa->sa.sin_port;
1781                 if (sa->sa.sin_addr.s_addr == INADDR_ANY)
1782                         bprintf(bp, "fwd tablearg");
1783                 else
1784                         bprintf(bp, "fwd %s", inet_ntoa(sa->sa.sin_addr));
1785         } else {
1786                 sa6 = insntod(cmd, sa6);
1787                 port = sa6->sa.sin6_port;
1788                 bprintf(bp, "fwd ");
1789                 if (getnameinfo((const struct sockaddr *)&sa6->sa,
1790                     sizeof(struct sockaddr_in6), buf, sizeof(buf), NULL, 0,
1791                     NI_NUMERICHOST) == 0)
1792                         bprintf(bp, "%s", buf);
1793         }
1794         if (port != 0)
1795                 bprintf(bp, ",%u", port);
1796 }
1797
1798 static int
1799 print_action_instruction(struct buf_pr *bp, const struct format_opts *fo,
1800     struct show_state *state, const ipfw_insn *cmd)
1801 {
1802         const char *s;
1803
1804         if (is_printed_opcode(state, cmd))
1805                 return (0);
1806         switch (cmd->opcode) {
1807         case O_CHECK_STATE:
1808                 bprintf(bp, "check-state");
1809                 if (cmd->arg1 != 0)
1810                         s = object_search_ctlv(fo->tstate, cmd->arg1,
1811                             IPFW_TLV_STATE_NAME);
1812                 else
1813                         s = NULL;
1814                 bprintf(bp, " :%s", s ? s: "any");
1815                 break;
1816         case O_ACCEPT:
1817                 bprintf(bp, "allow");
1818                 break;
1819         case O_COUNT:
1820                 bprintf(bp, "count");
1821                 break;
1822         case O_DENY:
1823                 bprintf(bp, "deny");
1824                 break;
1825         case O_REJECT:
1826                 if (cmd->arg1 == ICMP_REJECT_RST)
1827                         bprintf(bp, "reset");
1828                 else if (cmd->arg1 == ICMP_REJECT_ABORT)
1829                         bprintf(bp, "abort");
1830                 else if (cmd->arg1 == ICMP_UNREACH_HOST)
1831                         bprintf(bp, "reject");
1832                 else
1833                         print_reject_code(bp, cmd->arg1);
1834                 break;
1835         case O_UNREACH6:
1836                 if (cmd->arg1 == ICMP6_UNREACH_RST)
1837                         bprintf(bp, "reset6");
1838                 else if (cmd->arg1 == ICMP6_UNREACH_ABORT)
1839                         bprintf(bp, "abort6");
1840                 else
1841                         print_unreach6_code(bp, cmd->arg1);
1842                 break;
1843         case O_SKIPTO:
1844                 bprint_uint_arg(bp, "skipto ", cmd->arg1);
1845                 break;
1846         case O_PIPE:
1847                 bprint_uint_arg(bp, "pipe ", cmd->arg1);
1848                 break;
1849         case O_QUEUE:
1850                 bprint_uint_arg(bp, "queue ", cmd->arg1);
1851                 break;
1852         case O_DIVERT:
1853                 bprint_uint_arg(bp, "divert ", cmd->arg1);
1854                 break;
1855         case O_TEE:
1856                 bprint_uint_arg(bp, "tee ", cmd->arg1);
1857                 break;
1858         case O_NETGRAPH:
1859                 bprint_uint_arg(bp, "netgraph ", cmd->arg1);
1860                 break;
1861         case O_NGTEE:
1862                 bprint_uint_arg(bp, "ngtee ", cmd->arg1);
1863                 break;
1864         case O_FORWARD_IP:
1865         case O_FORWARD_IP6:
1866                 print_fwd(bp, cmd);
1867                 break;
1868         case O_LOG:
1869                 if (insntod(cmd, log)->max_log > 0)
1870                         bprintf(bp, " log logamount %d",
1871                             insntod(cmd, log)->max_log);
1872                 else
1873                         bprintf(bp, " log");
1874                 break;
1875         case O_ALTQ:
1876 #ifndef NO_ALTQ
1877                 print_altq_cmd(bp, insntod(cmd, altq));
1878 #endif
1879                 break;
1880         case O_TAG:
1881                 bprint_uint_arg(bp, cmd->len & F_NOT ? " untag ":
1882                     " tag ", cmd->arg1);
1883                 break;
1884         case O_NAT:
1885                 if (cmd->arg1 != IP_FW_NAT44_GLOBAL)
1886                         bprint_uint_arg(bp, "nat ", cmd->arg1);
1887                 else
1888                         bprintf(bp, "nat global");
1889                 break;
1890         case O_SETFIB:
1891                 if (cmd->arg1 == IP_FW_TARG)
1892                         bprint_uint_arg(bp, "setfib ", cmd->arg1);
1893                 else
1894                         bprintf(bp, "setfib %u", cmd->arg1 & 0x7FFF);
1895                 break;
1896         case O_EXTERNAL_ACTION:
1897                 /*
1898                  * The external action can consists of two following
1899                  * each other opcodes - O_EXTERNAL_ACTION and
1900                  * O_EXTERNAL_INSTANCE. The first contains the ID of
1901                  * name of external action. The second contains the ID
1902                  * of name of external action instance.
1903                  * NOTE: in case when external action has no named
1904                  * instances support, the second opcode isn't needed.
1905                  */
1906                 state->eaction = cmd;
1907                 s = object_search_ctlv(fo->tstate, cmd->arg1,
1908                     IPFW_TLV_EACTION);
1909                 if (match_token(rule_eactions, s) != -1)
1910                         bprintf(bp, "%s", s);
1911                 else
1912                         bprintf(bp, "eaction %s", s);
1913                 break;
1914         case O_EXTERNAL_INSTANCE:
1915                 if (state->eaction == NULL)
1916                         break;
1917                 /*
1918                  * XXX: we need to teach ipfw(9) to rewrite opcodes
1919                  * in the user buffer on rule addition. When we add
1920                  * the rule, we specify zero TLV type for
1921                  * O_EXTERNAL_INSTANCE object. To show correct
1922                  * rule after `ipfw add` we need to search instance
1923                  * name with zero type. But when we do `ipfw show`
1924                  * we calculate TLV type using IPFW_TLV_EACTION_NAME()
1925                  * macro.
1926                  */
1927                 s = object_search_ctlv(fo->tstate, cmd->arg1, 0);
1928                 if (s == NULL)
1929                         s = object_search_ctlv(fo->tstate,
1930                             cmd->arg1, IPFW_TLV_EACTION_NAME(
1931                             state->eaction->arg1));
1932                 bprintf(bp, " %s", s);
1933                 break;
1934         case O_EXTERNAL_DATA:
1935                 if (state->eaction == NULL)
1936                         break;
1937                 /*
1938                  * Currently we support data formatting only for
1939                  * external data with datalen u16. For unknown data
1940                  * print its size in bytes.
1941                  */
1942                 if (cmd->len == F_INSN_SIZE(ipfw_insn))
1943                         bprintf(bp, " %u", cmd->arg1);
1944                 else
1945                         bprintf(bp, " %ubytes",
1946                             cmd->len * sizeof(uint32_t));
1947                 break;
1948         case O_SETDSCP:
1949                 if (cmd->arg1 == IP_FW_TARG) {
1950                         bprintf(bp, "setdscp tablearg");
1951                         break;
1952                 }
1953                 s = match_value(f_ipdscp, cmd->arg1 & 0x3F);
1954                 if (s != NULL)
1955                         bprintf(bp, "setdscp %s", s);
1956                 else
1957                         bprintf(bp, "setdscp %u", cmd->arg1 & 0x3F);
1958                 break;
1959         case O_REASS:
1960                 bprintf(bp, "reass");
1961                 break;
1962         case O_CALLRETURN:
1963                 if (cmd->len & F_NOT)
1964                         bprintf(bp, "return");
1965                 else
1966                         bprint_uint_arg(bp, "call ", cmd->arg1);
1967                 break;
1968         default:
1969                 bprintf(bp, "** unrecognized action %d len %d ",
1970                         cmd->opcode, cmd->len);
1971         }
1972         mark_printed(state, cmd);
1973
1974         return (1);
1975 }
1976
1977
1978 static ipfw_insn *
1979 print_action(struct buf_pr *bp, struct format_opts *fo,
1980     struct show_state *state, uint8_t opcode)
1981 {
1982         ipfw_insn *cmd;
1983         int l;
1984
1985         for (l = state->rule->cmd_len - state->rule->act_ofs,
1986             cmd = ACTION_PTR(state->rule); l > 0;
1987             l -= F_LEN(cmd), cmd += F_LEN(cmd)) {
1988                 if (cmd->opcode != opcode)
1989                         continue;
1990                 if (!print_action_instruction(bp, fo, state, cmd))
1991                         continue;
1992                 return (cmd);
1993         }
1994         return (NULL);
1995 }
1996
1997 static void
1998 print_proto(struct buf_pr *bp, struct format_opts *fo,
1999     struct show_state *state)
2000 {
2001         ipfw_insn *cmd;
2002         int l, proto, ip4, ip6;
2003
2004         /* Count all O_PROTO, O_IP4, O_IP6 instructions. */
2005         proto = ip4 = ip6 = 0;
2006         for (l = state->rule->act_ofs, cmd = state->rule->cmd;
2007             l > 0; l -= F_LEN(cmd), cmd += F_LEN(cmd)) {
2008                 switch (cmd->opcode) {
2009                 case O_PROTO:
2010                         proto++;
2011                         break;
2012                 case O_IP4:
2013                         ip4 = 1;
2014                         if (cmd->len & F_OR)
2015                                 ip4++;
2016                         break;
2017                 case O_IP6:
2018                         ip6 = 1;
2019                         if (cmd->len & F_OR)
2020                                 ip6++;
2021                         break;
2022                 default:
2023                         continue;
2024                 }
2025         }
2026         if (proto == 0 && ip4 == 0 && ip6 == 0) {
2027                 state->proto = IPPROTO_IP;
2028                 state->flags |= HAVE_PROTO;
2029                 bprintf(bp, " ip");
2030                 return;
2031         }
2032         /* To handle the case { ip4 or ip6 }, print opcode with F_OR first */
2033         cmd = NULL;
2034         if (ip4 || ip6)
2035                 cmd = print_opcode(bp, fo, state, ip4 > ip6 ? O_IP4: O_IP6);
2036         if (cmd != NULL && (cmd->len & F_OR))
2037                 cmd = print_opcode(bp, fo, state, ip4 > ip6 ? O_IP6: O_IP4);
2038         if (cmd == NULL || (cmd->len & F_OR))
2039                 for (l = proto; l > 0; l--) {
2040                         cmd = print_opcode(bp, fo, state, O_PROTO);
2041                         if (cmd == NULL || (cmd->len & F_OR) == 0)
2042                                 break;
2043                 }
2044         /* Initialize proto, it is used by print_newports() */
2045         state->flags |= HAVE_PROTO;
2046         if (state->proto == 0 && ip6 != 0)
2047                 state->proto = IPPROTO_IPV6;
2048 }
2049
2050 static int
2051 match_opcode(int opcode, const int opcodes[], size_t nops)
2052 {
2053         int i;
2054
2055         for (i = 0; i < nops; i++)
2056                 if (opcode == opcodes[i])
2057                         return (1);
2058         return (0);
2059 }
2060
2061 static void
2062 print_address(struct buf_pr *bp, struct format_opts *fo,
2063     struct show_state *state, const int opcodes[], size_t nops, int portop,
2064     int flag)
2065 {
2066         ipfw_insn *cmd;
2067         int count, l, portcnt, pf;
2068
2069         count = portcnt = 0;
2070         for (l = state->rule->act_ofs, cmd = state->rule->cmd;
2071             l > 0; l -= F_LEN(cmd), cmd += F_LEN(cmd)) {
2072                 if (match_opcode(cmd->opcode, opcodes, nops))
2073                         count++;
2074                 else if (cmd->opcode == portop)
2075                         portcnt++;
2076         }
2077         if (count == 0)
2078                 bprintf(bp, " any");
2079         for (l = state->rule->act_ofs, cmd = state->rule->cmd;
2080             l > 0 && count > 0; l -= F_LEN(cmd), cmd += F_LEN(cmd)) {
2081                 if (!match_opcode(cmd->opcode, opcodes, nops))
2082                         continue;
2083                 print_instruction(bp, fo, state, cmd);
2084                 if ((cmd->len & F_OR) == 0)
2085                         break;
2086                 count--;
2087         }
2088         /*
2089          * If several O_IP_?PORT opcodes specified, leave them to the
2090          * options section.
2091          */
2092         if (portcnt == 1) {
2093                 for (l = state->rule->act_ofs, cmd = state->rule->cmd, pf = 0;
2094                     l > 0; l -= F_LEN(cmd), cmd += F_LEN(cmd)) {
2095                         if (cmd->opcode != portop) {
2096                                 pf = (cmd->len & F_OR);
2097                                 continue;
2098                         }
2099                         /* Print opcode iff it is not in OR block. */
2100                         if (pf == 0 && (cmd->len & F_OR) == 0)
2101                                 print_instruction(bp, fo, state, cmd);
2102                         break;
2103                 }
2104         }
2105         state->flags |= flag;
2106 }
2107
2108 static const int action_opcodes[] = {
2109         O_CHECK_STATE, O_ACCEPT, O_COUNT, O_DENY, O_REJECT,
2110         O_UNREACH6, O_SKIPTO, O_PIPE, O_QUEUE, O_DIVERT, O_TEE,
2111         O_NETGRAPH, O_NGTEE, O_FORWARD_IP, O_FORWARD_IP6, O_NAT,
2112         O_SETFIB, O_SETDSCP, O_REASS, O_CALLRETURN,
2113         /* keep the following opcodes at the end of the list */
2114         O_EXTERNAL_ACTION, O_EXTERNAL_INSTANCE, O_EXTERNAL_DATA
2115 };
2116
2117 static const int modifier_opcodes[] = {
2118         O_LOG, O_ALTQ, O_TAG
2119 };
2120
2121 static const int src_opcodes[] = {
2122         O_IP_SRC, O_IP_SRC_LOOKUP, O_IP_SRC_MASK, O_IP_SRC_ME,
2123         O_IP_SRC_SET, O_IP6_SRC, O_IP6_SRC_MASK, O_IP6_SRC_ME
2124 };
2125
2126 static const int dst_opcodes[] = {
2127         O_IP_DST, O_IP_DST_LOOKUP, O_IP_DST_MASK, O_IP_DST_ME,
2128         O_IP_DST_SET, O_IP6_DST, O_IP6_DST_MASK, O_IP6_DST_ME
2129 };
2130
2131 static void
2132 show_static_rule(struct cmdline_opts *co, struct format_opts *fo,
2133     struct buf_pr *bp, struct ip_fw_rule *rule, struct ip_fw_bcounter *cntr)
2134 {
2135         struct show_state state;
2136         ipfw_insn *cmd;
2137         static int twidth = 0;
2138         int i;
2139
2140         /* Print # DISABLED or skip the rule */
2141         if ((fo->set_mask & (1 << rule->set)) == 0) {
2142                 /* disabled mask */
2143                 if (!co->show_sets)
2144                         return;
2145                 else
2146                         bprintf(bp, "# DISABLED ");
2147         }
2148         if (init_show_state(&state, rule) != 0) {
2149                 warn("init_show_state() failed");
2150                 return;
2151         }
2152         bprintf(bp, "%05u ", rule->rulenum);
2153
2154         /* Print counters if enabled */
2155         if (fo->pcwidth > 0 || fo->bcwidth > 0) {
2156                 pr_u64(bp, &cntr->pcnt, fo->pcwidth);
2157                 pr_u64(bp, &cntr->bcnt, fo->bcwidth);
2158         }
2159
2160         /* Print timestamp */
2161         if (co->do_time == TIMESTAMP_NUMERIC)
2162                 bprintf(bp, "%10u ", cntr->timestamp);
2163         else if (co->do_time == TIMESTAMP_STRING) {
2164                 char timestr[30];
2165                 time_t t = (time_t)0;
2166
2167                 if (twidth == 0) {
2168                         strcpy(timestr, ctime(&t));
2169                         *strchr(timestr, '\n') = '\0';
2170                         twidth = strlen(timestr);
2171                 }
2172                 if (cntr->timestamp > 0) {
2173                         t = _long_to_time(cntr->timestamp);
2174
2175                         strcpy(timestr, ctime(&t));
2176                         *strchr(timestr, '\n') = '\0';
2177                         bprintf(bp, "%s ", timestr);
2178                 } else {
2179                         bprintf(bp, "%*s", twidth, " ");
2180                 }
2181         }
2182
2183         /* Print set number */
2184         if (co->show_sets)
2185                 bprintf(bp, "set %d ", rule->set);
2186
2187         /* Print the optional "match probability" */
2188         cmd = print_opcode(bp, fo, &state, O_PROB);
2189         /* Print rule action */
2190         for (i = 0; i < nitems(action_opcodes); i++) {
2191                 cmd = print_action(bp, fo, &state, action_opcodes[i]);
2192                 if (cmd == NULL)
2193                         continue;
2194                 /* Handle special cases */
2195                 switch (cmd->opcode) {
2196                 case O_CHECK_STATE:
2197                         goto end;
2198                 case O_EXTERNAL_ACTION:
2199                 case O_EXTERNAL_INSTANCE:
2200                         /* External action can have several instructions */
2201                         continue;
2202                 }
2203                 break;
2204         }
2205         /* Print rule modifiers */
2206         for (i = 0; i < nitems(modifier_opcodes); i++)
2207                 print_action(bp, fo, &state, modifier_opcodes[i]);
2208         /*
2209          * Print rule body
2210          */
2211         if (co->comment_only != 0)
2212                 goto end;
2213
2214         if (rule->flags & IPFW_RULE_JUSTOPTS) {
2215                 state.flags |= HAVE_PROTO | HAVE_SRCIP | HAVE_DSTIP;
2216                 goto justopts;
2217         }
2218
2219         print_proto(bp, fo, &state);
2220
2221         /* Print source */
2222         bprintf(bp, " from");
2223         print_address(bp, fo, &state, src_opcodes, nitems(src_opcodes),
2224             O_IP_SRCPORT, HAVE_SRCIP);
2225
2226         /* Print destination */
2227         bprintf(bp, " to");
2228         print_address(bp, fo, &state, dst_opcodes, nitems(dst_opcodes),
2229             O_IP_DSTPORT, HAVE_DSTIP);
2230
2231 justopts:
2232         /* Print the rest of options */
2233         while (print_opcode(bp, fo, &state, -1))
2234                 ;
2235 end:
2236         /* Print comment at the end */
2237         cmd = print_opcode(bp, fo, &state, O_NOP);
2238         if (co->comment_only != 0 && cmd == NULL)
2239                 bprintf(bp, " // ...");
2240         bprintf(bp, "\n");
2241         free_show_state(&state);
2242 }
2243
2244 static void
2245 show_dyn_state(struct cmdline_opts *co, struct format_opts *fo,
2246     struct buf_pr *bp, ipfw_dyn_rule *d)
2247 {
2248         struct protoent *pe;
2249         struct in_addr a;
2250         uint16_t rulenum;
2251         char buf[INET6_ADDRSTRLEN];
2252
2253         if (d->expire == 0 && d->dyn_type != O_LIMIT_PARENT)
2254                 return;
2255
2256         bcopy(&d->rule, &rulenum, sizeof(rulenum));
2257         bprintf(bp, "%05d", rulenum);
2258         if (fo->pcwidth > 0 || fo->bcwidth > 0) {
2259                 bprintf(bp, " ");
2260                 pr_u64(bp, &d->pcnt, fo->pcwidth);
2261                 pr_u64(bp, &d->bcnt, fo->bcwidth);
2262                 bprintf(bp, "(%ds)", d->expire);
2263         }
2264         switch (d->dyn_type) {
2265         case O_LIMIT_PARENT:
2266                 bprintf(bp, " PARENT %d", d->count);
2267                 break;
2268         case O_LIMIT:
2269                 bprintf(bp, " LIMIT");
2270                 break;
2271         case O_KEEP_STATE: /* bidir, no mask */
2272                 bprintf(bp, " STATE");
2273                 break;
2274         }
2275
2276         if ((pe = getprotobynumber(d->id.proto)) != NULL)
2277                 bprintf(bp, " %s", pe->p_name);
2278         else
2279                 bprintf(bp, " proto %u", d->id.proto);
2280
2281         if (d->id.addr_type == 4) {
2282                 a.s_addr = htonl(d->id.src_ip);
2283                 bprintf(bp, " %s %d", inet_ntoa(a), d->id.src_port);
2284
2285                 a.s_addr = htonl(d->id.dst_ip);
2286                 bprintf(bp, " <-> %s %d", inet_ntoa(a), d->id.dst_port);
2287         } else if (d->id.addr_type == 6) {
2288                 bprintf(bp, " %s %d", inet_ntop(AF_INET6, &d->id.src_ip6, buf,
2289                     sizeof(buf)), d->id.src_port);
2290                 bprintf(bp, " <-> %s %d", inet_ntop(AF_INET6, &d->id.dst_ip6,
2291                     buf, sizeof(buf)), d->id.dst_port);
2292         } else
2293                 bprintf(bp, " UNKNOWN <-> UNKNOWN");
2294         if (d->kidx != 0)
2295                 bprintf(bp, " :%s", object_search_ctlv(fo->tstate,
2296                     d->kidx, IPFW_TLV_STATE_NAME));
2297
2298 #define BOTH_SYN        (TH_SYN | (TH_SYN << 8))
2299 #define BOTH_FIN        (TH_FIN | (TH_FIN << 8))
2300         if (co->verbose) {
2301                 bprintf(bp, " state 0x%08x%s", d->state,
2302                     d->state ? " ": ",");
2303                 if (d->state & IPFW_DYN_ORPHANED)
2304                         bprintf(bp, "ORPHANED,");
2305                 if ((d->state & BOTH_SYN) == BOTH_SYN)
2306                         bprintf(bp, "BOTH_SYN,");
2307                 else {
2308                         if (d->state & TH_SYN)
2309                                 bprintf(bp, "F_SYN,");
2310                         if (d->state & (TH_SYN << 8))
2311                                 bprintf(bp, "R_SYN,");
2312                 }
2313                 if ((d->state & BOTH_FIN) == BOTH_FIN)
2314                         bprintf(bp, "BOTH_FIN,");
2315                 else {
2316                         if (d->state & TH_FIN)
2317                                 bprintf(bp, "F_FIN,");
2318                         if (d->state & (TH_FIN << 8))
2319                                 bprintf(bp, "R_FIN,");
2320                 }
2321                 bprintf(bp, " f_ack 0x%x, r_ack 0x%x", d->ack_fwd,
2322                     d->ack_rev);
2323         }
2324 }
2325
2326 static int
2327 do_range_cmd(int cmd, ipfw_range_tlv *rt)
2328 {
2329         ipfw_range_header rh;
2330         size_t sz;
2331
2332         memset(&rh, 0, sizeof(rh));
2333         memcpy(&rh.range, rt, sizeof(*rt));
2334         rh.range.head.length = sizeof(*rt);
2335         rh.range.head.type = IPFW_TLV_RANGE;
2336         sz = sizeof(rh);
2337
2338         if (do_get3(cmd, &rh.opheader, &sz) != 0)
2339                 return (-1);
2340         /* Save number of matched objects */
2341         rt->new_set = rh.range.new_set;
2342         return (0);
2343 }
2344
2345 /*
2346  * This one handles all set-related commands
2347  *      ipfw set { show | enable | disable }
2348  *      ipfw set swap X Y
2349  *      ipfw set move X to Y
2350  *      ipfw set move rule X to Y
2351  */
2352 void
2353 ipfw_sets_handler(char *av[])
2354 {
2355         ipfw_range_tlv rt;
2356         char *msg;
2357         size_t size;
2358         uint32_t masks[2];
2359         int i;
2360         uint16_t rulenum;
2361         uint8_t cmd;
2362
2363         av++;
2364         memset(&rt, 0, sizeof(rt));
2365
2366         if (av[0] == NULL)
2367                 errx(EX_USAGE, "set needs command");
2368         if (_substrcmp(*av, "show") == 0) {
2369                 struct format_opts fo;
2370                 ipfw_cfg_lheader *cfg;
2371
2372                 memset(&fo, 0, sizeof(fo));
2373                 if (ipfw_get_config(&co, &fo, &cfg, &size) != 0)
2374                         err(EX_OSERR, "requesting config failed");
2375
2376                 for (i = 0, msg = "disable"; i < RESVD_SET; i++)
2377                         if ((cfg->set_mask & (1<<i)) == 0) {
2378                                 printf("%s %d", msg, i);
2379                                 msg = "";
2380                         }
2381                 msg = (cfg->set_mask != (uint32_t)-1) ? " enable" : "enable";
2382                 for (i = 0; i < RESVD_SET; i++)
2383                         if ((cfg->set_mask & (1<<i)) != 0) {
2384                                 printf("%s %d", msg, i);
2385                                 msg = "";
2386                         }
2387                 printf("\n");
2388                 free(cfg);
2389         } else if (_substrcmp(*av, "swap") == 0) {
2390                 av++;
2391                 if ( av[0] == NULL || av[1] == NULL )
2392                         errx(EX_USAGE, "set swap needs 2 set numbers\n");
2393                 rt.set = atoi(av[0]);
2394                 rt.new_set = atoi(av[1]);
2395                 if (!isdigit(*(av[0])) || rt.set > RESVD_SET)
2396                         errx(EX_DATAERR, "invalid set number %s\n", av[0]);
2397                 if (!isdigit(*(av[1])) || rt.new_set > RESVD_SET)
2398                         errx(EX_DATAERR, "invalid set number %s\n", av[1]);
2399                 i = do_range_cmd(IP_FW_SET_SWAP, &rt);
2400         } else if (_substrcmp(*av, "move") == 0) {
2401                 av++;
2402                 if (av[0] && _substrcmp(*av, "rule") == 0) {
2403                         rt.flags = IPFW_RCFLAG_RANGE; /* move rules to new set */
2404                         cmd = IP_FW_XMOVE;
2405                         av++;
2406                 } else
2407                         cmd = IP_FW_SET_MOVE; /* Move set to new one */
2408                 if (av[0] == NULL || av[1] == NULL || av[2] == NULL ||
2409                                 av[3] != NULL ||  _substrcmp(av[1], "to") != 0)
2410                         errx(EX_USAGE, "syntax: set move [rule] X to Y\n");
2411                 rulenum = atoi(av[0]);
2412                 rt.new_set = atoi(av[2]);
2413                 if (cmd == IP_FW_XMOVE) {
2414                         rt.start_rule = rulenum;
2415                         rt.end_rule = rulenum;
2416                 } else
2417                         rt.set = rulenum;
2418                 rt.new_set = atoi(av[2]);
2419                 if (!isdigit(*(av[0])) || (cmd == 3 && rt.set > RESVD_SET) ||
2420                         (cmd == 2 && rt.start_rule == IPFW_DEFAULT_RULE) )
2421                         errx(EX_DATAERR, "invalid source number %s\n", av[0]);
2422                 if (!isdigit(*(av[2])) || rt.new_set > RESVD_SET)
2423                         errx(EX_DATAERR, "invalid dest. set %s\n", av[1]);
2424                 i = do_range_cmd(cmd, &rt);
2425                 if (i < 0)
2426                         err(EX_OSERR, "failed to move %s",
2427                             cmd == IP_FW_SET_MOVE ? "set": "rule");
2428         } else if (_substrcmp(*av, "disable") == 0 ||
2429                    _substrcmp(*av, "enable") == 0 ) {
2430                 int which = _substrcmp(*av, "enable") == 0 ? 1 : 0;
2431
2432                 av++;
2433                 masks[0] = masks[1] = 0;
2434
2435                 while (av[0]) {
2436                         if (isdigit(**av)) {
2437                                 i = atoi(*av);
2438                                 if (i < 0 || i > RESVD_SET)
2439                                         errx(EX_DATAERR,
2440                                             "invalid set number %d\n", i);
2441                                 masks[which] |= (1<<i);
2442                         } else if (_substrcmp(*av, "disable") == 0)
2443                                 which = 0;
2444                         else if (_substrcmp(*av, "enable") == 0)
2445                                 which = 1;
2446                         else
2447                                 errx(EX_DATAERR,
2448                                         "invalid set command %s\n", *av);
2449                         av++;
2450                 }
2451                 if ( (masks[0] & masks[1]) != 0 )
2452                         errx(EX_DATAERR,
2453                             "cannot enable and disable the same set\n");
2454
2455                 rt.set = masks[0];
2456                 rt.new_set = masks[1];
2457                 i = do_range_cmd(IP_FW_SET_ENABLE, &rt);
2458                 if (i)
2459                         warn("set enable/disable: setsockopt(IP_FW_SET_ENABLE)");
2460         } else
2461                 errx(EX_USAGE, "invalid set command %s\n", *av);
2462 }
2463
2464 void
2465 ipfw_sysctl_handler(char *av[], int which)
2466 {
2467         av++;
2468
2469         if (av[0] == NULL) {
2470                 warnx("missing keyword to enable/disable\n");
2471         } else if (_substrcmp(*av, "firewall") == 0) {
2472                 sysctlbyname("net.inet.ip.fw.enable", NULL, 0,
2473                     &which, sizeof(which));
2474                 sysctlbyname("net.inet6.ip6.fw.enable", NULL, 0,
2475                     &which, sizeof(which));
2476         } else if (_substrcmp(*av, "one_pass") == 0) {
2477                 sysctlbyname("net.inet.ip.fw.one_pass", NULL, 0,
2478                     &which, sizeof(which));
2479         } else if (_substrcmp(*av, "debug") == 0) {
2480                 sysctlbyname("net.inet.ip.fw.debug", NULL, 0,
2481                     &which, sizeof(which));
2482         } else if (_substrcmp(*av, "verbose") == 0) {
2483                 sysctlbyname("net.inet.ip.fw.verbose", NULL, 0,
2484                     &which, sizeof(which));
2485         } else if (_substrcmp(*av, "dyn_keepalive") == 0) {
2486                 sysctlbyname("net.inet.ip.fw.dyn_keepalive", NULL, 0,
2487                     &which, sizeof(which));
2488 #ifndef NO_ALTQ
2489         } else if (_substrcmp(*av, "altq") == 0) {
2490                 altq_set_enabled(which);
2491 #endif
2492         } else {
2493                 warnx("unrecognize enable/disable keyword: %s\n", *av);
2494         }
2495 }
2496
2497 typedef void state_cb(struct cmdline_opts *co, struct format_opts *fo,
2498     void *arg, void *state);
2499
2500 static void
2501 prepare_format_dyn(struct cmdline_opts *co, struct format_opts *fo,
2502     void *arg, void *_state)
2503 {
2504         ipfw_dyn_rule *d;
2505         int width;
2506         uint8_t set;
2507
2508         d = (ipfw_dyn_rule *)_state;
2509         /* Count _ALL_ states */
2510         fo->dcnt++;
2511
2512         if (fo->show_counters == 0)
2513                 return;
2514
2515         if (co->use_set) {
2516                 /* skip states from another set */
2517                 bcopy((char *)&d->rule + sizeof(uint16_t), &set,
2518                     sizeof(uint8_t));
2519                 if (set != co->use_set - 1)
2520                         return;
2521         }
2522
2523         width = pr_u64(NULL, &d->pcnt, 0);
2524         if (width > fo->pcwidth)
2525                 fo->pcwidth = width;
2526
2527         width = pr_u64(NULL, &d->bcnt, 0);
2528         if (width > fo->bcwidth)
2529                 fo->bcwidth = width;
2530 }
2531
2532 static int
2533 foreach_state(struct cmdline_opts *co, struct format_opts *fo,
2534     caddr_t base, size_t sz, state_cb dyn_bc, void *dyn_arg)
2535 {
2536         int ttype;
2537         state_cb *fptr;
2538         void *farg;
2539         ipfw_obj_tlv *tlv;
2540         ipfw_obj_ctlv *ctlv;
2541
2542         fptr = NULL;
2543         ttype = 0;
2544
2545         while (sz > 0) {
2546                 ctlv = (ipfw_obj_ctlv *)base;
2547                 switch (ctlv->head.type) {
2548                 case IPFW_TLV_DYNSTATE_LIST:
2549                         base += sizeof(*ctlv);
2550                         sz -= sizeof(*ctlv);
2551                         ttype = IPFW_TLV_DYN_ENT;
2552                         fptr = dyn_bc;
2553                         farg = dyn_arg;
2554                         break;
2555                 default:
2556                         return (sz);
2557                 }
2558
2559                 while (sz > 0) {
2560                         tlv = (ipfw_obj_tlv *)base;
2561                         if (tlv->type != ttype)
2562                                 break;
2563
2564                         fptr(co, fo, farg, tlv + 1);
2565                         sz -= tlv->length;
2566                         base += tlv->length;
2567                 }
2568         }
2569
2570         return (sz);
2571 }
2572
2573 static void
2574 prepare_format_opts(struct cmdline_opts *co, struct format_opts *fo,
2575     ipfw_obj_tlv *rtlv, int rcnt, caddr_t dynbase, size_t dynsz)
2576 {
2577         int bcwidth, pcwidth, width;
2578         int n;
2579         struct ip_fw_bcounter *cntr;
2580         struct ip_fw_rule *r;
2581
2582         bcwidth = 0;
2583         pcwidth = 0;
2584         if (fo->show_counters != 0) {
2585                 for (n = 0; n < rcnt; n++,
2586                     rtlv = (ipfw_obj_tlv *)((caddr_t)rtlv + rtlv->length)) {
2587                         cntr = (struct ip_fw_bcounter *)(rtlv + 1);
2588                         r = (struct ip_fw_rule *)((caddr_t)cntr + cntr->size);
2589                         /* skip rules from another set */
2590                         if (co->use_set && r->set != co->use_set - 1)
2591                                 continue;
2592
2593                         /* packet counter */
2594                         width = pr_u64(NULL, &cntr->pcnt, 0);
2595                         if (width > pcwidth)
2596                                 pcwidth = width;
2597
2598                         /* byte counter */
2599                         width = pr_u64(NULL, &cntr->bcnt, 0);
2600                         if (width > bcwidth)
2601                                 bcwidth = width;
2602                 }
2603         }
2604         fo->bcwidth = bcwidth;
2605         fo->pcwidth = pcwidth;
2606
2607         fo->dcnt = 0;
2608         if (co->do_dynamic && dynsz > 0)
2609                 foreach_state(co, fo, dynbase, dynsz, prepare_format_dyn, NULL);
2610 }
2611
2612 static int
2613 list_static_range(struct cmdline_opts *co, struct format_opts *fo,
2614     struct buf_pr *bp, ipfw_obj_tlv *rtlv, int rcnt)
2615 {
2616         int n, seen;
2617         struct ip_fw_rule *r;
2618         struct ip_fw_bcounter *cntr;
2619         int c = 0;
2620
2621         for (n = seen = 0; n < rcnt; n++,
2622             rtlv = (ipfw_obj_tlv *)((caddr_t)rtlv + rtlv->length)) {
2623
2624                 if ((fo->show_counters | fo->show_time) != 0) {
2625                         cntr = (struct ip_fw_bcounter *)(rtlv + 1);
2626                         r = (struct ip_fw_rule *)((caddr_t)cntr + cntr->size);
2627                 } else {
2628                         cntr = NULL;
2629                         r = (struct ip_fw_rule *)(rtlv + 1);
2630                 }
2631                 if (r->rulenum > fo->last)
2632                         break;
2633                 if (co->use_set && r->set != co->use_set - 1)
2634                         continue;
2635                 if (r->rulenum >= fo->first && r->rulenum <= fo->last) {
2636                         show_static_rule(co, fo, bp, r, cntr);
2637                         printf("%s", bp->buf);
2638                         c += rtlv->length;
2639                         bp_flush(bp);
2640                         seen++;
2641                 }
2642         }
2643
2644         return (seen);
2645 }
2646
2647 static void
2648 list_dyn_state(struct cmdline_opts *co, struct format_opts *fo,
2649     void *_arg, void *_state)
2650 {
2651         uint16_t rulenum;
2652         uint8_t set;
2653         ipfw_dyn_rule *d;
2654         struct buf_pr *bp;
2655
2656         d = (ipfw_dyn_rule *)_state;
2657         bp = (struct buf_pr *)_arg;
2658
2659         bcopy(&d->rule, &rulenum, sizeof(rulenum));
2660         if (rulenum > fo->last)
2661                 return;
2662         if (co->use_set) {
2663                 bcopy((char *)&d->rule + sizeof(uint16_t),
2664                       &set, sizeof(uint8_t));
2665                 if (set != co->use_set - 1)
2666                         return;
2667         }
2668         if (rulenum >= fo->first) {
2669                 show_dyn_state(co, fo, bp, d);
2670                 printf("%s\n", bp->buf);
2671                 bp_flush(bp);
2672         }
2673 }
2674
2675 static int
2676 list_dyn_range(struct cmdline_opts *co, struct format_opts *fo,
2677     struct buf_pr *bp, caddr_t base, size_t sz)
2678 {
2679
2680         sz = foreach_state(co, fo, base, sz, list_dyn_state, bp);
2681         return (sz);
2682 }
2683
2684 void
2685 ipfw_list(int ac, char *av[], int show_counters)
2686 {
2687         ipfw_cfg_lheader *cfg;
2688         struct format_opts sfo;
2689         size_t sz;
2690         int error;
2691         int lac;
2692         char **lav;
2693         uint32_t rnum;
2694         char *endptr;
2695
2696         if (co.test_only) {
2697                 fprintf(stderr, "Testing only, list disabled\n");
2698                 return;
2699         }
2700         if (co.do_pipe) {
2701                 dummynet_list(ac, av, show_counters);
2702                 return;
2703         }
2704
2705         ac--;
2706         av++;
2707         memset(&sfo, 0, sizeof(sfo));
2708
2709         /* Determine rule range to request */
2710         if (ac > 0) {
2711                 for (lac = ac, lav = av; lac != 0; lac--) {
2712                         rnum = strtoul(*lav++, &endptr, 10);
2713                         if (sfo.first == 0 || rnum < sfo.first)
2714                                 sfo.first = rnum;
2715
2716                         if (*endptr == '-')
2717                                 rnum = strtoul(endptr + 1, &endptr, 10);
2718                         if (sfo.last == 0 || rnum > sfo.last)
2719                                 sfo.last = rnum;
2720                 }
2721         }
2722
2723         /* get configuraion from kernel */
2724         cfg = NULL;
2725         sfo.show_counters = show_counters;
2726         sfo.show_time = co.do_time;
2727         if (co.do_dynamic != 2)
2728                 sfo.flags |= IPFW_CFG_GET_STATIC;
2729         if (co.do_dynamic != 0)
2730                 sfo.flags |= IPFW_CFG_GET_STATES;
2731         if ((sfo.show_counters | sfo.show_time) != 0)
2732                 sfo.flags |= IPFW_CFG_GET_COUNTERS;
2733         if (ipfw_get_config(&co, &sfo, &cfg, &sz) != 0)
2734                 err(EX_OSERR, "retrieving config failed");
2735
2736         error = ipfw_show_config(&co, &sfo, cfg, sz, ac, av);
2737
2738         free(cfg);
2739
2740         if (error != EX_OK)
2741                 exit(error);
2742 }
2743
2744 static int
2745 ipfw_show_config(struct cmdline_opts *co, struct format_opts *fo,
2746     ipfw_cfg_lheader *cfg, size_t sz, int ac, char *av[])
2747 {
2748         caddr_t dynbase;
2749         size_t dynsz;
2750         int rcnt;
2751         int exitval = EX_OK;
2752         int lac;
2753         char **lav;
2754         char *endptr;
2755         size_t readsz;
2756         struct buf_pr bp;
2757         ipfw_obj_ctlv *ctlv, *tstate;
2758         ipfw_obj_tlv *rbase;
2759
2760         /*
2761          * Handle tablenames TLV first, if any
2762          */
2763         tstate = NULL;
2764         rbase = NULL;
2765         dynbase = NULL;
2766         dynsz = 0;
2767         readsz = sizeof(*cfg);
2768         rcnt = 0;
2769
2770         fo->set_mask = cfg->set_mask;
2771
2772         ctlv = (ipfw_obj_ctlv *)(cfg + 1);
2773         if (ctlv->head.type == IPFW_TLV_TBLNAME_LIST) {
2774                 object_sort_ctlv(ctlv);
2775                 fo->tstate = ctlv;
2776                 readsz += ctlv->head.length;
2777                 ctlv = (ipfw_obj_ctlv *)((caddr_t)ctlv + ctlv->head.length);
2778         }
2779
2780         if (cfg->flags & IPFW_CFG_GET_STATIC) {
2781                 /* We've requested static rules */
2782                 if (ctlv->head.type == IPFW_TLV_RULE_LIST) {
2783                         rbase = (ipfw_obj_tlv *)(ctlv + 1);
2784                         rcnt = ctlv->count;
2785                         readsz += ctlv->head.length;
2786                         ctlv = (ipfw_obj_ctlv *)((caddr_t)ctlv +
2787                             ctlv->head.length);
2788                 }
2789         }
2790
2791         if ((cfg->flags & IPFW_CFG_GET_STATES) && (readsz != sz))  {
2792                 /* We may have some dynamic states */
2793                 dynsz = sz - readsz;
2794                 /* Skip empty header */
2795                 if (dynsz != sizeof(ipfw_obj_ctlv))
2796                         dynbase = (caddr_t)ctlv;
2797                 else
2798                         dynsz = 0;
2799         }
2800
2801         prepare_format_opts(co, fo, rbase, rcnt, dynbase, dynsz);
2802         bp_alloc(&bp, 4096);
2803
2804         /* if no rule numbers were specified, list all rules */
2805         if (ac == 0) {
2806                 fo->first = 0;
2807                 fo->last = IPFW_DEFAULT_RULE;
2808                 if (cfg->flags & IPFW_CFG_GET_STATIC)
2809                         list_static_range(co, fo, &bp, rbase, rcnt);
2810
2811                 if (co->do_dynamic && dynsz > 0) {
2812                         printf("## Dynamic rules (%d %zu):\n", fo->dcnt,
2813                             dynsz);
2814                         list_dyn_range(co, fo, &bp, dynbase, dynsz);
2815                 }
2816
2817                 bp_free(&bp);
2818                 return (EX_OK);
2819         }
2820
2821         /* display specific rules requested on command line */
2822         for (lac = ac, lav = av; lac != 0; lac--) {
2823                 /* convert command line rule # */
2824                 fo->last = fo->first = strtoul(*lav++, &endptr, 10);
2825                 if (*endptr == '-')
2826                         fo->last = strtoul(endptr + 1, &endptr, 10);
2827                 if (*endptr) {
2828                         exitval = EX_USAGE;
2829                         warnx("invalid rule number: %s", *(lav - 1));
2830                         continue;
2831                 }
2832
2833                 if ((cfg->flags & IPFW_CFG_GET_STATIC) == 0)
2834                         continue;
2835
2836                 if (list_static_range(co, fo, &bp, rbase, rcnt) == 0) {
2837                         /* give precedence to other error(s) */
2838                         if (exitval == EX_OK)
2839                                 exitval = EX_UNAVAILABLE;
2840                         if (fo->first == fo->last)
2841                                 warnx("rule %u does not exist", fo->first);
2842                         else
2843                                 warnx("no rules in range %u-%u",
2844                                     fo->first, fo->last);
2845                 }
2846         }
2847
2848         if (co->do_dynamic && dynsz > 0) {
2849                 printf("## Dynamic rules:\n");
2850                 for (lac = ac, lav = av; lac != 0; lac--) {
2851                         fo->last = fo->first = strtoul(*lav++, &endptr, 10);
2852                         if (*endptr == '-')
2853                                 fo->last = strtoul(endptr+1, &endptr, 10);
2854                         if (*endptr)
2855                                 /* already warned */
2856                                 continue;
2857                         list_dyn_range(co, fo, &bp, dynbase, dynsz);
2858                 }
2859         }
2860
2861         bp_free(&bp);
2862         return (exitval);
2863 }
2864
2865
2866 /*
2867  * Retrieves current ipfw configuration of given type
2868  * and stores its pointer to @pcfg.
2869  *
2870  * Caller is responsible for freeing @pcfg.
2871  *
2872  * Returns 0 on success.
2873  */
2874
2875 static int
2876 ipfw_get_config(struct cmdline_opts *co, struct format_opts *fo,
2877     ipfw_cfg_lheader **pcfg, size_t *psize)
2878 {
2879         ipfw_cfg_lheader *cfg;
2880         size_t sz;
2881         int i;
2882
2883
2884         if (co->test_only != 0) {
2885                 fprintf(stderr, "Testing only, list disabled\n");
2886                 return (0);
2887         }
2888
2889         /* Start with some data size */
2890         sz = 4096;
2891         cfg = NULL;
2892
2893         for (i = 0; i < 16; i++) {
2894                 if (cfg != NULL)
2895                         free(cfg);
2896                 if ((cfg = calloc(1, sz)) == NULL)
2897                         return (ENOMEM);
2898
2899                 cfg->flags = fo->flags;
2900                 cfg->start_rule = fo->first;
2901                 cfg->end_rule = fo->last;
2902
2903                 if (do_get3(IP_FW_XGET, &cfg->opheader, &sz) != 0) {
2904                         if (errno != ENOMEM) {
2905                                 free(cfg);
2906                                 return (errno);
2907                         }
2908
2909                         /* Buffer size is not enough. Try to increase */
2910                         sz = sz * 2;
2911                         if (sz < cfg->size)
2912                                 sz = cfg->size;
2913                         continue;
2914                 }
2915
2916                 *pcfg = cfg;
2917                 *psize = sz;
2918                 return (0);
2919         }
2920
2921         free(cfg);
2922         return (ENOMEM);
2923 }
2924
2925 static int
2926 lookup_host (char *host, struct in_addr *ipaddr)
2927 {
2928         struct hostent *he;
2929
2930         if (!inet_aton(host, ipaddr)) {
2931                 if ((he = gethostbyname(host)) == NULL)
2932                         return(-1);
2933                 *ipaddr = *(struct in_addr *)he->h_addr_list[0];
2934         }
2935         return(0);
2936 }
2937
2938 struct tidx {
2939         ipfw_obj_ntlv *idx;
2940         uint32_t count;
2941         uint32_t size;
2942         uint16_t counter;
2943         uint8_t set;
2944 };
2945
2946 int
2947 ipfw_check_object_name(const char *name)
2948 {
2949         int c, i, l;
2950
2951         /*
2952          * Check that name is null-terminated and contains
2953          * valid symbols only. Valid mask is:
2954          * [a-zA-Z0-9\-_\.]{1,63}
2955          */
2956         l = strlen(name);
2957         if (l == 0 || l >= 64)
2958                 return (EINVAL);
2959         for (i = 0; i < l; i++) {
2960                 c = name[i];
2961                 if (isalpha(c) || isdigit(c) || c == '_' ||
2962                     c == '-' || c == '.')
2963                         continue;
2964                 return (EINVAL);
2965         }
2966         return (0);
2967 }
2968
2969 static char *default_state_name = "default";
2970 static int
2971 state_check_name(const char *name)
2972 {
2973
2974         if (ipfw_check_object_name(name) != 0)
2975                 return (EINVAL);
2976         if (strcmp(name, "any") == 0)
2977                 return (EINVAL);
2978         return (0);
2979 }
2980
2981 static int
2982 eaction_check_name(const char *name)
2983 {
2984
2985         if (ipfw_check_object_name(name) != 0)
2986                 return (EINVAL);
2987         /* Restrict some 'special' names */
2988         if (match_token(rule_actions, name) != -1 &&
2989             match_token(rule_action_params, name) != -1)
2990                 return (EINVAL);
2991         return (0);
2992 }
2993
2994 static uint16_t
2995 pack_object(struct tidx *tstate, char *name, int otype)
2996 {
2997         int i;
2998         ipfw_obj_ntlv *ntlv;
2999
3000         for (i = 0; i < tstate->count; i++) {
3001                 if (strcmp(tstate->idx[i].name, name) != 0)
3002                         continue;
3003                 if (tstate->idx[i].set != tstate->set)
3004                         continue;
3005                 if (tstate->idx[i].head.type != otype)
3006                         continue;
3007
3008                 return (tstate->idx[i].idx);
3009         }
3010
3011         if (tstate->count + 1 > tstate->size) {
3012                 tstate->size += 4;
3013                 tstate->idx = realloc(tstate->idx, tstate->size *
3014                     sizeof(ipfw_obj_ntlv));
3015                 if (tstate->idx == NULL)
3016                         return (0);
3017         }
3018
3019         ntlv = &tstate->idx[i];
3020         memset(ntlv, 0, sizeof(ipfw_obj_ntlv));
3021         strlcpy(ntlv->name, name, sizeof(ntlv->name));
3022         ntlv->head.type = otype;
3023         ntlv->head.length = sizeof(ipfw_obj_ntlv);
3024         ntlv->set = tstate->set;
3025         ntlv->idx = ++tstate->counter;
3026         tstate->count++;
3027
3028         return (ntlv->idx);
3029 }
3030
3031 static uint16_t
3032 pack_table(struct tidx *tstate, char *name)
3033 {
3034
3035         if (table_check_name(name) != 0)
3036                 return (0);
3037
3038         return (pack_object(tstate, name, IPFW_TLV_TBL_NAME));
3039 }
3040
3041 void
3042 fill_table(struct _ipfw_insn *cmd, char *av, uint8_t opcode,
3043     struct tidx *tstate)
3044 {
3045         uint32_t *d = ((ipfw_insn_u32 *)cmd)->d;
3046         uint16_t uidx;
3047         char *p;
3048
3049         if ((p = strchr(av + 6, ')')) == NULL)
3050                 errx(EX_DATAERR, "forgotten parenthesis: '%s'", av);
3051         *p = '\0';
3052         p = strchr(av + 6, ',');
3053         if (p)
3054                 *p++ = '\0';
3055
3056         if ((uidx = pack_table(tstate, av + 6)) == 0)
3057                 errx(EX_DATAERR, "Invalid table name: %s", av + 6);
3058
3059         cmd->opcode = opcode;
3060         cmd->arg1 = uidx;
3061         if (p) {
3062                 cmd->len |= F_INSN_SIZE(ipfw_insn_u32);
3063                 d[0] = strtoul(p, NULL, 0);
3064         } else
3065                 cmd->len |= F_INSN_SIZE(ipfw_insn);
3066 }
3067
3068
3069 /*
3070  * fills the addr and mask fields in the instruction as appropriate from av.
3071  * Update length as appropriate.
3072  * The following formats are allowed:
3073  *      me      returns O_IP_*_ME
3074  *      1.2.3.4         single IP address
3075  *      1.2.3.4:5.6.7.8 address:mask
3076  *      1.2.3.4/24      address/mask
3077  *      1.2.3.4/26{1,6,5,4,23}  set of addresses in a subnet
3078  * We can have multiple comma-separated address/mask entries.
3079  */
3080 static void
3081 fill_ip(ipfw_insn_ip *cmd, char *av, int cblen, struct tidx *tstate)
3082 {
3083         int len = 0;
3084         uint32_t *d = ((ipfw_insn_u32 *)cmd)->d;
3085
3086         cmd->o.len &= ~F_LEN_MASK;      /* zero len */
3087
3088         if (_substrcmp(av, "any") == 0)
3089                 return;
3090
3091         if (_substrcmp(av, "me") == 0) {
3092                 cmd->o.len |= F_INSN_SIZE(ipfw_insn);
3093                 return;
3094         }
3095
3096         if (strncmp(av, "table(", 6) == 0) {
3097                 fill_table(&cmd->o, av, O_IP_DST_LOOKUP, tstate);
3098                 return;
3099         }
3100
3101     while (av) {
3102         /*
3103          * After the address we can have '/' or ':' indicating a mask,
3104          * ',' indicating another address follows, '{' indicating a
3105          * set of addresses of unspecified size.
3106          */
3107         char *t = NULL, *p = strpbrk(av, "/:,{");
3108         int masklen;
3109         char md, nd = '\0';
3110
3111         CHECK_LENGTH(cblen, F_INSN_SIZE(ipfw_insn) + 2 + len);
3112
3113         if (p) {
3114                 md = *p;
3115                 *p++ = '\0';
3116                 if ((t = strpbrk(p, ",{")) != NULL) {
3117                         nd = *t;
3118                         *t = '\0';
3119                 }
3120         } else
3121                 md = '\0';
3122
3123         if (lookup_host(av, (struct in_addr *)&d[0]) != 0)
3124                 errx(EX_NOHOST, "hostname ``%s'' unknown", av);
3125         switch (md) {
3126         case ':':
3127                 if (!inet_aton(p, (struct in_addr *)&d[1]))
3128                         errx(EX_DATAERR, "bad netmask ``%s''", p);
3129                 break;
3130         case '/':
3131                 masklen = atoi(p);
3132                 if (masklen == 0)
3133                         d[1] = htonl(0U);       /* mask */
3134                 else if (masklen > 32)
3135                         errx(EX_DATAERR, "bad width ``%s''", p);
3136                 else
3137                         d[1] = htonl(~0U << (32 - masklen));
3138                 break;
3139         case '{':       /* no mask, assume /24 and put back the '{' */
3140                 d[1] = htonl(~0U << (32 - 24));
3141                 *(--p) = md;
3142                 break;
3143
3144         case ',':       /* single address plus continuation */
3145                 *(--p) = md;
3146                 /* FALLTHROUGH */
3147         case 0:         /* initialization value */
3148         default:
3149                 d[1] = htonl(~0U);      /* force /32 */
3150                 break;
3151         }
3152         d[0] &= d[1];           /* mask base address with mask */
3153         if (t)
3154                 *t = nd;
3155         /* find next separator */
3156         if (p)
3157                 p = strpbrk(p, ",{");
3158         if (p && *p == '{') {
3159                 /*
3160                  * We have a set of addresses. They are stored as follows:
3161                  *   arg1       is the set size (powers of 2, 2..256)
3162                  *   addr       is the base address IN HOST FORMAT
3163                  *   mask..     is an array of arg1 bits (rounded up to
3164                  *              the next multiple of 32) with bits set
3165                  *              for each host in the map.
3166                  */
3167                 uint32_t *map = (uint32_t *)&cmd->mask;
3168                 int low, high;
3169                 int i = contigmask((uint8_t *)&(d[1]), 32);
3170
3171                 if (len > 0)
3172                         errx(EX_DATAERR, "address set cannot be in a list");
3173                 if (i < 24 || i > 31)
3174                         errx(EX_DATAERR, "invalid set with mask %d\n", i);
3175                 cmd->o.arg1 = 1<<(32-i);        /* map length           */
3176                 d[0] = ntohl(d[0]);             /* base addr in host format */
3177                 cmd->o.opcode = O_IP_DST_SET;   /* default */
3178                 cmd->o.len |= F_INSN_SIZE(ipfw_insn_u32) + (cmd->o.arg1+31)/32;
3179                 for (i = 0; i < (cmd->o.arg1+31)/32 ; i++)
3180                         map[i] = 0;     /* clear map */
3181
3182                 av = p + 1;
3183                 low = d[0] & 0xff;
3184                 high = low + cmd->o.arg1 - 1;
3185                 /*
3186                  * Here, i stores the previous value when we specify a range
3187                  * of addresses within a mask, e.g. 45-63. i = -1 means we
3188                  * have no previous value.
3189                  */
3190                 i = -1; /* previous value in a range */
3191                 while (isdigit(*av)) {
3192                         char *s;
3193                         int a = strtol(av, &s, 0);
3194
3195                         if (s == av) { /* no parameter */
3196                             if (*av != '}')
3197                                 errx(EX_DATAERR, "set not closed\n");
3198                             if (i != -1)
3199                                 errx(EX_DATAERR, "incomplete range %d-", i);
3200                             break;
3201                         }
3202                         if (a < low || a > high)
3203                             errx(EX_DATAERR, "addr %d out of range [%d-%d]\n",
3204                                 a, low, high);
3205                         a -= low;
3206                         if (i == -1)    /* no previous in range */
3207                             i = a;
3208                         else {          /* check that range is valid */
3209                             if (i > a)
3210                                 errx(EX_DATAERR, "invalid range %d-%d",
3211                                         i+low, a+low);
3212                             if (*s == '-')
3213                                 errx(EX_DATAERR, "double '-' in range");
3214                         }
3215                         for (; i <= a; i++)
3216                             map[i/32] |= 1<<(i & 31);
3217                         i = -1;
3218                         if (*s == '-')
3219                             i = a;
3220                         else if (*s == '}')
3221                             break;
3222                         av = s+1;
3223                 }
3224                 return;
3225         }
3226         av = p;
3227         if (av)                 /* then *av must be a ',' */
3228                 av++;
3229
3230         /* Check this entry */
3231         if (d[1] == 0) { /* "any", specified as x.x.x.x/0 */
3232                 /*
3233                  * 'any' turns the entire list into a NOP.
3234                  * 'not any' never matches, so it is removed from the
3235                  * list unless it is the only item, in which case we
3236                  * report an error.
3237                  */
3238                 if (cmd->o.len & F_NOT) {       /* "not any" never matches */
3239                         if (av == NULL && len == 0) /* only this entry */
3240                                 errx(EX_DATAERR, "not any never matches");
3241                 }
3242                 /* else do nothing and skip this entry */
3243                 return;
3244         }
3245         /* A single IP can be stored in an optimized format */
3246         if (d[1] == (uint32_t)~0 && av == NULL && len == 0) {
3247                 cmd->o.len |= F_INSN_SIZE(ipfw_insn_u32);
3248                 return;
3249         }
3250         len += 2;       /* two words... */
3251         d += 2;
3252     } /* end while */
3253     if (len + 1 > F_LEN_MASK)
3254         errx(EX_DATAERR, "address list too long");
3255     cmd->o.len |= len+1;
3256 }
3257
3258
3259 /* n2mask sets n bits of the mask */
3260 void
3261 n2mask(struct in6_addr *mask, int n)
3262 {
3263         static int      minimask[9] =
3264             { 0x00, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe, 0xff };
3265         u_char          *p;
3266
3267         memset(mask, 0, sizeof(struct in6_addr));
3268         p = (u_char *) mask;
3269         for (; n > 0; p++, n -= 8) {
3270                 if (n >= 8)
3271                         *p = 0xff;
3272                 else
3273                         *p = minimask[n];
3274         }
3275         return;
3276 }
3277
3278 static void
3279 fill_flags_cmd(ipfw_insn *cmd, enum ipfw_opcodes opcode,
3280         struct _s_x *flags, char *p)
3281 {
3282         char *e;
3283         uint32_t set = 0, clear = 0;
3284
3285         if (fill_flags(flags, p, &e, &set, &clear) != 0)
3286                 errx(EX_DATAERR, "invalid flag %s", e);
3287
3288         cmd->opcode = opcode;
3289         cmd->len =  (cmd->len & (F_NOT | F_OR)) | 1;
3290         cmd->arg1 = (set & 0xff) | ( (clear & 0xff) << 8);
3291 }
3292
3293
3294 void
3295 ipfw_delete(char *av[])
3296 {
3297         ipfw_range_tlv rt;
3298         char *sep;
3299         int i, j;
3300         int exitval = EX_OK;
3301         int do_set = 0;
3302
3303         av++;
3304         NEED1("missing rule specification");
3305         if ( *av && _substrcmp(*av, "set") == 0) {
3306                 /* Do not allow using the following syntax:
3307                  *      ipfw set N delete set M
3308                  */
3309                 if (co.use_set)
3310                         errx(EX_DATAERR, "invalid syntax");
3311                 do_set = 1;     /* delete set */
3312                 av++;
3313         }
3314
3315         /* Rule number */
3316         while (*av && isdigit(**av)) {
3317                 i = strtol(*av, &sep, 10);
3318                 j = i;
3319                 if (*sep== '-')
3320                         j = strtol(sep + 1, NULL, 10);
3321                 av++;
3322                 if (co.do_nat) {
3323                         exitval = do_cmd(IP_FW_NAT_DEL, &i, sizeof i);
3324                         if (exitval) {
3325                                 exitval = EX_UNAVAILABLE;
3326                                 if (co.do_quiet)
3327                                         continue;
3328                                 warn("nat %u not available", i);
3329                         }
3330                 } else if (co.do_pipe) {
3331                         exitval = ipfw_delete_pipe(co.do_pipe, i);
3332                 } else {
3333                         memset(&rt, 0, sizeof(rt));
3334                         if (do_set != 0) {
3335                                 rt.set = i & 31;
3336                                 rt.flags = IPFW_RCFLAG_SET;
3337                         } else {
3338                                 rt.start_rule = i & 0xffff;
3339                                 rt.end_rule = j & 0xffff;
3340                                 if (rt.start_rule == 0 && rt.end_rule == 0)
3341                                         rt.flags |= IPFW_RCFLAG_ALL;
3342                                 else
3343                                         rt.flags |= IPFW_RCFLAG_RANGE;
3344                                 if (co.use_set != 0) {
3345                                         rt.set = co.use_set - 1;
3346                                         rt.flags |= IPFW_RCFLAG_SET;
3347                                 }
3348                         }
3349                         if (co.do_dynamic == 2)
3350                                 rt.flags |= IPFW_RCFLAG_DYNAMIC;
3351                         i = do_range_cmd(IP_FW_XDEL, &rt);
3352                         if (i != 0) {
3353                                 exitval = EX_UNAVAILABLE;
3354                                 if (co.do_quiet)
3355                                         continue;
3356                                 warn("rule %u: setsockopt(IP_FW_XDEL)",
3357                                     rt.start_rule);
3358                         } else if (rt.new_set == 0 && do_set == 0 &&
3359                             co.do_dynamic != 2) {
3360                                 exitval = EX_UNAVAILABLE;
3361                                 if (co.do_quiet)
3362                                         continue;
3363                                 if (rt.start_rule != rt.end_rule)
3364                                         warnx("no rules rules in %u-%u range",
3365                                             rt.start_rule, rt.end_rule);
3366                                 else
3367                                         warnx("rule %u not found",
3368                                             rt.start_rule);
3369                         }
3370                 }
3371         }
3372         if (exitval != EX_OK && co.do_force == 0)
3373                 exit(exitval);
3374 }
3375
3376
3377 /*
3378  * fill the interface structure. We do not check the name as we can
3379  * create interfaces dynamically, so checking them at insert time
3380  * makes relatively little sense.
3381  * Interface names containing '*', '?', or '[' are assumed to be shell
3382  * patterns which match interfaces.
3383  */
3384 static void
3385 fill_iface(ipfw_insn_if *cmd, char *arg, int cblen, struct tidx *tstate)
3386 {
3387         char *p;
3388         uint16_t uidx;
3389
3390         cmd->name[0] = '\0';
3391         cmd->o.len |= F_INSN_SIZE(ipfw_insn_if);
3392
3393         CHECK_CMDLEN;
3394
3395         /* Parse the interface or address */
3396         if (strcmp(arg, "any") == 0)
3397                 cmd->o.len = 0;         /* effectively ignore this command */
3398         else if (strncmp(arg, "table(", 6) == 0) {
3399                 if ((p = strchr(arg + 6, ')')) == NULL)
3400                         errx(EX_DATAERR, "forgotten parenthesis: '%s'", arg);
3401                 *p = '\0';
3402                 p = strchr(arg + 6, ',');
3403                 if (p)
3404                         *p++ = '\0';
3405                 if ((uidx = pack_table(tstate, arg + 6)) == 0)
3406                         errx(EX_DATAERR, "Invalid table name: %s", arg + 6);
3407
3408                 cmd->name[0] = '\1'; /* Special value indicating table */
3409                 cmd->p.kidx = uidx;
3410         } else if (!isdigit(*arg)) {
3411                 strlcpy(cmd->name, arg, sizeof(cmd->name));
3412                 cmd->p.glob = strpbrk(arg, "*?[") != NULL ? 1 : 0;
3413         } else if (!inet_aton(arg, &cmd->p.ip))
3414                 errx(EX_DATAERR, "bad ip address ``%s''", arg);
3415 }
3416
3417 static void
3418 get_mac_addr_mask(const char *p, uint8_t *addr, uint8_t *mask)
3419 {
3420         int i;
3421         size_t l;
3422         char *ap, *ptr, *optr;
3423         struct ether_addr *mac;
3424         const char *macset = "0123456789abcdefABCDEF:";
3425
3426         if (strcmp(p, "any") == 0) {
3427                 for (i = 0; i < ETHER_ADDR_LEN; i++)
3428                         addr[i] = mask[i] = 0;
3429                 return;
3430         }
3431
3432         optr = ptr = strdup(p);
3433         if ((ap = strsep(&ptr, "&/")) != NULL && *ap != 0) {
3434                 l = strlen(ap);
3435                 if (strspn(ap, macset) != l || (mac = ether_aton(ap)) == NULL)
3436                         errx(EX_DATAERR, "Incorrect MAC address");
3437                 bcopy(mac, addr, ETHER_ADDR_LEN);
3438         } else
3439                 errx(EX_DATAERR, "Incorrect MAC address");
3440
3441         if (ptr != NULL) { /* we have mask? */
3442                 if (p[ptr - optr - 1] == '/') { /* mask len */
3443                         long ml = strtol(ptr, &ap, 10);
3444                         if (*ap != 0 || ml > ETHER_ADDR_LEN * 8 || ml < 0)
3445                                 errx(EX_DATAERR, "Incorrect mask length");
3446                         for (i = 0; ml > 0 && i < ETHER_ADDR_LEN; ml -= 8, i++)
3447                                 mask[i] = (ml >= 8) ? 0xff: (~0) << (8 - ml);
3448                 } else { /* mask */
3449                         l = strlen(ptr);
3450                         if (strspn(ptr, macset) != l ||
3451                             (mac = ether_aton(ptr)) == NULL)
3452                                 errx(EX_DATAERR, "Incorrect mask");
3453                         bcopy(mac, mask, ETHER_ADDR_LEN);
3454                 }
3455         } else { /* default mask: ff:ff:ff:ff:ff:ff */
3456                 for (i = 0; i < ETHER_ADDR_LEN; i++)
3457                         mask[i] = 0xff;
3458         }
3459         for (i = 0; i < ETHER_ADDR_LEN; i++)
3460                 addr[i] &= mask[i];
3461
3462         free(optr);
3463 }
3464
3465 /*
3466  * helper function, updates the pointer to cmd with the length
3467  * of the current command, and also cleans up the first word of
3468  * the new command in case it has been clobbered before.
3469  */
3470 static ipfw_insn *
3471 next_cmd(ipfw_insn *cmd, int *len)
3472 {
3473         *len -= F_LEN(cmd);
3474         CHECK_LENGTH(*len, 0);
3475         cmd += F_LEN(cmd);
3476         bzero(cmd, sizeof(*cmd));
3477         return cmd;
3478 }
3479
3480 /*
3481  * Takes arguments and copies them into a comment
3482  */
3483 static void
3484 fill_comment(ipfw_insn *cmd, char **av, int cblen)
3485 {
3486         int i, l;
3487         char *p = (char *)(cmd + 1);
3488
3489         cmd->opcode = O_NOP;
3490         cmd->len =  (cmd->len & (F_NOT | F_OR));
3491
3492         /* Compute length of comment string. */
3493         for (i = 0, l = 0; av[i] != NULL; i++)
3494                 l += strlen(av[i]) + 1;
3495         if (l == 0)
3496                 return;
3497         if (l > 84)
3498                 errx(EX_DATAERR,
3499                     "comment too long (max 80 chars)");
3500         l = 1 + (l+3)/4;
3501         cmd->len =  (cmd->len & (F_NOT | F_OR)) | l;
3502         CHECK_CMDLEN;
3503
3504         for (i = 0; av[i] != NULL; i++) {
3505                 strcpy(p, av[i]);
3506                 p += strlen(av[i]);
3507                 *p++ = ' ';
3508         }
3509         *(--p) = '\0';
3510 }
3511
3512 /*
3513  * A function to fill simple commands of size 1.
3514  * Existing flags are preserved.
3515  */
3516 static void
3517 fill_cmd(ipfw_insn *cmd, enum ipfw_opcodes opcode, int flags, uint16_t arg)
3518 {
3519         cmd->opcode = opcode;
3520         cmd->len =  ((cmd->len | flags) & (F_NOT | F_OR)) | 1;
3521         cmd->arg1 = arg;
3522 }
3523
3524 /*
3525  * Fetch and add the MAC address and type, with masks. This generates one or
3526  * two microinstructions, and returns the pointer to the last one.
3527  */
3528 static ipfw_insn *
3529 add_mac(ipfw_insn *cmd, char *av[], int cblen)
3530 {
3531         ipfw_insn_mac *mac;
3532
3533         if ( ( av[0] == NULL ) || ( av[1] == NULL ) )
3534                 errx(EX_DATAERR, "MAC dst src");
3535
3536         cmd->opcode = O_MACADDR2;
3537         cmd->len = (cmd->len & (F_NOT | F_OR)) | F_INSN_SIZE(ipfw_insn_mac);
3538         CHECK_CMDLEN;
3539
3540         mac = (ipfw_insn_mac *)cmd;
3541         get_mac_addr_mask(av[0], mac->addr, mac->mask); /* dst */
3542         get_mac_addr_mask(av[1], &(mac->addr[ETHER_ADDR_LEN]),
3543             &(mac->mask[ETHER_ADDR_LEN])); /* src */
3544         return cmd;
3545 }
3546
3547 static ipfw_insn *
3548 add_mactype(ipfw_insn *cmd, char *av, int cblen)
3549 {
3550         if (!av)
3551                 errx(EX_DATAERR, "missing MAC type");
3552         if (strcmp(av, "any") != 0) { /* we have a non-null type */
3553                 fill_newports((ipfw_insn_u16 *)cmd, av, IPPROTO_ETHERTYPE,
3554                     cblen);
3555                 cmd->opcode = O_MAC_TYPE;
3556                 return cmd;
3557         } else
3558                 return NULL;
3559 }
3560
3561 static ipfw_insn *
3562 add_proto0(ipfw_insn *cmd, char *av, u_char *protop)
3563 {
3564         struct protoent *pe;
3565         char *ep;
3566         int proto;
3567
3568         proto = strtol(av, &ep, 10);
3569         if (*ep != '\0' || proto <= 0) {
3570                 if ((pe = getprotobyname(av)) == NULL)
3571                         return NULL;
3572                 proto = pe->p_proto;
3573         }
3574
3575         fill_cmd(cmd, O_PROTO, 0, proto);
3576         *protop = proto;
3577         return cmd;
3578 }
3579
3580 static ipfw_insn *
3581 add_proto(ipfw_insn *cmd, char *av, u_char *protop)
3582 {
3583         u_char proto = IPPROTO_IP;
3584
3585         if (_substrcmp(av, "all") == 0 || strcmp(av, "ip") == 0)
3586                 ; /* do not set O_IP4 nor O_IP6 */
3587         else if (strcmp(av, "ip4") == 0)
3588                 /* explicit "just IPv4" rule */
3589                 fill_cmd(cmd, O_IP4, 0, 0);
3590         else if (strcmp(av, "ip6") == 0) {
3591                 /* explicit "just IPv6" rule */
3592                 proto = IPPROTO_IPV6;
3593                 fill_cmd(cmd, O_IP6, 0, 0);
3594         } else
3595                 return add_proto0(cmd, av, protop);
3596
3597         *protop = proto;
3598         return cmd;
3599 }
3600
3601 static ipfw_insn *
3602 add_proto_compat(ipfw_insn *cmd, char *av, u_char *protop)
3603 {
3604         u_char proto = IPPROTO_IP;
3605
3606         if (_substrcmp(av, "all") == 0 || strcmp(av, "ip") == 0)
3607                 ; /* do not set O_IP4 nor O_IP6 */
3608         else if (strcmp(av, "ipv4") == 0 || strcmp(av, "ip4") == 0)
3609                 /* explicit "just IPv4" rule */
3610                 fill_cmd(cmd, O_IP4, 0, 0);
3611         else if (strcmp(av, "ipv6") == 0 || strcmp(av, "ip6") == 0) {
3612                 /* explicit "just IPv6" rule */
3613                 proto = IPPROTO_IPV6;
3614                 fill_cmd(cmd, O_IP6, 0, 0);
3615         } else
3616                 return add_proto0(cmd, av, protop);
3617
3618         *protop = proto;
3619         return cmd;
3620 }
3621
3622 static ipfw_insn *
3623 add_srcip(ipfw_insn *cmd, char *av, int cblen, struct tidx *tstate)
3624 {
3625         fill_ip((ipfw_insn_ip *)cmd, av, cblen, tstate);
3626         if (cmd->opcode == O_IP_DST_SET)                        /* set */
3627                 cmd->opcode = O_IP_SRC_SET;
3628         else if (cmd->opcode == O_IP_DST_LOOKUP)                /* table */
3629                 cmd->opcode = O_IP_SRC_LOOKUP;
3630         else if (F_LEN(cmd) == F_INSN_SIZE(ipfw_insn))          /* me */
3631                 cmd->opcode = O_IP_SRC_ME;
3632         else if (F_LEN(cmd) == F_INSN_SIZE(ipfw_insn_u32))      /* one IP */
3633                 cmd->opcode = O_IP_SRC;
3634         else                                                    /* addr/mask */
3635                 cmd->opcode = O_IP_SRC_MASK;
3636         return cmd;
3637 }
3638
3639 static ipfw_insn *
3640 add_dstip(ipfw_insn *cmd, char *av, int cblen, struct tidx *tstate)
3641 {
3642         fill_ip((ipfw_insn_ip *)cmd, av, cblen, tstate);
3643         if (cmd->opcode == O_IP_DST_SET)                        /* set */
3644                 ;
3645         else if (cmd->opcode == O_IP_DST_LOOKUP)                /* table */
3646                 ;
3647         else if (F_LEN(cmd) == F_INSN_SIZE(ipfw_insn))          /* me */
3648                 cmd->opcode = O_IP_DST_ME;
3649         else if (F_LEN(cmd) == F_INSN_SIZE(ipfw_insn_u32))      /* one IP */
3650                 cmd->opcode = O_IP_DST;
3651         else                                                    /* addr/mask */
3652                 cmd->opcode = O_IP_DST_MASK;
3653         return cmd;
3654 }
3655
3656 static struct _s_x f_reserved_keywords[] = {
3657         { "altq",       TOK_OR },
3658         { "//",         TOK_OR },
3659         { "diverted",   TOK_OR },
3660         { "dst-port",   TOK_OR },
3661         { "src-port",   TOK_OR },
3662         { "established",        TOK_OR },
3663         { "keep-state", TOK_OR },
3664         { "frag",       TOK_OR },
3665         { "icmptypes",  TOK_OR },
3666         { "in",         TOK_OR },
3667         { "out",        TOK_OR },
3668         { "ip6",        TOK_OR },
3669         { "any",        TOK_OR },
3670         { "to",         TOK_OR },
3671         { "via",        TOK_OR },
3672         { "{",          TOK_OR },
3673         { NULL, 0 }     /* terminator */
3674 };
3675
3676 static ipfw_insn *
3677 add_ports(ipfw_insn *cmd, char *av, u_char proto, int opcode, int cblen)
3678 {
3679
3680         if (match_token(f_reserved_keywords, av) != -1)
3681                 return (NULL);
3682
3683         if (fill_newports((ipfw_insn_u16 *)cmd, av, proto, cblen)) {
3684                 /* XXX todo: check that we have a protocol with ports */
3685                 cmd->opcode = opcode;
3686                 return cmd;
3687         }
3688         return NULL;
3689 }
3690
3691 static ipfw_insn *
3692 add_src(ipfw_insn *cmd, char *av, u_char proto, int cblen, struct tidx *tstate)
3693 {
3694         struct in6_addr a;
3695         char *host, *ch, buf[INET6_ADDRSTRLEN];
3696         ipfw_insn *ret = NULL;
3697         int len;
3698
3699         /* Copy first address in set if needed */
3700         if ((ch = strpbrk(av, "/,")) != NULL) {
3701                 len = ch - av;
3702                 strlcpy(buf, av, sizeof(buf));
3703                 if (len < sizeof(buf))
3704                         buf[len] = '\0';
3705                 host = buf;
3706         } else
3707                 host = av;
3708
3709         if (proto == IPPROTO_IPV6  || strcmp(av, "me6") == 0 ||
3710             inet_pton(AF_INET6, host, &a) == 1)
3711                 ret = add_srcip6(cmd, av, cblen, tstate);
3712         /* XXX: should check for IPv4, not !IPv6 */
3713         if (ret == NULL && (proto == IPPROTO_IP || strcmp(av, "me") == 0 ||
3714             inet_pton(AF_INET6, host, &a) != 1))
3715                 ret = add_srcip(cmd, av, cblen, tstate);
3716         if (ret == NULL && strcmp(av, "any") != 0)
3717                 ret = cmd;
3718
3719         return ret;
3720 }
3721
3722 static ipfw_insn *
3723 add_dst(ipfw_insn *cmd, char *av, u_char proto, int cblen, struct tidx *tstate)
3724 {
3725         struct in6_addr a;
3726         char *host, *ch, buf[INET6_ADDRSTRLEN];
3727         ipfw_insn *ret = NULL;
3728         int len;
3729
3730         /* Copy first address in set if needed */
3731         if ((ch = strpbrk(av, "/,")) != NULL) {
3732                 len = ch - av;
3733                 strlcpy(buf, av, sizeof(buf));
3734                 if (len < sizeof(buf))
3735                         buf[len] = '\0';
3736                 host = buf;
3737         } else
3738                 host = av;
3739
3740         if (proto == IPPROTO_IPV6  || strcmp(av, "me6") == 0 ||
3741             inet_pton(AF_INET6, host, &a) == 1)
3742                 ret = add_dstip6(cmd, av, cblen, tstate);
3743         /* XXX: should check for IPv4, not !IPv6 */
3744         if (ret == NULL && (proto == IPPROTO_IP || strcmp(av, "me") == 0 ||
3745             inet_pton(AF_INET6, host, &a) != 1))
3746                 ret = add_dstip(cmd, av, cblen, tstate);
3747         if (ret == NULL && strcmp(av, "any") != 0)
3748                 ret = cmd;
3749
3750         return ret;
3751 }
3752
3753 /*
3754  * Parse arguments and assemble the microinstructions which make up a rule.
3755  * Rules are added into the 'rulebuf' and then copied in the correct order
3756  * into the actual rule.
3757  *
3758  * The syntax for a rule starts with the action, followed by
3759  * optional action parameters, and the various match patterns.
3760  * In the assembled microcode, the first opcode must be an O_PROBE_STATE
3761  * (generated if the rule includes a keep-state option), then the
3762  * various match patterns, log/altq actions, and the actual action.
3763  *
3764  */
3765 void
3766 compile_rule(char *av[], uint32_t *rbuf, int *rbufsize, struct tidx *tstate)
3767 {
3768         /*
3769          * rules are added into the 'rulebuf' and then copied in
3770          * the correct order into the actual rule.
3771          * Some things that need to go out of order (prob, action etc.)
3772          * go into actbuf[].
3773          */
3774         static uint32_t actbuf[255], cmdbuf[255];
3775         int rblen, ablen, cblen;
3776
3777         ipfw_insn *src, *dst, *cmd, *action, *prev=NULL;
3778         ipfw_insn *first_cmd;   /* first match pattern */
3779
3780         struct ip_fw_rule *rule;
3781
3782         /*
3783          * various flags used to record that we entered some fields.
3784          */
3785         ipfw_insn *have_state = NULL;   /* any state-related option */
3786         int have_rstate = 0;
3787         ipfw_insn *have_log = NULL, *have_altq = NULL, *have_tag = NULL;
3788         ipfw_insn *have_skipcmd = NULL;
3789         size_t len;
3790
3791         int i;
3792
3793         int open_par = 0;       /* open parenthesis ( */
3794
3795         /* proto is here because it is used to fetch ports */
3796         u_char proto = IPPROTO_IP;      /* default protocol */
3797
3798         double match_prob = 1; /* match probability, default is always match */
3799
3800         bzero(actbuf, sizeof(actbuf));          /* actions go here */
3801         bzero(cmdbuf, sizeof(cmdbuf));
3802         bzero(rbuf, *rbufsize);
3803
3804         rule = (struct ip_fw_rule *)rbuf;
3805         cmd = (ipfw_insn *)cmdbuf;
3806         action = (ipfw_insn *)actbuf;
3807
3808         rblen = *rbufsize / sizeof(uint32_t);
3809         rblen -= sizeof(struct ip_fw_rule) / sizeof(uint32_t);
3810         ablen = sizeof(actbuf) / sizeof(actbuf[0]);
3811         cblen = sizeof(cmdbuf) / sizeof(cmdbuf[0]);
3812         cblen -= F_INSN_SIZE(ipfw_insn_u32) + 1;
3813
3814 #define CHECK_RBUFLEN(len)      { CHECK_LENGTH(rblen, len); rblen -= len; }
3815 #define CHECK_ACTLEN            CHECK_LENGTH(ablen, action->len)
3816
3817         av++;
3818
3819         /* [rule N]     -- Rule number optional */
3820         if (av[0] && isdigit(**av)) {
3821                 rule->rulenum = atoi(*av);
3822                 av++;
3823         }
3824
3825         /* [set N]      -- set number (0..RESVD_SET), optional */
3826         if (av[0] && av[1] && _substrcmp(*av, "set") == 0) {
3827                 int set = strtoul(av[1], NULL, 10);
3828                 if (set < 0 || set > RESVD_SET)
3829                         errx(EX_DATAERR, "illegal set %s", av[1]);
3830                 rule->set = set;
3831                 tstate->set = set;
3832                 av += 2;
3833         }
3834
3835         /* [prob D]     -- match probability, optional */
3836         if (av[0] && av[1] && _substrcmp(*av, "prob") == 0) {
3837                 match_prob = strtod(av[1], NULL);
3838
3839                 if (match_prob <= 0 || match_prob > 1)
3840                         errx(EX_DATAERR, "illegal match prob. %s", av[1]);
3841                 av += 2;
3842         }
3843
3844         /* action       -- mandatory */
3845         NEED1("missing action");
3846         i = match_token(rule_actions, *av);
3847         av++;
3848         action->len = 1;        /* default */
3849         CHECK_ACTLEN;
3850         switch(i) {
3851         case TOK_CHECKSTATE:
3852                 have_state = action;
3853                 action->opcode = O_CHECK_STATE;
3854                 if (*av == NULL ||
3855                     match_token(rule_options, *av) == TOK_COMMENT) {
3856                         action->arg1 = pack_object(tstate,
3857                             default_state_name, IPFW_TLV_STATE_NAME);
3858                         break;
3859                 }
3860                 if (*av[0] == ':') {
3861                         if (strcmp(*av + 1, "any") == 0)
3862                                 action->arg1 = 0;
3863                         else if (state_check_name(*av + 1) == 0)
3864                                 action->arg1 = pack_object(tstate, *av + 1,
3865                                     IPFW_TLV_STATE_NAME);
3866                         else
3867                                 errx(EX_DATAERR, "Invalid state name %s",
3868                                     *av);
3869                         av++;
3870                         break;
3871                 }
3872                 errx(EX_DATAERR, "Invalid state name %s", *av);
3873                 break;
3874
3875         case TOK_ABORT:
3876                 action->opcode = O_REJECT;
3877                 action->arg1 = ICMP_REJECT_ABORT;
3878                 break;
3879
3880         case TOK_ABORT6:
3881                 action->opcode = O_UNREACH6;
3882                 action->arg1 = ICMP6_UNREACH_ABORT;
3883                 break;
3884
3885         case TOK_ACCEPT:
3886                 action->opcode = O_ACCEPT;
3887                 break;
3888
3889         case TOK_DENY:
3890                 action->opcode = O_DENY;
3891                 action->arg1 = 0;
3892                 break;
3893
3894         case TOK_REJECT:
3895                 action->opcode = O_REJECT;
3896                 action->arg1 = ICMP_UNREACH_HOST;
3897                 break;
3898
3899         case TOK_RESET:
3900                 action->opcode = O_REJECT;
3901                 action->arg1 = ICMP_REJECT_RST;
3902                 break;
3903
3904         case TOK_RESET6:
3905                 action->opcode = O_UNREACH6;
3906                 action->arg1 = ICMP6_UNREACH_RST;
3907                 break;
3908
3909         case TOK_UNREACH:
3910                 action->opcode = O_REJECT;
3911                 NEED1("missing reject code");
3912                 fill_reject_code(&action->arg1, *av);
3913                 av++;
3914                 break;
3915
3916         case TOK_UNREACH6:
3917                 action->opcode = O_UNREACH6;
3918                 NEED1("missing unreach code");
3919                 fill_unreach6_code(&action->arg1, *av);
3920                 av++;
3921                 break;
3922
3923         case TOK_COUNT:
3924                 action->opcode = O_COUNT;
3925                 break;
3926
3927         case TOK_NAT:
3928                 action->opcode = O_NAT;
3929                 action->len = F_INSN_SIZE(ipfw_insn_nat);
3930                 CHECK_ACTLEN;
3931                 if (*av != NULL && _substrcmp(*av, "global") == 0) {
3932                         action->arg1 = IP_FW_NAT44_GLOBAL;
3933                         av++;
3934                         break;
3935                 } else
3936                         goto chkarg;
3937         case TOK_QUEUE:
3938                 action->opcode = O_QUEUE;
3939                 goto chkarg;
3940         case TOK_PIPE:
3941                 action->opcode = O_PIPE;
3942                 goto chkarg;
3943         case TOK_SKIPTO:
3944                 action->opcode = O_SKIPTO;
3945                 goto chkarg;
3946         case TOK_NETGRAPH:
3947                 action->opcode = O_NETGRAPH;
3948                 goto chkarg;
3949         case TOK_NGTEE:
3950                 action->opcode = O_NGTEE;
3951                 goto chkarg;
3952         case TOK_DIVERT:
3953                 action->opcode = O_DIVERT;
3954                 goto chkarg;
3955         case TOK_TEE:
3956                 action->opcode = O_TEE;
3957                 goto chkarg;
3958         case TOK_CALL:
3959                 action->opcode = O_CALLRETURN;
3960 chkarg:
3961                 if (!av[0])
3962                         errx(EX_USAGE, "missing argument for %s", *(av - 1));
3963                 if (isdigit(**av)) {
3964                         action->arg1 = strtoul(*av, NULL, 10);
3965                         if (action->arg1 <= 0 || action->arg1 >= IP_FW_TABLEARG)
3966                                 errx(EX_DATAERR, "illegal argument for %s",
3967                                     *(av - 1));
3968                 } else if (_substrcmp(*av, "tablearg") == 0) {
3969                         action->arg1 = IP_FW_TARG;
3970                 } else if (i == TOK_DIVERT || i == TOK_TEE) {
3971                         struct servent *s;
3972                         setservent(1);
3973                         s = getservbyname(av[0], "divert");
3974                         if (s != NULL)
3975                                 action->arg1 = ntohs(s->s_port);
3976                         else
3977                                 errx(EX_DATAERR, "illegal divert/tee port");
3978                 } else
3979                         errx(EX_DATAERR, "illegal argument for %s", *(av - 1));
3980                 av++;
3981                 break;
3982
3983         case TOK_FORWARD: {
3984                 /*
3985                  * Locate the address-port separator (':' or ',').
3986                  * Could be one of the following:
3987                  *      hostname:port
3988                  *      IPv4 a.b.c.d,port
3989                  *      IPv4 a.b.c.d:port
3990                  *      IPv6 w:x:y::z,port
3991                  * The ':' can only be used with hostname and IPv4 address.
3992                  * XXX-BZ Should we also support [w:x:y::z]:port?
3993                  */
3994                 struct sockaddr_storage result;
3995                 struct addrinfo *res;
3996                 char *s, *end;
3997                 int family;
3998                 u_short port_number;
3999
4000                 NEED1("missing forward address[:port]");
4001
4002                 /*
4003                  * locate the address-port separator (':' or ',')
4004                  */
4005                 s = strchr(*av, ',');
4006                 if (s == NULL) {
4007                         /* Distinguish between IPv4:port and IPv6 cases. */
4008                         s = strchr(*av, ':');
4009                         if (s && strchr(s+1, ':'))
4010                                 s = NULL; /* no port */
4011                 }
4012
4013                 port_number = 0;
4014                 if (s != NULL) {
4015                         /* Terminate host portion and set s to start of port. */
4016                         *(s++) = '\0';
4017                         i = strtoport(s, &end, 0 /* base */, 0 /* proto */);
4018                         if (s == end)
4019                                 errx(EX_DATAERR,
4020                                     "illegal forwarding port ``%s''", s);
4021                         port_number = (u_short)i;
4022                 }
4023
4024                 if (_substrcmp(*av, "tablearg") == 0) {
4025                         family = PF_INET;
4026                         ((struct sockaddr_in*)&result)->sin_addr.s_addr =
4027                             INADDR_ANY;
4028                 } else {
4029                         /*
4030                          * Resolve the host name or address to a family and a
4031                          * network representation of the address.
4032                          */
4033                         if (getaddrinfo(*av, NULL, NULL, &res))
4034                                 errx(EX_DATAERR, NULL);
4035                         /* Just use the first host in the answer. */
4036                         family = res->ai_family;
4037                         memcpy(&result, res->ai_addr, res->ai_addrlen);
4038                         freeaddrinfo(res);
4039                 }
4040
4041                 if (family == PF_INET) {
4042                         ipfw_insn_sa *p = (ipfw_insn_sa *)action;
4043
4044                         action->opcode = O_FORWARD_IP;
4045                         action->len = F_INSN_SIZE(ipfw_insn_sa);
4046                         CHECK_ACTLEN;
4047
4048                         /*
4049                          * In the kernel we assume AF_INET and use only
4050                          * sin_port and sin_addr. Remember to set sin_len as
4051                          * the routing code seems to use it too.
4052                          */
4053                         p->sa.sin_len = sizeof(struct sockaddr_in);
4054                         p->sa.sin_family = AF_INET;
4055                         p->sa.sin_port = port_number;
4056                         p->sa.sin_addr.s_addr =
4057                              ((struct sockaddr_in *)&result)->sin_addr.s_addr;
4058                 } else if (family == PF_INET6) {
4059                         ipfw_insn_sa6 *p = (ipfw_insn_sa6 *)action;
4060
4061                         action->opcode = O_FORWARD_IP6;
4062                         action->len = F_INSN_SIZE(ipfw_insn_sa6);
4063                         CHECK_ACTLEN;
4064
4065                         p->sa.sin6_len = sizeof(struct sockaddr_in6);
4066                         p->sa.sin6_family = AF_INET6;
4067                         p->sa.sin6_port = port_number;
4068                         p->sa.sin6_flowinfo = 0;
4069                         p->sa.sin6_scope_id =
4070                             ((struct sockaddr_in6 *)&result)->sin6_scope_id;
4071                         bcopy(&((struct sockaddr_in6*)&result)->sin6_addr,
4072                             &p->sa.sin6_addr, sizeof(p->sa.sin6_addr));
4073                 } else {
4074                         errx(EX_DATAERR, "Invalid address family in forward action");
4075                 }
4076                 av++;
4077                 break;
4078             }
4079         case TOK_COMMENT:
4080                 /* pretend it is a 'count' rule followed by the comment */
4081                 action->opcode = O_COUNT;
4082                 av--;           /* go back... */
4083                 break;
4084
4085         case TOK_SETFIB:
4086             {
4087                 int numfibs;
4088                 size_t intsize = sizeof(int);
4089
4090                 action->opcode = O_SETFIB;
4091                 NEED1("missing fib number");
4092                 if (_substrcmp(*av, "tablearg") == 0) {
4093                         action->arg1 = IP_FW_TARG;
4094                 } else {
4095                         action->arg1 = strtoul(*av, NULL, 10);
4096                         if (sysctlbyname("net.fibs", &numfibs, &intsize,
4097                             NULL, 0) == -1)
4098                                 errx(EX_DATAERR, "fibs not suported.\n");
4099                         if (action->arg1 >= numfibs)  /* Temporary */
4100                                 errx(EX_DATAERR, "fib too large.\n");
4101                         /* Add high-order bit to fib to make room for tablearg*/
4102                         action->arg1 |= 0x8000;
4103                 }
4104                 av++;
4105                 break;
4106             }
4107
4108         case TOK_SETDSCP:
4109             {
4110                 int code;
4111
4112                 action->opcode = O_SETDSCP;
4113                 NEED1("missing DSCP code");
4114                 if (_substrcmp(*av, "tablearg") == 0) {
4115                         action->arg1 = IP_FW_TARG;
4116                 } else {
4117                         if (isalpha(*av[0])) {
4118                                 if ((code = match_token(f_ipdscp, *av)) == -1)
4119                                         errx(EX_DATAERR, "Unknown DSCP code");
4120                                 action->arg1 = code;
4121                         } else
4122                                 action->arg1 = strtoul(*av, NULL, 10);
4123                         /*
4124                          * Add high-order bit to DSCP to make room
4125                          * for tablearg
4126                          */
4127                         action->arg1 |= 0x8000;
4128                 }
4129                 av++;
4130                 break;
4131             }
4132
4133         case TOK_REASS:
4134                 action->opcode = O_REASS;
4135                 break;
4136
4137         case TOK_RETURN:
4138                 fill_cmd(action, O_CALLRETURN, F_NOT, 0);
4139                 break;
4140
4141         case TOK_TCPSETMSS: {
4142                 u_long mss;
4143                 uint16_t idx;
4144
4145                 idx = pack_object(tstate, "tcp-setmss", IPFW_TLV_EACTION);
4146                 if (idx == 0)
4147                         errx(EX_DATAERR, "pack_object failed");
4148                 fill_cmd(action, O_EXTERNAL_ACTION, 0, idx);
4149                 NEED1("Missing MSS value");
4150                 action = next_cmd(action, &ablen);
4151                 action->len = 1;
4152                 CHECK_ACTLEN;
4153                 mss = strtoul(*av, NULL, 10);
4154                 if (mss == 0 || mss > UINT16_MAX)
4155                         errx(EX_USAGE, "invalid MSS value %s", *av);
4156                 fill_cmd(action, O_EXTERNAL_DATA, 0, (uint16_t)mss);
4157                 av++;
4158                 break;
4159         }
4160
4161         default:
4162                 av--;
4163                 if (match_token(rule_eactions, *av) == -1)
4164                         errx(EX_DATAERR, "invalid action %s\n", *av);
4165                 /*
4166                  * External actions support.
4167                  * XXX: we support only syntax with instance name.
4168                  *      For known external actions (from rule_eactions list)
4169                  *      we can handle syntax directly. But with `eaction'
4170                  *      keyword we can use only `eaction <name> <instance>'
4171                  *      syntax.
4172                  */
4173         case TOK_EACTION: {
4174                 uint16_t idx;
4175
4176                 NEED1("Missing eaction name");
4177                 if (eaction_check_name(*av) != 0)
4178                         errx(EX_DATAERR, "Invalid eaction name %s", *av);
4179                 idx = pack_object(tstate, *av, IPFW_TLV_EACTION);
4180                 if (idx == 0)
4181                         errx(EX_DATAERR, "pack_object failed");
4182                 fill_cmd(action, O_EXTERNAL_ACTION, 0, idx);
4183                 av++;
4184                 NEED1("Missing eaction instance name");
4185                 action = next_cmd(action, &ablen);
4186                 action->len = 1;
4187                 CHECK_ACTLEN;
4188                 if (eaction_check_name(*av) != 0)
4189                         errx(EX_DATAERR, "Invalid eaction instance name %s",
4190                             *av);
4191                 /*
4192                  * External action instance object has TLV type depended
4193                  * from the external action name object index. Since we
4194                  * currently don't know this index, use zero as TLV type.
4195                  */
4196                 idx = pack_object(tstate, *av, 0);
4197                 if (idx == 0)
4198                         errx(EX_DATAERR, "pack_object failed");
4199                 fill_cmd(action, O_EXTERNAL_INSTANCE, 0, idx);
4200                 av++;
4201                 }
4202         }
4203         action = next_cmd(action, &ablen);
4204
4205         /*
4206          * [altq queuename] -- altq tag, optional
4207          * [log [logamount N]]  -- log, optional
4208          *
4209          * If they exist, it go first in the cmdbuf, but then it is
4210          * skipped in the copy section to the end of the buffer.
4211          */
4212         while (av[0] != NULL && (i = match_token(rule_action_params, *av)) != -1) {
4213                 av++;
4214                 switch (i) {
4215                 case TOK_LOG:
4216                     {
4217                         ipfw_insn_log *c = (ipfw_insn_log *)cmd;
4218                         int l;
4219
4220                         if (have_log)
4221                                 errx(EX_DATAERR,
4222                                     "log cannot be specified more than once");
4223                         have_log = (ipfw_insn *)c;
4224                         cmd->len = F_INSN_SIZE(ipfw_insn_log);
4225                         CHECK_CMDLEN;
4226                         cmd->opcode = O_LOG;
4227                         if (av[0] && _substrcmp(*av, "logamount") == 0) {
4228                                 av++;
4229                                 NEED1("logamount requires argument");
4230                                 l = atoi(*av);
4231                                 if (l < 0)
4232                                         errx(EX_DATAERR,
4233                                             "logamount must be positive");
4234                                 c->max_log = l;
4235                                 av++;
4236                         } else {
4237                                 len = sizeof(c->max_log);
4238                                 if (sysctlbyname("net.inet.ip.fw.verbose_limit",
4239                                     &c->max_log, &len, NULL, 0) == -1) {
4240                                         if (co.test_only) {
4241                                                 c->max_log = 0;
4242                                                 break;
4243                                         }
4244                                         errx(1, "sysctlbyname(\"%s\")",
4245                                             "net.inet.ip.fw.verbose_limit");
4246                                 }
4247                         }
4248                     }
4249                         break;
4250
4251 #ifndef NO_ALTQ
4252                 case TOK_ALTQ:
4253                     {
4254                         ipfw_insn_altq *a = (ipfw_insn_altq *)cmd;
4255
4256                         NEED1("missing altq queue name");
4257                         if (have_altq)
4258                                 errx(EX_DATAERR,
4259                                     "altq cannot be specified more than once");
4260                         have_altq = (ipfw_insn *)a;
4261                         cmd->len = F_INSN_SIZE(ipfw_insn_altq);
4262                         CHECK_CMDLEN;
4263                         cmd->opcode = O_ALTQ;
4264                         a->qid = altq_name_to_qid(*av);
4265                         av++;
4266                     }
4267                         break;
4268 #endif
4269
4270                 case TOK_TAG:
4271                 case TOK_UNTAG: {
4272                         uint16_t tag;
4273
4274                         if (have_tag)
4275                                 errx(EX_USAGE, "tag and untag cannot be "
4276                                     "specified more than once");
4277                         GET_UINT_ARG(tag, IPFW_ARG_MIN, IPFW_ARG_MAX, i,
4278                            rule_action_params);
4279                         have_tag = cmd;
4280                         fill_cmd(cmd, O_TAG, (i == TOK_TAG) ? 0: F_NOT, tag);
4281                         av++;
4282                         break;
4283                 }
4284
4285                 default:
4286                         abort();
4287                 }
4288                 cmd = next_cmd(cmd, &cblen);
4289         }
4290
4291         if (have_state) { /* must be a check-state, we are done */
4292                 if (*av != NULL &&
4293                     match_token(rule_options, *av) == TOK_COMMENT) {
4294                         /* check-state has a comment */
4295                         av++;
4296                         fill_comment(cmd, av, cblen);
4297                         cmd = next_cmd(cmd, &cblen);
4298                         av[0] = NULL;
4299                 }
4300                 goto done;
4301         }
4302
4303 #define OR_START(target)                                        \
4304         if (av[0] && (*av[0] == '(' || *av[0] == '{')) {        \
4305                 if (open_par)                                   \
4306                         errx(EX_USAGE, "nested \"(\" not allowed\n"); \
4307                 prev = NULL;                                    \
4308                 open_par = 1;                                   \
4309                 if ( (av[0])[1] == '\0') {                      \
4310                         av++;                                   \
4311                 } else                                          \
4312                         (*av)++;                                \
4313         }                                                       \
4314         target:                                                 \
4315
4316
4317 #define CLOSE_PAR                                               \
4318         if (open_par) {                                         \
4319                 if (av[0] && (                                  \
4320                     strcmp(*av, ")") == 0 ||                    \
4321                     strcmp(*av, "}") == 0)) {                   \
4322                         prev = NULL;                            \
4323                         open_par = 0;                           \
4324                         av++;                                   \
4325                 } else                                          \
4326                         errx(EX_USAGE, "missing \")\"\n");      \
4327         }
4328
4329 #define NOT_BLOCK                                               \
4330         if (av[0] && _substrcmp(*av, "not") == 0) {             \
4331                 if (cmd->len & F_NOT)                           \
4332                         errx(EX_USAGE, "double \"not\" not allowed\n"); \
4333                 cmd->len |= F_NOT;                              \
4334                 av++;                                           \
4335         }
4336
4337 #define OR_BLOCK(target)                                        \
4338         if (av[0] && _substrcmp(*av, "or") == 0) {              \
4339                 if (prev == NULL || open_par == 0)              \
4340                         errx(EX_DATAERR, "invalid OR block");   \
4341                 prev->len |= F_OR;                              \
4342                 av++;                                   \
4343                 goto target;                                    \
4344         }                                                       \
4345         CLOSE_PAR;
4346
4347         first_cmd = cmd;
4348
4349 #if 0
4350         /*
4351          * MAC addresses, optional.
4352          * If we have this, we skip the part "proto from src to dst"
4353          * and jump straight to the option parsing.
4354          */
4355         NOT_BLOCK;
4356         NEED1("missing protocol");
4357         if (_substrcmp(*av, "MAC") == 0 ||
4358             _substrcmp(*av, "mac") == 0) {
4359                 av++;                   /* the "MAC" keyword */
4360                 add_mac(cmd, av);       /* exits in case of errors */
4361                 cmd = next_cmd(cmd);
4362                 av += 2;                /* dst-mac and src-mac */
4363                 NOT_BLOCK;
4364                 NEED1("missing mac type");
4365                 if (add_mactype(cmd, av[0]))
4366                         cmd = next_cmd(cmd);
4367                 av++;                   /* any or mac-type */
4368                 goto read_options;
4369         }
4370 #endif
4371
4372         /*
4373          * protocol, mandatory
4374          */
4375     OR_START(get_proto);
4376         NOT_BLOCK;
4377         NEED1("missing protocol");
4378         if (add_proto_compat(cmd, *av, &proto)) {
4379                 av++;
4380                 if (F_LEN(cmd) != 0) {
4381                         prev = cmd;
4382                         cmd = next_cmd(cmd, &cblen);
4383                 }
4384         } else if (first_cmd != cmd) {
4385                 errx(EX_DATAERR, "invalid protocol ``%s''", *av);
4386         } else {
4387                 rule->flags |= IPFW_RULE_JUSTOPTS;
4388                 goto read_options;
4389         }
4390     OR_BLOCK(get_proto);
4391
4392         /*
4393          * "from", mandatory
4394          */
4395         if ((av[0] == NULL) || _substrcmp(*av, "from") != 0)
4396                 errx(EX_USAGE, "missing ``from''");
4397         av++;
4398
4399         /*
4400          * source IP, mandatory
4401          */
4402     OR_START(source_ip);
4403         NOT_BLOCK;      /* optional "not" */
4404         NEED1("missing source address");
4405         if (add_src(cmd, *av, proto, cblen, tstate)) {
4406                 av++;
4407                 if (F_LEN(cmd) != 0) {  /* ! any */
4408                         prev = cmd;
4409                         cmd = next_cmd(cmd, &cblen);
4410                 }
4411         } else
4412                 errx(EX_USAGE, "bad source address %s", *av);
4413     OR_BLOCK(source_ip);
4414
4415         /*
4416          * source ports, optional
4417          */
4418         NOT_BLOCK;      /* optional "not" */
4419         if ( av[0] != NULL ) {
4420                 if (_substrcmp(*av, "any") == 0 ||
4421                     add_ports(cmd, *av, proto, O_IP_SRCPORT, cblen)) {
4422                         av++;
4423                         if (F_LEN(cmd) != 0)
4424                                 cmd = next_cmd(cmd, &cblen);
4425                 }
4426         }
4427
4428         /*
4429          * "to", mandatory
4430          */
4431         if ( (av[0] == NULL) || _substrcmp(*av, "to") != 0 )
4432                 errx(EX_USAGE, "missing ``to''");
4433         av++;
4434
4435         /*
4436          * destination, mandatory
4437          */
4438     OR_START(dest_ip);
4439         NOT_BLOCK;      /* optional "not" */
4440         NEED1("missing dst address");
4441         if (add_dst(cmd, *av, proto, cblen, tstate)) {
4442                 av++;
4443                 if (F_LEN(cmd) != 0) {  /* ! any */
4444                         prev = cmd;
4445                         cmd = next_cmd(cmd, &cblen);
4446                 }
4447         } else
4448                 errx( EX_USAGE, "bad destination address %s", *av);
4449     OR_BLOCK(dest_ip);
4450
4451         /*
4452          * dest. ports, optional
4453          */
4454         NOT_BLOCK;      /* optional "not" */
4455         if (av[0]) {
4456                 if (_substrcmp(*av, "any") == 0 ||
4457                     add_ports(cmd, *av, proto, O_IP_DSTPORT, cblen)) {
4458                         av++;
4459                         if (F_LEN(cmd) != 0)
4460                                 cmd = next_cmd(cmd, &cblen);
4461                 }
4462         }
4463
4464 read_options:
4465         prev = NULL;
4466         while ( av[0] != NULL ) {
4467                 char *s;
4468                 ipfw_insn_u32 *cmd32;   /* alias for cmd */
4469
4470                 s = *av;
4471                 cmd32 = (ipfw_insn_u32 *)cmd;
4472
4473                 if (*s == '!') {        /* alternate syntax for NOT */
4474                         if (cmd->len & F_NOT)
4475                                 errx(EX_USAGE, "double \"not\" not allowed\n");
4476                         cmd->len = F_NOT;
4477                         s++;
4478                 }
4479                 i = match_token(rule_options, s);
4480                 av++;
4481                 switch(i) {
4482                 case TOK_NOT:
4483                         if (cmd->len & F_NOT)
4484                                 errx(EX_USAGE, "double \"not\" not allowed\n");
4485                         cmd->len = F_NOT;
4486                         break;
4487
4488                 case TOK_OR:
4489                         if (open_par == 0 || prev == NULL)
4490                                 errx(EX_USAGE, "invalid \"or\" block\n");
4491                         prev->len |= F_OR;
4492                         break;
4493
4494                 case TOK_STARTBRACE:
4495                         if (open_par)
4496                                 errx(EX_USAGE, "+nested \"(\" not allowed\n");
4497                         open_par = 1;
4498                         break;
4499
4500                 case TOK_ENDBRACE:
4501                         if (!open_par)
4502                                 errx(EX_USAGE, "+missing \")\"\n");
4503                         open_par = 0;
4504                         prev = NULL;
4505                         break;
4506
4507                 case TOK_IN:
4508                         fill_cmd(cmd, O_IN, 0, 0);
4509                         break;
4510
4511                 case TOK_OUT:
4512                         cmd->len ^= F_NOT; /* toggle F_NOT */
4513                         fill_cmd(cmd, O_IN, 0, 0);
4514                         break;
4515
4516                 case TOK_DIVERTED:
4517                         fill_cmd(cmd, O_DIVERTED, 0, 3);
4518                         break;
4519
4520                 case TOK_DIVERTEDLOOPBACK:
4521                         fill_cmd(cmd, O_DIVERTED, 0, 1);
4522                         break;
4523
4524                 case TOK_DIVERTEDOUTPUT:
4525                         fill_cmd(cmd, O_DIVERTED, 0, 2);
4526                         break;
4527
4528                 case TOK_FRAG:
4529                         fill_cmd(cmd, O_FRAG, 0, 0);
4530                         break;
4531
4532                 case TOK_LAYER2:
4533                         fill_cmd(cmd, O_LAYER2, 0, 0);
4534                         break;
4535
4536                 case TOK_XMIT:
4537                 case TOK_RECV:
4538                 case TOK_VIA:
4539                         NEED1("recv, xmit, via require interface name"
4540                                 " or address");
4541                         fill_iface((ipfw_insn_if *)cmd, av[0], cblen, tstate);
4542                         av++;
4543                         if (F_LEN(cmd) == 0)    /* not a valid address */
4544                                 break;
4545                         if (i == TOK_XMIT)
4546                                 cmd->opcode = O_XMIT;
4547                         else if (i == TOK_RECV)
4548                                 cmd->opcode = O_RECV;
4549                         else if (i == TOK_VIA)
4550                                 cmd->opcode = O_VIA;
4551                         break;
4552
4553                 case TOK_ICMPTYPES:
4554                         NEED1("icmptypes requires list of types");
4555                         fill_icmptypes((ipfw_insn_u32 *)cmd, *av);
4556                         av++;
4557                         break;
4558
4559                 case TOK_ICMP6TYPES:
4560                         NEED1("icmptypes requires list of types");
4561                         fill_icmp6types((ipfw_insn_icmp6 *)cmd, *av, cblen);
4562                         av++;
4563                         break;
4564
4565                 case TOK_IPTTL:
4566                         NEED1("ipttl requires TTL");
4567                         if (strpbrk(*av, "-,")) {
4568                             if (!add_ports(cmd, *av, 0, O_IPTTL, cblen))
4569                                 errx(EX_DATAERR, "invalid ipttl %s", *av);
4570                         } else
4571                             fill_cmd(cmd, O_IPTTL, 0, strtoul(*av, NULL, 0));
4572                         av++;
4573                         break;
4574
4575                 case TOK_IPID:
4576                         NEED1("ipid requires id");
4577                         if (strpbrk(*av, "-,")) {
4578                             if (!add_ports(cmd, *av, 0, O_IPID, cblen))
4579                                 errx(EX_DATAERR, "invalid ipid %s", *av);
4580                         } else
4581                             fill_cmd(cmd, O_IPID, 0, strtoul(*av, NULL, 0));
4582                         av++;
4583                         break;
4584
4585                 case TOK_IPLEN:
4586                         NEED1("iplen requires length");
4587                         if (strpbrk(*av, "-,")) {
4588                             if (!add_ports(cmd, *av, 0, O_IPLEN, cblen))
4589                                 errx(EX_DATAERR, "invalid ip len %s", *av);
4590                         } else
4591                             fill_cmd(cmd, O_IPLEN, 0, strtoul(*av, NULL, 0));
4592                         av++;
4593                         break;
4594
4595                 case TOK_IPVER:
4596                         NEED1("ipver requires version");
4597                         fill_cmd(cmd, O_IPVER, 0, strtoul(*av, NULL, 0));
4598                         av++;
4599                         break;
4600
4601                 case TOK_IPPRECEDENCE:
4602                         NEED1("ipprecedence requires value");
4603                         fill_cmd(cmd, O_IPPRECEDENCE, 0,
4604                             (strtoul(*av, NULL, 0) & 7) << 5);
4605                         av++;
4606                         break;
4607
4608                 case TOK_DSCP:
4609                         NEED1("missing DSCP code");
4610                         fill_dscp(cmd, *av, cblen);
4611                         av++;
4612                         break;
4613
4614                 case TOK_IPOPTS:
4615                         NEED1("missing argument for ipoptions");
4616                         fill_flags_cmd(cmd, O_IPOPT, f_ipopts, *av);
4617                         av++;
4618                         break;
4619
4620                 case TOK_IPTOS:
4621                         NEED1("missing argument for iptos");
4622                         fill_flags_cmd(cmd, O_IPTOS, f_iptos, *av);
4623                         av++;
4624                         break;
4625
4626                 case TOK_UID:
4627                         NEED1("uid requires argument");
4628                     {
4629                         char *end;
4630                         uid_t uid;
4631                         struct passwd *pwd;
4632
4633                         cmd->opcode = O_UID;
4634                         uid = strtoul(*av, &end, 0);
4635                         pwd = (*end == '\0') ? getpwuid(uid) : getpwnam(*av);
4636                         if (pwd == NULL)
4637                                 errx(EX_DATAERR, "uid \"%s\" nonexistent", *av);
4638                         cmd32->d[0] = pwd->pw_uid;
4639                         cmd->len |= F_INSN_SIZE(ipfw_insn_u32);
4640                         av++;
4641                     }
4642                         break;
4643
4644                 case TOK_GID:
4645                         NEED1("gid requires argument");
4646                     {
4647                         char *end;
4648                         gid_t gid;
4649                         struct group *grp;
4650
4651                         cmd->opcode = O_GID;
4652                         gid = strtoul(*av, &end, 0);
4653                         grp = (*end == '\0') ? getgrgid(gid) : getgrnam(*av);
4654                         if (grp == NULL)
4655                                 errx(EX_DATAERR, "gid \"%s\" nonexistent", *av);
4656                         cmd32->d[0] = grp->gr_gid;
4657                         cmd->len |= F_INSN_SIZE(ipfw_insn_u32);
4658                         av++;
4659                     }
4660                         break;
4661
4662                 case TOK_JAIL:
4663                         NEED1("jail requires argument");
4664                     {
4665                         char *end;
4666                         int jid;
4667
4668                         cmd->opcode = O_JAIL;
4669                         /*
4670                          * If av is a number, then we'll just pass it as-is.  If
4671                          * it's a name, try to resolve that to a jid.
4672                          *
4673                          * We save the jail_getid(3) call for a fallback because
4674                          * it entails an unconditional trip to the kernel to
4675                          * either validate a jid or resolve a name to a jid.
4676                          * This specific token doesn't currently require a
4677                          * jid to be an active jail, so we save a transition
4678                          * by simply using a number that we're given.
4679                          */
4680                         jid = strtoul(*av, &end, 10);
4681                         if (*end != '\0') {
4682                                 jid = jail_getid(*av);
4683                                 if (jid < 0)
4684                                     errx(EX_DATAERR, "%s", jail_errmsg);
4685                         }
4686                         cmd32->d[0] = (uint32_t)jid;
4687                         cmd->len |= F_INSN_SIZE(ipfw_insn_u32);
4688                         av++;
4689                     }
4690                         break;
4691
4692                 case TOK_ESTAB:
4693                         fill_cmd(cmd, O_ESTAB, 0, 0);
4694                         break;
4695
4696                 case TOK_SETUP:
4697                         fill_cmd(cmd, O_TCPFLAGS, 0,
4698                                 (TH_SYN) | ( (TH_ACK) & 0xff) <<8 );
4699                         break;
4700
4701                 case TOK_TCPDATALEN:
4702                         NEED1("tcpdatalen requires length");
4703                         if (strpbrk(*av, "-,")) {
4704                             if (!add_ports(cmd, *av, 0, O_TCPDATALEN, cblen))
4705                                 errx(EX_DATAERR, "invalid tcpdata len %s", *av);
4706                         } else
4707                             fill_cmd(cmd, O_TCPDATALEN, 0,
4708                                     strtoul(*av, NULL, 0));
4709                         av++;
4710                         break;
4711
4712                 case TOK_TCPOPTS:
4713                         NEED1("missing argument for tcpoptions");
4714                         fill_flags_cmd(cmd, O_TCPOPTS, f_tcpopts, *av);
4715                         av++;
4716                         break;
4717
4718                 case TOK_TCPSEQ:
4719                 case TOK_TCPACK:
4720                         NEED1("tcpseq/tcpack requires argument");
4721                         cmd->len = F_INSN_SIZE(ipfw_insn_u32);
4722                         cmd->opcode = (i == TOK_TCPSEQ) ? O_TCPSEQ : O_TCPACK;
4723                         cmd32->d[0] = htonl(strtoul(*av, NULL, 0));
4724                         av++;
4725                         break;
4726
4727                 case TOK_TCPWIN:
4728                         NEED1("tcpwin requires length");
4729                         if (strpbrk(*av, "-,")) {
4730                             if (!add_ports(cmd, *av, 0, O_TCPWIN, cblen))
4731                                 errx(EX_DATAERR, "invalid tcpwin len %s", *av);
4732                         } else
4733                             fill_cmd(cmd, O_TCPWIN, 0,
4734                                     strtoul(*av, NULL, 0));
4735                         av++;
4736                         break;
4737
4738                 case TOK_TCPFLAGS:
4739                         NEED1("missing argument for tcpflags");
4740                         cmd->opcode = O_TCPFLAGS;
4741                         fill_flags_cmd(cmd, O_TCPFLAGS, f_tcpflags, *av);
4742                         av++;
4743                         break;
4744
4745                 case TOK_KEEPSTATE:
4746                 case TOK_RECORDSTATE: {
4747                         uint16_t uidx;
4748
4749                         if (open_par)
4750                                 errx(EX_USAGE, "keep-state or record-state cannot be part "
4751                                     "of an or block");
4752                         if (have_state)
4753                                 errx(EX_USAGE, "only one of keep-state, record-state, "
4754                                         " limit and set-limit is allowed");
4755                         if (*av != NULL && *av[0] == ':') {
4756                                 if (state_check_name(*av + 1) != 0)
4757                                         errx(EX_DATAERR,
4758                                             "Invalid state name %s", *av);
4759                                 uidx = pack_object(tstate, *av + 1,
4760                                     IPFW_TLV_STATE_NAME);
4761                                 av++;
4762                         } else
4763                                 uidx = pack_object(tstate, default_state_name,
4764                                     IPFW_TLV_STATE_NAME);
4765                         have_state = cmd;
4766                         have_rstate = i == TOK_RECORDSTATE;
4767                         fill_cmd(cmd, O_KEEP_STATE, 0, uidx);
4768                         break;
4769                 }
4770
4771                 case TOK_LIMIT:
4772                 case TOK_SETLIMIT: {
4773                         ipfw_insn_limit *c = (ipfw_insn_limit *)cmd;
4774                         int val;
4775
4776                         if (open_par)
4777                                 errx(EX_USAGE,
4778                                     "limit or set-limit cannot be part of an or block");
4779                         if (have_state)
4780                                 errx(EX_USAGE, "only one of keep-state, record-state, "
4781                                         " limit and set-limit is allowed");
4782                         have_state = cmd;
4783                         have_rstate = i == TOK_SETLIMIT;
4784
4785                         cmd->len = F_INSN_SIZE(ipfw_insn_limit);
4786                         CHECK_CMDLEN;
4787                         cmd->opcode = O_LIMIT;
4788                         c->limit_mask = c->conn_limit = 0;
4789
4790                         while ( av[0] != NULL ) {
4791                                 if ((val = match_token(limit_masks, *av)) <= 0)
4792                                         break;
4793                                 c->limit_mask |= val;
4794                                 av++;
4795                         }
4796
4797                         if (c->limit_mask == 0)
4798                                 errx(EX_USAGE, "limit: missing limit mask");
4799
4800                         GET_UINT_ARG(c->conn_limit, IPFW_ARG_MIN, IPFW_ARG_MAX,
4801                             TOK_LIMIT, rule_options);
4802                         av++;
4803
4804                         if (*av != NULL && *av[0] == ':') {
4805                                 if (state_check_name(*av + 1) != 0)
4806                                         errx(EX_DATAERR,
4807                                             "Invalid state name %s", *av);
4808                                 cmd->arg1 = pack_object(tstate, *av + 1,
4809                                     IPFW_TLV_STATE_NAME);
4810                                 av++;
4811                         } else
4812                                 cmd->arg1 = pack_object(tstate,
4813                                     default_state_name, IPFW_TLV_STATE_NAME);
4814                         break;
4815                 }
4816
4817                 case TOK_PROTO:
4818                         NEED1("missing protocol");
4819                         if (add_proto(cmd, *av, &proto)) {
4820                                 av++;
4821                         } else
4822                                 errx(EX_DATAERR, "invalid protocol ``%s''",
4823                                     *av);
4824                         break;
4825
4826                 case TOK_SRCIP:
4827                         NEED1("missing source IP");
4828                         if (add_srcip(cmd, *av, cblen, tstate)) {
4829                                 av++;
4830                         }
4831                         break;
4832
4833                 case TOK_DSTIP:
4834                         NEED1("missing destination IP");
4835                         if (add_dstip(cmd, *av, cblen, tstate)) {
4836                                 av++;
4837                         }
4838                         break;
4839
4840                 case TOK_SRCIP6:
4841                         NEED1("missing source IP6");
4842                         if (add_srcip6(cmd, *av, cblen, tstate)) {
4843                                 av++;
4844                         }
4845                         break;
4846
4847                 case TOK_DSTIP6:
4848                         NEED1("missing destination IP6");
4849                         if (add_dstip6(cmd, *av, cblen, tstate)) {
4850                                 av++;
4851                         }
4852                         break;
4853
4854                 case TOK_SRCPORT:
4855                         NEED1("missing source port");
4856                         if (_substrcmp(*av, "any") == 0 ||
4857                             add_ports(cmd, *av, proto, O_IP_SRCPORT, cblen)) {
4858                                 av++;
4859                         } else
4860                                 errx(EX_DATAERR, "invalid source port %s", *av);
4861                         break;
4862
4863                 case TOK_DSTPORT:
4864                         NEED1("missing destination port");
4865                         if (_substrcmp(*av, "any") == 0 ||
4866                             add_ports(cmd, *av, proto, O_IP_DSTPORT, cblen)) {
4867                                 av++;
4868                         } else
4869                                 errx(EX_DATAERR, "invalid destination port %s",
4870                                     *av);
4871                         break;
4872
4873                 case TOK_MAC:
4874                         if (add_mac(cmd, av, cblen))
4875                                 av += 2;
4876                         break;
4877
4878                 case TOK_MACTYPE:
4879                         NEED1("missing mac type");
4880                         if (!add_mactype(cmd, *av, cblen))
4881                                 errx(EX_DATAERR, "invalid mac type %s", *av);
4882                         av++;
4883                         break;
4884
4885                 case TOK_VERREVPATH:
4886                         fill_cmd(cmd, O_VERREVPATH, 0, 0);
4887                         break;
4888
4889                 case TOK_VERSRCREACH:
4890                         fill_cmd(cmd, O_VERSRCREACH, 0, 0);
4891                         break;
4892
4893                 case TOK_ANTISPOOF:
4894                         fill_cmd(cmd, O_ANTISPOOF, 0, 0);
4895                         break;
4896
4897                 case TOK_IPSEC:
4898                         fill_cmd(cmd, O_IPSEC, 0, 0);
4899                         break;
4900
4901                 case TOK_IPV6:
4902                         fill_cmd(cmd, O_IP6, 0, 0);
4903                         break;
4904
4905                 case TOK_IPV4:
4906                         fill_cmd(cmd, O_IP4, 0, 0);
4907                         break;
4908
4909                 case TOK_EXT6HDR:
4910                         fill_ext6hdr( cmd, *av );
4911                         av++;
4912                         break;
4913
4914                 case TOK_FLOWID:
4915                         if (proto != IPPROTO_IPV6 )
4916                                 errx( EX_USAGE, "flow-id filter is active "
4917                                     "only for ipv6 protocol\n");
4918                         fill_flow6( (ipfw_insn_u32 *) cmd, *av, cblen);
4919                         av++;
4920                         break;
4921
4922                 case TOK_COMMENT:
4923                         fill_comment(cmd, av, cblen);
4924                         av[0]=NULL;
4925                         break;
4926
4927                 case TOK_TAGGED:
4928                         if (av[0] && strpbrk(*av, "-,")) {
4929                                 if (!add_ports(cmd, *av, 0, O_TAGGED, cblen))
4930                                         errx(EX_DATAERR, "tagged: invalid tag"
4931                                             " list: %s", *av);
4932                         }
4933                         else {
4934                                 uint16_t tag;
4935
4936                                 GET_UINT_ARG(tag, IPFW_ARG_MIN, IPFW_ARG_MAX,
4937                                     TOK_TAGGED, rule_options);
4938                                 fill_cmd(cmd, O_TAGGED, 0, tag);
4939                         }
4940                         av++;
4941                         break;
4942
4943                 case TOK_FIB:
4944                         NEED1("fib requires fib number");
4945                         fill_cmd(cmd, O_FIB, 0, strtoul(*av, NULL, 0));
4946                         av++;
4947                         break;
4948                 case TOK_SOCKARG:
4949                         fill_cmd(cmd, O_SOCKARG, 0, 0);
4950                         break;
4951
4952                 case TOK_LOOKUP: {
4953                         ipfw_insn_u32 *c = (ipfw_insn_u32 *)cmd;
4954                         int j;
4955
4956                         if (!av[0] || !av[1])
4957                                 errx(EX_USAGE, "format: lookup argument tablenum");
4958                         cmd->opcode = O_IP_DST_LOOKUP;
4959                         cmd->len |= F_INSN_SIZE(ipfw_insn) + 2;
4960                         i = match_token(rule_options, *av);
4961                         for (j = 0; lookup_key[j] >= 0 ; j++) {
4962                                 if (i == lookup_key[j])
4963                                         break;
4964                         }
4965                         if (lookup_key[j] <= 0)
4966                                 errx(EX_USAGE, "format: cannot lookup on %s", *av);
4967                         __PAST_END(c->d, 1) = j; // i converted to option
4968                         av++;
4969
4970                         if ((j = pack_table(tstate, *av)) == 0)
4971                                 errx(EX_DATAERR, "Invalid table name: %s", *av);
4972
4973                         cmd->arg1 = j;
4974                         av++;
4975                     }
4976                         break;
4977                 case TOK_FLOW:
4978                         NEED1("missing table name");
4979                         if (strncmp(*av, "table(", 6) != 0)
4980                                 errx(EX_DATAERR,
4981                                     "enclose table name into \"table()\"");
4982                         fill_table(cmd, *av, O_IP_FLOW_LOOKUP, tstate);
4983                         av++;
4984                         break;
4985
4986                 case TOK_SKIPACTION:
4987                         if (have_skipcmd)
4988                                 errx(EX_USAGE, "only one defer-action "
4989                                         "is allowed");
4990                         have_skipcmd = cmd;
4991                         fill_cmd(cmd, O_SKIP_ACTION, 0, 0);
4992                         break;
4993
4994                 default:
4995                         errx(EX_USAGE, "unrecognised option [%d] %s\n", i, s);
4996                 }
4997                 if (F_LEN(cmd) > 0) {   /* prepare to advance */
4998                         prev = cmd;
4999                         cmd = next_cmd(cmd, &cblen);
5000                 }
5001         }
5002
5003 done:
5004
5005         if (!have_state && have_skipcmd)
5006                 warnx("Rule contains \"defer-immediate-action\" "
5007                         "and doesn't contain any state-related options.");
5008
5009         /*
5010          * Now copy stuff into the rule.
5011          * If we have a keep-state option, the first instruction
5012          * must be a PROBE_STATE (which is generated here).
5013          * If we have a LOG option, it was stored as the first command,
5014          * and now must be moved to the top of the action part.
5015          */
5016         dst = (ipfw_insn *)rule->cmd;
5017
5018         /*
5019          * First thing to write into the command stream is the match probability.
5020          */
5021         if (match_prob != 1) { /* 1 means always match */
5022                 dst->opcode = O_PROB;
5023                 dst->len = 2;
5024                 *((int32_t *)(dst+1)) = (int32_t)(match_prob * 0x7fffffff);
5025                 dst += dst->len;
5026         }
5027
5028         /*
5029          * generate O_PROBE_STATE if necessary
5030          */
5031         if (have_state && have_state->opcode != O_CHECK_STATE && !have_rstate) {
5032                 fill_cmd(dst, O_PROBE_STATE, 0, have_state->arg1);
5033                 dst = next_cmd(dst, &rblen);
5034         }
5035
5036         /*
5037          * copy all commands but O_LOG, O_KEEP_STATE, O_LIMIT, O_ALTQ, O_TAG,
5038          * O_SKIP_ACTION
5039          */
5040         for (src = (ipfw_insn *)cmdbuf; src != cmd; src += i) {
5041                 i = F_LEN(src);
5042                 CHECK_RBUFLEN(i);
5043
5044                 switch (src->opcode) {
5045                 case O_LOG:
5046                 case O_KEEP_STATE:
5047                 case O_LIMIT:
5048                 case O_ALTQ:
5049                 case O_TAG:
5050                 case O_SKIP_ACTION:
5051                         break;
5052                 default:
5053                         bcopy(src, dst, i * sizeof(uint32_t));
5054                         dst += i;
5055                 }
5056         }
5057
5058         /*
5059          * put back the have_state command as last opcode
5060          */
5061         if (have_state && have_state->opcode != O_CHECK_STATE) {
5062                 i = F_LEN(have_state);
5063                 CHECK_RBUFLEN(i);
5064                 bcopy(have_state, dst, i * sizeof(uint32_t));
5065                 dst += i;
5066         }
5067
5068         /*
5069          * put back the have_skipcmd command as very last opcode
5070          */
5071         if (have_skipcmd) {
5072                 i = F_LEN(have_skipcmd);
5073                 CHECK_RBUFLEN(i);
5074                 bcopy(have_skipcmd, dst, i * sizeof(uint32_t));
5075                 dst += i;
5076         }
5077
5078         /*
5079          * start action section
5080          */
5081         rule->act_ofs = dst - rule->cmd;
5082
5083         /* put back O_LOG, O_ALTQ, O_TAG if necessary */
5084         if (have_log) {
5085                 i = F_LEN(have_log);
5086                 CHECK_RBUFLEN(i);
5087                 bcopy(have_log, dst, i * sizeof(uint32_t));
5088                 dst += i;
5089         }
5090         if (have_altq) {
5091                 i = F_LEN(have_altq);
5092                 CHECK_RBUFLEN(i);
5093                 bcopy(have_altq, dst, i * sizeof(uint32_t));
5094                 dst += i;
5095         }
5096         if (have_tag) {
5097                 i = F_LEN(have_tag);
5098                 CHECK_RBUFLEN(i);
5099                 bcopy(have_tag, dst, i * sizeof(uint32_t));
5100                 dst += i;
5101         }
5102
5103         /*
5104          * copy all other actions
5105          */
5106         for (src = (ipfw_insn *)actbuf; src != action; src += i) {
5107                 i = F_LEN(src);
5108                 CHECK_RBUFLEN(i);
5109                 bcopy(src, dst, i * sizeof(uint32_t));
5110                 dst += i;
5111         }
5112
5113         rule->cmd_len = (uint32_t *)dst - (uint32_t *)(rule->cmd);
5114         *rbufsize = (char *)dst - (char *)rule;
5115 }
5116
5117 static int
5118 compare_ntlv(const void *_a, const void *_b)
5119 {
5120         ipfw_obj_ntlv *a, *b;
5121
5122         a = (ipfw_obj_ntlv *)_a;
5123         b = (ipfw_obj_ntlv *)_b;
5124
5125         if (a->set < b->set)
5126                 return (-1);
5127         else if (a->set > b->set)
5128                 return (1);
5129
5130         if (a->idx < b->idx)
5131                 return (-1);
5132         else if (a->idx > b->idx)
5133                 return (1);
5134
5135         if (a->head.type < b->head.type)
5136                 return (-1);
5137         else if (a->head.type > b->head.type)
5138                 return (1);
5139
5140         return (0);
5141 }
5142
5143 /*
5144  * Provide kernel with sorted list of referenced objects
5145  */
5146 static void
5147 object_sort_ctlv(ipfw_obj_ctlv *ctlv)
5148 {
5149
5150         qsort(ctlv + 1, ctlv->count, ctlv->objsize, compare_ntlv);
5151 }
5152
5153 struct object_kt {
5154         uint16_t        uidx;
5155         uint16_t        type;
5156 };
5157 static int
5158 compare_object_kntlv(const void *k, const void *v)
5159 {
5160         ipfw_obj_ntlv *ntlv;
5161         struct object_kt key;
5162
5163         key = *((struct object_kt *)k);
5164         ntlv = (ipfw_obj_ntlv *)v;
5165
5166         if (key.uidx < ntlv->idx)
5167                 return (-1);
5168         else if (key.uidx > ntlv->idx)
5169                 return (1);
5170
5171         if (key.type < ntlv->head.type)
5172                 return (-1);
5173         else if (key.type > ntlv->head.type)
5174                 return (1);
5175
5176         return (0);
5177 }
5178
5179 /*
5180  * Finds object name in @ctlv by @idx and @type.
5181  * Uses the following facts:
5182  * 1) All TLVs are the same size
5183  * 2) Kernel implementation provides already sorted list.
5184  *
5185  * Returns table name or NULL.
5186  */
5187 static char *
5188 object_search_ctlv(ipfw_obj_ctlv *ctlv, uint16_t idx, uint16_t type)
5189 {
5190         ipfw_obj_ntlv *ntlv;
5191         struct object_kt key;
5192
5193         key.uidx = idx;
5194         key.type = type;
5195
5196         ntlv = bsearch(&key, (ctlv + 1), ctlv->count, ctlv->objsize,
5197             compare_object_kntlv);
5198
5199         if (ntlv != NULL)
5200                 return (ntlv->name);
5201
5202         return (NULL);
5203 }
5204
5205 static char *
5206 table_search_ctlv(ipfw_obj_ctlv *ctlv, uint16_t idx)
5207 {
5208
5209         return (object_search_ctlv(ctlv, idx, IPFW_TLV_TBL_NAME));
5210 }
5211
5212 /*
5213  * Adds one or more rules to ipfw chain.
5214  * Data layout:
5215  * Request:
5216  * [
5217  *   ip_fw3_opheader
5218  *   [ ipfw_obj_ctlv(IPFW_TLV_TBL_LIST) ipfw_obj_ntlv x N ] (optional *1)
5219  *   [ ipfw_obj_ctlv(IPFW_TLV_RULE_LIST) [ ip_fw_rule ip_fw_insn ] x N ] (*2) (*3)
5220  * ]
5221  * Reply:
5222  * [
5223  *   ip_fw3_opheader
5224  *   [ ipfw_obj_ctlv(IPFW_TLV_TBL_LIST) ipfw_obj_ntlv x N ] (optional)
5225  *   [ ipfw_obj_ctlv(IPFW_TLV_RULE_LIST) [ ip_fw_rule ip_fw_insn ] x N ]
5226  * ]
5227  *
5228  * Rules in reply are modified to store their actual ruleset number.
5229  *
5230  * (*1) TLVs inside IPFW_TLV_TBL_LIST needs to be sorted ascending
5231  * according to their idx field and there has to be no duplicates.
5232  * (*2) Numbered rules inside IPFW_TLV_RULE_LIST needs to be sorted ascending.
5233  * (*3) Each ip_fw structure needs to be aligned to u64 boundary.
5234  */
5235 void
5236 ipfw_add(char *av[])
5237 {
5238         uint32_t rulebuf[1024];
5239         int rbufsize, default_off, tlen, rlen;
5240         size_t sz;
5241         struct tidx ts;
5242         struct ip_fw_rule *rule;
5243         caddr_t tbuf;
5244         ip_fw3_opheader *op3;
5245         ipfw_obj_ctlv *ctlv, *tstate;
5246
5247         rbufsize = sizeof(rulebuf);
5248         memset(rulebuf, 0, rbufsize);
5249         memset(&ts, 0, sizeof(ts));
5250
5251         /* Optimize case with no tables */
5252         default_off = sizeof(ipfw_obj_ctlv) + sizeof(ip_fw3_opheader);
5253         op3 = (ip_fw3_opheader *)rulebuf;
5254         ctlv = (ipfw_obj_ctlv *)(op3 + 1);
5255         rule = (struct ip_fw_rule *)(ctlv + 1);
5256         rbufsize -= default_off;
5257
5258         compile_rule(av, (uint32_t *)rule, &rbufsize, &ts);
5259         /* Align rule size to u64 boundary */
5260         rlen = roundup2(rbufsize, sizeof(uint64_t));
5261
5262         tbuf = NULL;
5263         sz = 0;
5264         tstate = NULL;
5265         if (ts.count != 0) {
5266                 /* Some tables. We have to alloc more data */
5267                 tlen = ts.count * sizeof(ipfw_obj_ntlv);
5268                 sz = default_off + sizeof(ipfw_obj_ctlv) + tlen + rlen;
5269
5270                 if ((tbuf = calloc(1, sz)) == NULL)
5271                         err(EX_UNAVAILABLE, "malloc() failed for IP_FW_ADD");
5272                 op3 = (ip_fw3_opheader *)tbuf;
5273                 /* Tables first */
5274                 ctlv = (ipfw_obj_ctlv *)(op3 + 1);
5275                 ctlv->head.type = IPFW_TLV_TBLNAME_LIST;
5276                 ctlv->head.length = sizeof(ipfw_obj_ctlv) + tlen;
5277                 ctlv->count = ts.count;
5278                 ctlv->objsize = sizeof(ipfw_obj_ntlv);
5279                 memcpy(ctlv + 1, ts.idx, tlen);
5280                 object_sort_ctlv(ctlv);
5281                 tstate = ctlv;
5282                 /* Rule next */
5283                 ctlv = (ipfw_obj_ctlv *)((caddr_t)ctlv + ctlv->head.length);
5284                 ctlv->head.type = IPFW_TLV_RULE_LIST;
5285                 ctlv->head.length = sizeof(ipfw_obj_ctlv) + rlen;
5286                 ctlv->count = 1;
5287                 memcpy(ctlv + 1, rule, rbufsize);
5288         } else {
5289                 /* Simply add header */
5290                 sz = rlen + default_off;
5291                 memset(ctlv, 0, sizeof(*ctlv));
5292                 ctlv->head.type = IPFW_TLV_RULE_LIST;
5293                 ctlv->head.length = sizeof(ipfw_obj_ctlv) + rlen;
5294                 ctlv->count = 1;
5295         }
5296
5297         if (do_get3(IP_FW_XADD, op3, &sz) != 0)
5298                 err(EX_UNAVAILABLE, "getsockopt(%s)", "IP_FW_XADD");
5299
5300         if (!co.do_quiet) {
5301                 struct format_opts sfo;
5302                 struct buf_pr bp;
5303                 memset(&sfo, 0, sizeof(sfo));
5304                 sfo.tstate = tstate;
5305                 sfo.set_mask = (uint32_t)(-1);
5306                 bp_alloc(&bp, 4096);
5307                 show_static_rule(&co, &sfo, &bp, rule, NULL);
5308                 printf("%s", bp.buf);
5309                 bp_free(&bp);
5310         }
5311
5312         if (tbuf != NULL)
5313                 free(tbuf);
5314
5315         if (ts.idx != NULL)
5316                 free(ts.idx);
5317 }
5318
5319 /*
5320  * clear the counters or the log counters.
5321  * optname has the following values:
5322  *  0 (zero both counters and logging)
5323  *  1 (zero logging only)
5324  */
5325 void
5326 ipfw_zero(int ac, char *av[], int optname)
5327 {
5328         ipfw_range_tlv rt;
5329         char const *errstr;
5330         char const *name = optname ? "RESETLOG" : "ZERO";
5331         uint32_t arg;
5332         int failed = EX_OK;
5333
5334         optname = optname ? IP_FW_XRESETLOG : IP_FW_XZERO;
5335         av++; ac--;
5336
5337         if (ac == 0) {
5338                 /* clear all entries */
5339                 memset(&rt, 0, sizeof(rt));
5340                 rt.flags = IPFW_RCFLAG_ALL;
5341                 if (do_range_cmd(optname, &rt) < 0)
5342                         err(EX_UNAVAILABLE, "setsockopt(IP_FW_X%s)", name);
5343                 if (!co.do_quiet)
5344                         printf("%s.\n", optname == IP_FW_XZERO ?
5345                             "Accounting cleared":"Logging counts reset");
5346
5347                 return;
5348         }
5349
5350         while (ac) {
5351                 /* Rule number */
5352                 if (isdigit(**av)) {
5353                         arg = strtonum(*av, 0, 0xffff, &errstr);
5354                         if (errstr)
5355                                 errx(EX_DATAERR,
5356                                     "invalid rule number %s\n", *av);
5357                         memset(&rt, 0, sizeof(rt));
5358                         rt.start_rule = arg;
5359                         rt.end_rule = arg;
5360                         rt.flags |= IPFW_RCFLAG_RANGE;
5361                         if (co.use_set != 0) {
5362                                 rt.set = co.use_set - 1;
5363                                 rt.flags |= IPFW_RCFLAG_SET;
5364                         }
5365                         if (do_range_cmd(optname, &rt) != 0) {
5366                                 warn("rule %u: setsockopt(IP_FW_X%s)",
5367                                     arg, name);
5368                                 failed = EX_UNAVAILABLE;
5369                         } else if (rt.new_set == 0) {
5370                                 printf("Entry %d not found\n", arg);
5371                                 failed = EX_UNAVAILABLE;
5372                         } else if (!co.do_quiet)
5373                                 printf("Entry %d %s.\n", arg,
5374                                     optname == IP_FW_XZERO ?
5375                                         "cleared" : "logging count reset");
5376                 } else {
5377                         errx(EX_USAGE, "invalid rule number ``%s''", *av);
5378                 }
5379                 av++; ac--;
5380         }
5381         if (failed != EX_OK)
5382                 exit(failed);
5383 }
5384
5385 void
5386 ipfw_flush(int force)
5387 {
5388         ipfw_range_tlv rt;
5389
5390         if (!force && !co.do_quiet) { /* need to ask user */
5391                 int c;
5392
5393                 printf("Are you sure? [yn] ");
5394                 fflush(stdout);
5395                 do {
5396                         c = toupper(getc(stdin));
5397                         while (c != '\n' && getc(stdin) != '\n')
5398                                 if (feof(stdin))
5399                                         return; /* and do not flush */
5400                 } while (c != 'Y' && c != 'N');
5401                 printf("\n");
5402                 if (c == 'N')   /* user said no */
5403                         return;
5404         }
5405         if (co.do_pipe) {
5406                 dummynet_flush();
5407                 return;
5408         }
5409         /* `ipfw set N flush` - is the same that `ipfw delete set N` */
5410         memset(&rt, 0, sizeof(rt));
5411         if (co.use_set != 0) {
5412                 rt.set = co.use_set - 1;
5413                 rt.flags = IPFW_RCFLAG_SET;
5414         } else
5415                 rt.flags = IPFW_RCFLAG_ALL;
5416         if (do_range_cmd(IP_FW_XDEL, &rt) != 0)
5417                         err(EX_UNAVAILABLE, "setsockopt(IP_FW_XDEL)");
5418         if (!co.do_quiet)
5419                 printf("Flushed all %s.\n", co.do_pipe ? "pipes" : "rules");
5420 }
5421
5422 static struct _s_x intcmds[] = {
5423       { "talist",       TOK_TALIST },
5424       { "iflist",       TOK_IFLIST },
5425       { "olist",        TOK_OLIST },
5426       { "vlist",        TOK_VLIST },
5427       { NULL, 0 }
5428 };
5429
5430 static struct _s_x otypes[] = {
5431         { "EACTION",    IPFW_TLV_EACTION },
5432         { "DYNSTATE",   IPFW_TLV_STATE_NAME },
5433         { NULL, 0 }
5434 };
5435
5436 static const char*
5437 lookup_eaction_name(ipfw_obj_ntlv *ntlv, int cnt, uint16_t type)
5438 {
5439         const char *name;
5440         int i;
5441
5442         name = NULL;
5443         for (i = 0; i < cnt; i++) {
5444                 if (ntlv[i].head.type != IPFW_TLV_EACTION)
5445                         continue;
5446                 if (IPFW_TLV_EACTION_NAME(ntlv[i].idx) != type)
5447                         continue;
5448                 name = ntlv[i].name;
5449                 break;
5450         }
5451         return (name);
5452 }
5453
5454 static void
5455 ipfw_list_objects(int ac, char *av[])
5456 {
5457         ipfw_obj_lheader req, *olh;
5458         ipfw_obj_ntlv *ntlv;
5459         const char *name;
5460         size_t sz;
5461         int i;
5462
5463         memset(&req, 0, sizeof(req));
5464         sz = sizeof(req);
5465         if (do_get3(IP_FW_DUMP_SRVOBJECTS, &req.opheader, &sz) != 0)
5466                 if (errno != ENOMEM)
5467                         return;
5468
5469         sz = req.size;
5470         if ((olh = calloc(1, sz)) == NULL)
5471                 return;
5472
5473         olh->size = sz;
5474         if (do_get3(IP_FW_DUMP_SRVOBJECTS, &olh->opheader, &sz) != 0) {
5475                 free(olh);
5476                 return;
5477         }
5478
5479         if (olh->count > 0)
5480                 printf("Objects list:\n");
5481         else
5482                 printf("There are no objects\n");
5483         ntlv = (ipfw_obj_ntlv *)(olh + 1);
5484         for (i = 0; i < olh->count; i++) {
5485                 name = match_value(otypes, ntlv->head.type);
5486                 if (name == NULL)
5487                         name = lookup_eaction_name(
5488                             (ipfw_obj_ntlv *)(olh + 1), olh->count,
5489                             ntlv->head.type);
5490                 if (name == NULL)
5491                         printf(" kidx: %4d\ttype: %10d\tname: %s\n",
5492                             ntlv->idx, ntlv->head.type, ntlv->name);
5493                 else
5494                         printf(" kidx: %4d\ttype: %10s\tname: %s\n",
5495                             ntlv->idx, name, ntlv->name);
5496                 ntlv++;
5497         }
5498         free(olh);
5499 }
5500
5501 void
5502 ipfw_internal_handler(int ac, char *av[])
5503 {
5504         int tcmd;
5505
5506         ac--; av++;
5507         NEED1("internal cmd required");
5508
5509         if ((tcmd = match_token(intcmds, *av)) == -1)
5510                 errx(EX_USAGE, "invalid internal sub-cmd: %s", *av);
5511
5512         switch (tcmd) {
5513         case TOK_IFLIST:
5514                 ipfw_list_tifaces();
5515                 break;
5516         case TOK_TALIST:
5517                 ipfw_list_ta(ac, av);
5518                 break;
5519         case TOK_OLIST:
5520                 ipfw_list_objects(ac, av);
5521                 break;
5522         case TOK_VLIST:
5523                 ipfw_list_values(ac, av);
5524                 break;
5525         }
5526 }
5527
5528 static int
5529 ipfw_get_tracked_ifaces(ipfw_obj_lheader **polh)
5530 {
5531         ipfw_obj_lheader req, *olh;
5532         size_t sz;
5533
5534         memset(&req, 0, sizeof(req));
5535         sz = sizeof(req);
5536
5537         if (do_get3(IP_FW_XIFLIST, &req.opheader, &sz) != 0) {
5538                 if (errno != ENOMEM)
5539                         return (errno);
5540         }
5541
5542         sz = req.size;
5543         if ((olh = calloc(1, sz)) == NULL)
5544                 return (ENOMEM);
5545
5546         olh->size = sz;
5547         if (do_get3(IP_FW_XIFLIST, &olh->opheader, &sz) != 0) {
5548                 free(olh);
5549                 return (errno);
5550         }
5551
5552         *polh = olh;
5553         return (0);
5554 }
5555
5556 static int
5557 ifinfo_cmp(const void *a, const void *b)
5558 {
5559         ipfw_iface_info *ia, *ib;
5560
5561         ia = (ipfw_iface_info *)a;
5562         ib = (ipfw_iface_info *)b;
5563
5564         return (stringnum_cmp(ia->ifname, ib->ifname));
5565 }
5566
5567 /*
5568  * Retrieves table list from kernel,
5569  * optionally sorts it and calls requested function for each table.
5570  * Returns 0 on success.
5571  */
5572 static void
5573 ipfw_list_tifaces()
5574 {
5575         ipfw_obj_lheader *olh;
5576         ipfw_iface_info *info;
5577         int i, error;
5578
5579         if ((error = ipfw_get_tracked_ifaces(&olh)) != 0)
5580                 err(EX_OSERR, "Unable to request ipfw tracked interface list");
5581
5582
5583         qsort(olh + 1, olh->count, olh->objsize, ifinfo_cmp);
5584
5585         info = (ipfw_iface_info *)(olh + 1);
5586         for (i = 0; i < olh->count; i++) {
5587                 if (info->flags & IPFW_IFFLAG_RESOLVED)
5588                         printf("%s ifindex: %d refcount: %u changes: %u\n",
5589                             info->ifname, info->ifindex, info->refcnt,
5590                             info->gencnt);
5591                 else
5592                         printf("%s ifindex: unresolved refcount: %u changes: %u\n",
5593                             info->ifname, info->refcnt, info->gencnt);
5594                 info = (ipfw_iface_info *)((caddr_t)info + olh->objsize);
5595         }
5596
5597         free(olh);
5598 }
5599
5600
5601
5602