X-Git-Url: http://git.onelab.eu/?p=iproute2.git;a=blobdiff_plain;f=tc%2Ff_u32.c;fp=tc%2Ff_u32.c;h=0000000000000000000000000000000000000000;hp=9d527fc0744ca4e4f2fca62bebf043d0beb51338;hb=3331a68859fd71047bb1f309048960b48eab2d83;hpb=2bd4a72f2100be7ad7d9518cb1d49bb2a5b71994 diff --git a/tc/f_u32.c b/tc/f_u32.c deleted file mode 100644 index 9d527fc..0000000 --- a/tc/f_u32.c +++ /dev/null @@ -1,1084 +0,0 @@ -/* - * q_u32.c U32 filter. - * - * This program is free software; you can u32istribute it and/or - * modify it under the terms of the GNU General Public License - * as published by the Free Software Foundation; either version - * 2 of the License, or (at your option) any later version. - * - * Authors: Alexey Kuznetsov, - * Match mark added by Catalin(ux aka Dino) BOIE [5 nov 2004] - * - */ - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include "utils.h" -#include "tc_util.h" - -static void explain(void) -{ - fprintf(stderr, "Usage: ... u32 [ match SELECTOR ... ] [ link HTID ] [ classid CLASSID ]\n"); - fprintf(stderr, " [ police POLICE_SPEC ] [ offset OFFSET_SPEC ]\n"); - fprintf(stderr, " [ ht HTID ] [ hashkey HASHKEY_SPEC ]\n"); - fprintf(stderr, " [ sample SAMPLE ]\n"); - fprintf(stderr, "or u32 divisor DIVISOR\n"); - fprintf(stderr, "\n"); - fprintf(stderr, "Where: SELECTOR := SAMPLE SAMPLE ...\n"); - fprintf(stderr, " SAMPLE := { ip | ip6 | udp | tcp | icmp | u{32|16|8} | mark } SAMPLE_ARGS [divisor DIVISOR]\n"); - fprintf(stderr, " FILTERID := X:Y:Z\n"); -} - -#define usage() return(-1) - -int get_u32_handle(__u32 *handle, char *str) -{ - __u32 htid=0, hash=0, nodeid=0; - char *tmp = strchr(str, ':'); - - if (tmp == NULL) { - if (memcmp("0x", str, 2) == 0) - return get_u32(handle, str, 16); - return -1; - } - htid = strtoul(str, &tmp, 16); - if (tmp == str && *str != ':' && *str != 0) - return -1; - if (htid>=0x1000) - return -1; - if (*tmp) { - str = tmp+1; - hash = strtoul(str, &tmp, 16); - if (tmp == str && *str != ':' && *str != 0) - return -1; - if (hash>=0x100) - return -1; - if (*tmp) { - str = tmp+1; - nodeid = strtoul(str, &tmp, 16); - if (tmp == str && *str != 0) - return -1; - if (nodeid>=0x1000) - return -1; - } - } - *handle = (htid<<20)|(hash<<12)|nodeid; - return 0; -} - -char * sprint_u32_handle(__u32 handle, char *buf) -{ - int bsize = SPRINT_BSIZE-1; - __u32 htid = TC_U32_HTID(handle); - __u32 hash = TC_U32_HASH(handle); - __u32 nodeid = TC_U32_NODE(handle); - char *b = buf; - - if (handle == 0) { - snprintf(b, bsize, "none"); - return b; - } - if (htid) { - int l = snprintf(b, bsize, "%x:", htid>>20); - bsize -= l; - b += l; - } - if (nodeid|hash) { - if (hash) { - int l = snprintf(b, bsize, "%x", hash); - bsize -= l; - b += l; - } - if (nodeid) { - int l = snprintf(b, bsize, ":%x", nodeid); - bsize -= l; - b += l; - } - } - if (show_raw) - snprintf(b, bsize, "[%08x] ", handle); - return buf; -} - -static int pack_key(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int offmask) -{ - int i; - int hwm = sel->nkeys; - - key &= mask; - - for (i=0; ikeys[i].off == off && sel->keys[i].offmask == offmask) { - __u32 intersect = mask&sel->keys[i].mask; - - if ((key^sel->keys[i].val) & intersect) - return -1; - sel->keys[i].val |= key; - sel->keys[i].mask |= mask; - return 0; - } - } - - if (hwm >= 128) - return -1; - if (off % 4) - return -1; - sel->keys[hwm].val = key; - sel->keys[hwm].mask = mask; - sel->keys[hwm].off = off; - sel->keys[hwm].offmask = offmask; - sel->nkeys++; - return 0; -} - -static int pack_key32(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int offmask) -{ - key = htonl(key); - mask = htonl(mask); - return pack_key(sel, key, mask, off, offmask); -} - -static int pack_key16(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int offmask) -{ - if (key > 0xFFFF || mask > 0xFFFF) - return -1; - - if ((off & 3) == 0) { - key <<= 16; - mask <<= 16; - } - off &= ~3; - key = htonl(key); - mask = htonl(mask); - - return pack_key(sel, key, mask, off, offmask); -} - -static int pack_key8(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int offmask) -{ - if (key > 0xFF || mask > 0xFF) - return -1; - - if ((off & 3) == 0) { - key <<= 24; - mask <<= 24; - } else if ((off & 3) == 1) { - key <<= 16; - mask <<= 16; - } else if ((off & 3) == 2) { - key <<= 8; - mask <<= 8; - } - off &= ~3; - key = htonl(key); - mask = htonl(mask); - - return pack_key(sel, key, mask, off, offmask); -} - - -int parse_at(int *argc_p, char ***argv_p, int *off, int *offmask) -{ - int argc = *argc_p; - char **argv = *argv_p; - char *p = *argv; - - if (argc <= 0) - return -1; - - if (strlen(p) > strlen("nexthdr+") && - memcmp(p, "nexthdr+", strlen("nexthdr+")) == 0) { - *offmask = -1; - p += strlen("nexthdr+"); - } else if (matches(*argv, "nexthdr+") == 0) { - NEXT_ARG(); - *offmask = -1; - p = *argv; - } - - if (get_integer(off, p, 0)) - return -1; - argc--; argv++; - - *argc_p = argc; - *argv_p = argv; - return 0; -} - - -static int parse_u32(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off, int offmask) -{ - int res = -1; - int argc = *argc_p; - char **argv = *argv_p; - __u32 key; - __u32 mask; - - if (argc < 2) - return -1; - - if (get_u32(&key, *argv, 0)) - return -1; - argc--; argv++; - - if (get_u32(&mask, *argv, 16)) - return -1; - argc--; argv++; - - if (argc > 0 && strcmp(argv[0], "at") == 0) { - NEXT_ARG(); - if (parse_at(&argc, &argv, &off, &offmask)) - return -1; - } - - res = pack_key32(sel, key, mask, off, offmask); - *argc_p = argc; - *argv_p = argv; - return res; -} - -static int parse_u16(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off, int offmask) -{ - int res = -1; - int argc = *argc_p; - char **argv = *argv_p; - __u32 key; - __u32 mask; - - if (argc < 2) - return -1; - - if (get_u32(&key, *argv, 0)) - return -1; - argc--; argv++; - - if (get_u32(&mask, *argv, 16)) - return -1; - argc--; argv++; - - if (argc > 0 && strcmp(argv[0], "at") == 0) { - NEXT_ARG(); - if (parse_at(&argc, &argv, &off, &offmask)) - return -1; - } - res = pack_key16(sel, key, mask, off, offmask); - *argc_p = argc; - *argv_p = argv; - return res; -} - -static int parse_u8(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off, int offmask) -{ - int res = -1; - int argc = *argc_p; - char **argv = *argv_p; - __u32 key; - __u32 mask; - - if (argc < 2) - return -1; - - if (get_u32(&key, *argv, 0)) - return -1; - argc--; argv++; - - if (get_u32(&mask, *argv, 16)) - return -1; - argc--; argv++; - - if (key > 0xFF || mask > 0xFF) - return -1; - - if (argc > 0 && strcmp(argv[0], "at") == 0) { - NEXT_ARG(); - if (parse_at(&argc, &argv, &off, &offmask)) - return -1; - } - - res = pack_key8(sel, key, mask, off, offmask); - *argc_p = argc; - *argv_p = argv; - return res; -} - -static int parse_ip_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off) -{ - int res = -1; - int argc = *argc_p; - char **argv = *argv_p; - inet_prefix addr; - __u32 mask; - int offmask = 0; - - if (argc < 1) - return -1; - - if (get_prefix_1(&addr, *argv, AF_INET)) - return -1; - argc--; argv++; - - if (argc > 0 && strcmp(argv[0], "at") == 0) { - NEXT_ARG(); - if (parse_at(&argc, &argv, &off, &offmask)) - return -1; - } - - mask = 0; - if (addr.bitlen) - mask = htonl(0xFFFFFFFF<<(32-addr.bitlen)); - if (pack_key(sel, addr.data[0], mask, off, offmask) < 0) - return -1; - res = 0; - - *argc_p = argc; - *argv_p = argv; - return res; -} - -static int parse_ip6_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off) -{ - int res = -1; - int argc = *argc_p; - char **argv = *argv_p; - int plen = 128; - int i; - inet_prefix addr; - int offmask = 0; - - if (argc < 1) - return -1; - - if (get_prefix_1(&addr, *argv, AF_INET6)) - return -1; - argc--; argv++; - - if (argc > 0 && strcmp(argv[0], "at") == 0) { - NEXT_ARG(); - if (parse_at(&argc, &argv, &off, &offmask)) - return -1; - } - - plen = addr.bitlen; - for (i=0; i 0) { - if (matches(*argv, "plus") == 0) { - int off; - NEXT_ARG(); - if (get_integer(&off, *argv, 0)) - return -1; - sel->off = off; - sel->flags |= TC_U32_OFFSET; - } else if (matches(*argv, "at") == 0) { - int off; - NEXT_ARG(); - if (get_integer(&off, *argv, 0)) - return -1; - sel->offoff = off; - if (off%2) { - fprintf(stderr, "offset \"at\" must be even\n"); - return -1; - } - sel->flags |= TC_U32_VAROFFSET; - } else if (matches(*argv, "mask") == 0) { - __u16 mask; - NEXT_ARG(); - if (get_u16(&mask, *argv, 16)) - return -1; - sel->offmask = htons(mask); - sel->flags |= TC_U32_VAROFFSET; - } else if (matches(*argv, "shift") == 0) { - int shift; - NEXT_ARG(); - if (get_integer(&shift, *argv, 0)) - return -1; - sel->offshift = shift; - sel->flags |= TC_U32_VAROFFSET; - } else if (matches(*argv, "eat") == 0) { - sel->flags |= TC_U32_EAT; - } else { - break; - } - argc--; argv++; - } - - *argc_p = argc; - *argv_p = argv; - return 0; -} - -static int parse_hashkey(int *argc_p, char ***argv_p, struct tc_u32_sel *sel) -{ - int argc = *argc_p; - char **argv = *argv_p; - - while (argc > 0) { - if (matches(*argv, "mask") == 0) { - __u32 mask; - NEXT_ARG(); - if (get_u32(&mask, *argv, 16)) - return -1; - sel->hmask = htonl(mask); - } else if (matches(*argv, "at") == 0) { - int num; - NEXT_ARG(); - if (get_integer(&num, *argv, 0)) - return -1; - if (num%4) - return -1; - sel->hoff = num; - } else { - break; - } - argc--; argv++; - } - - *argc_p = argc; - *argv_p = argv; - return 0; -} - -static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n) -{ - struct { - struct tc_u32_sel sel; - struct tc_u32_key keys[128]; - } sel; - struct tcmsg *t = NLMSG_DATA(n); - struct rtattr *tail; - int sel_ok = 0; - int sample_ok = 0; - __u32 htid = 0; - __u32 order = 0; - - memset(&sel, 0, sizeof(sel)); - - if (handle && get_u32_handle(&t->tcm_handle, handle)) { - fprintf(stderr, "Illegal filter ID\n"); - return -1; - } - - if (argc == 0) - return 0; - - tail = NLMSG_TAIL(n); - addattr_l(n, MAX_MSG, TCA_OPTIONS, NULL, 0); - - while (argc > 0) { - if (matches(*argv, "match") == 0) { - NEXT_ARG(); - if (parse_selector(&argc, &argv, &sel.sel, n)) { - fprintf(stderr, "Illegal \"match\"\n"); - return -1; - } - sel_ok++; - continue; - } else if (matches(*argv, "offset") == 0) { - NEXT_ARG(); - if (parse_offset(&argc, &argv, &sel.sel)) { - fprintf(stderr, "Illegal \"offset\"\n"); - return -1; - } - continue; - } else if (matches(*argv, "hashkey") == 0) { - NEXT_ARG(); - if (parse_hashkey(&argc, &argv, &sel.sel)) { - fprintf(stderr, "Illegal \"hashkey\"\n"); - return -1; - } - continue; - } else if (matches(*argv, "classid") == 0 || - strcmp(*argv, "flowid") == 0) { - unsigned handle; - NEXT_ARG(); - if (get_tc_classid(&handle, *argv)) { - fprintf(stderr, "Illegal \"classid\"\n"); - return -1; - } - addattr_l(n, MAX_MSG, TCA_U32_CLASSID, &handle, 4); - sel.sel.flags |= TC_U32_TERMINAL; - } else if (matches(*argv, "divisor") == 0) { - unsigned divisor; - NEXT_ARG(); - if (get_unsigned(&divisor, *argv, 0) || - divisor == 0 || - divisor > 0x100 || ((divisor - 1) & divisor)) { - fprintf(stderr, "Illegal \"divisor\"\n"); - return -1; - } - addattr_l(n, MAX_MSG, TCA_U32_DIVISOR, &divisor, 4); - } else if (matches(*argv, "order") == 0) { - NEXT_ARG(); - if (get_u32(&order, *argv, 0)) { - fprintf(stderr, "Illegal \"order\"\n"); - return -1; - } - } else if (strcmp(*argv, "link") == 0) { - unsigned handle; - NEXT_ARG(); - if (get_u32_handle(&handle, *argv)) { - fprintf(stderr, "Illegal \"link\"\n"); - return -1; - } - if (handle && TC_U32_NODE(handle)) { - fprintf(stderr, "\"link\" must be a hash table.\n"); - return -1; - } - addattr_l(n, MAX_MSG, TCA_U32_LINK, &handle, 4); - } else if (strcmp(*argv, "ht") == 0) { - unsigned handle; - NEXT_ARG(); - if (get_u32_handle(&handle, *argv)) { - fprintf(stderr, "Illegal \"ht\"\n"); - return -1; - } - if (handle && TC_U32_NODE(handle)) { - fprintf(stderr, "\"ht\" must be a hash table.\n"); - return -1; - } - if (sample_ok) - htid = (htid&0xFF000)|(handle&0xFFF00000); - else - htid = (handle&0xFFFFF000); - } else if (strcmp(*argv, "sample") == 0) { - __u32 hash; - unsigned divisor = 0x100; - - struct { - struct tc_u32_sel sel; - struct tc_u32_key keys[4]; - } sel2; - memset(&sel2, 0, sizeof(sel2)); - NEXT_ARG(); - if (parse_selector(&argc, &argv, &sel2.sel, n)) { - fprintf(stderr, "Illegal \"sample\"\n"); - return -1; - } - if (sel2.sel.nkeys != 1) { - fprintf(stderr, "\"sample\" must contain exactly ONE key.\n"); - return -1; - } - if (*argv != 0 && strcmp(*argv, "divisor") == 0) { - NEXT_ARG(); - if (get_unsigned(&divisor, *argv, 0) || divisor == 0 || - divisor > 0x100 || ((divisor - 1) & divisor)) { - fprintf(stderr, "Illegal sample \"divisor\"\n"); - return -1; - } - NEXT_ARG(); - } - hash = sel2.sel.keys[0].val&sel2.sel.keys[0].mask; - hash ^= hash>>16; - hash ^= hash>>8; - htid = ((hash%divisor)<<12)|(htid&0xFFF00000); - sample_ok = 1; - continue; - } else if (strcmp(*argv, "indev") == 0) { - char ind[IFNAMSIZ + 1]; - memset(ind, 0, sizeof (ind)); - argc--; - argv++; - if (argc < 1) { - fprintf(stderr, "Illegal indev\n"); - return -1; - } - strncpy(ind, *argv, sizeof (ind) - 1); - addattr_l(n, MAX_MSG, TCA_U32_INDEV, ind, strlen(ind) + 1); - - } else if (matches(*argv, "action") == 0) { - NEXT_ARG(); - if (parse_action(&argc, &argv, TCA_U32_ACT, n)) { - fprintf(stderr, "Illegal \"action\"\n"); - return -1; - } - continue; - - } else if (matches(*argv, "police") == 0) { - NEXT_ARG(); - if (parse_police(&argc, &argv, TCA_U32_POLICE, n)) { - fprintf(stderr, "Illegal \"police\"\n"); - return -1; - } - continue; - } else if (strcmp(*argv, "help") == 0) { - explain(); - return -1; - } else { - fprintf(stderr, "What is \"%s\"?\n", *argv); - explain(); - return -1; - } - argc--; argv++; - } - - if (order) { - if (TC_U32_NODE(t->tcm_handle) && order != TC_U32_NODE(t->tcm_handle)) { - fprintf(stderr, "\"order\" contradicts \"handle\"\n"); - return -1; - } - t->tcm_handle |= order; - } - - if (htid) - addattr_l(n, MAX_MSG, TCA_U32_HASH, &htid, 4); - if (sel_ok) - addattr_l(n, MAX_MSG, TCA_U32_SEL, &sel, sizeof(sel.sel)+sel.sel.nkeys*sizeof(struct tc_u32_key)); - tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail; - return 0; -} - -static int u32_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle) -{ - struct rtattr *tb[TCA_U32_MAX+1]; - struct tc_u32_sel *sel = NULL; - struct tc_u32_pcnt *pf = NULL; - - if (opt == NULL) - return 0; - - parse_rtattr_nested(tb, TCA_U32_MAX, opt); - - if (handle) { - SPRINT_BUF(b1); - fprintf(f, "fh %s ", sprint_u32_handle(handle, b1)); - } - if (TC_U32_NODE(handle)) { - fprintf(f, "order %d ", TC_U32_NODE(handle)); - } - - if (tb[TCA_U32_SEL]) { - if (RTA_PAYLOAD(tb[TCA_U32_SEL]) < sizeof(*sel)) - return -1; - - sel = RTA_DATA(tb[TCA_U32_SEL]); - } - - if (tb[TCA_U32_DIVISOR]) { - fprintf(f, "ht divisor %d ", *(__u32*)RTA_DATA(tb[TCA_U32_DIVISOR])); - } else if (tb[TCA_U32_HASH]) { - __u32 htid = *(__u32*)RTA_DATA(tb[TCA_U32_HASH]); - fprintf(f, "key ht %x bkt %x ", TC_U32_USERHTID(htid), TC_U32_HASH(htid)); - } else { - fprintf(f, "??? "); - } - if (tb[TCA_U32_CLASSID]) { - SPRINT_BUF(b1); - fprintf(f, "%sflowid %s ", - !sel || !(sel->flags&TC_U32_TERMINAL) ? "*" : "", - sprint_tc_classid(*(__u32*)RTA_DATA(tb[TCA_U32_CLASSID]), b1)); - } else if (sel && sel->flags&TC_U32_TERMINAL) { - fprintf(f, "terminal flowid ??? "); - } - if (tb[TCA_U32_LINK]) { - SPRINT_BUF(b1); - fprintf(f, "link %s ", sprint_u32_handle(*(__u32*)RTA_DATA(tb[TCA_U32_LINK]), b1)); - } - - if (tb[TCA_U32_PCNT]) { - if (RTA_PAYLOAD(tb[TCA_U32_PCNT]) < sizeof(*pf)) { - fprintf(f, "Broken perf counters \n"); - return -1; - } - pf = RTA_DATA(tb[TCA_U32_PCNT]); - } - - if (sel && show_stats && NULL != pf) - fprintf(f, " (rule hit %llu success %llu)", - (unsigned long long) pf->rcnt, - (unsigned long long) pf->rhit); - - if (tb[TCA_U32_MARK]) { - struct tc_u32_mark *mark = RTA_DATA(tb[TCA_U32_MARK]); - if (RTA_PAYLOAD(tb[TCA_U32_MARK]) < sizeof(*mark)) { - fprintf(f, "\n Invalid mark (kernel&iproute2 mismatch)\n"); - } else { - fprintf(f, "\n mark 0x%04x 0x%04x (success %d)", - mark->val, mark->mask, mark->success); - } - } - - if (sel) { - int i; - struct tc_u32_key *key = sel->keys; - if (sel->nkeys) { - for (i=0; inkeys; i++, key++) { - fprintf(f, "\n match %08x/%08x at %s%d", - (unsigned int)ntohl(key->val), - (unsigned int)ntohl(key->mask), - key->offmask ? "nexthdr+" : "", - key->off); - if (show_stats && NULL != pf) - fprintf(f, " (success %lld ) ", - (unsigned long long) pf->kcnts[i]); - } - } - - if (sel->flags&(TC_U32_VAROFFSET|TC_U32_OFFSET)) { - fprintf(f, "\n offset "); - if (sel->flags&TC_U32_VAROFFSET) - fprintf(f, "%04x>>%d at %d ", ntohs(sel->offmask), sel->offshift, sel->offoff); - if (sel->off) - fprintf(f, "plus %d ", sel->off); - } - if (sel->flags&TC_U32_EAT) - fprintf(f, " eat "); - - if (sel->hmask) { - fprintf(f, "\n hash mask %08x at %d ", - (unsigned int)htonl(sel->hmask), sel->hoff); - } - } - - if (tb[TCA_U32_POLICE]) { - fprintf(f, "\n"); - tc_print_police(f, tb[TCA_U32_POLICE]); - } - if (tb[TCA_U32_INDEV]) { - struct rtattr *idev = tb[TCA_U32_INDEV]; - fprintf(f, "\n input dev %s\n", (char *) RTA_DATA(idev)); - } - if (tb[TCA_U32_ACT]) { - tc_print_action(f, tb[TCA_U32_ACT]); - } - - return 0; -} - -struct filter_util u32_filter_util = { - .id = "u32", - .parse_fopt = u32_parse_opt, - .print_fopt = u32_print_opt, -};