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