sbin/ipfw/ipfw2.c

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