]> git.proxmox.com Git - mirror_iproute2.git/blobdiff - tc/f_u32.c
ip: add MACsec support
[mirror_iproute2.git] / tc / f_u32.c
index fe31ec085c9b2ba838c66281ebe9c068853bf2a0..9424dc3785478d95f14998760ba24a19df789a8b 100644 (file)
 #include <arpa/inet.h>
 #include <string.h>
 #include <linux/if.h>
+#include <linux/if_ether.h>
 
 #include "utils.h"
 #include "tc_util.h"
 
+extern int show_pretty;
+
 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, "               [ action ACTION_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");
@@ -36,13 +39,12 @@ static void explain(void)
        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");
+       fprintf(stderr, "\nNOTE: CLASSID is parsed at hexadecimal input.\n");
 }
 
-#define usage() return(-1)
-
-int get_u32_handle(__u32 *handle, char *str)
+static int get_u32_handle(__u32 *handle, const char *str)
 {
-       __u32 htid=0, hash=0, nodeid=0;
+       __u32 htid = 0, hash = 0, nodeid = 0;
        char *tmp = strchr(str, ':');
 
        if (tmp == NULL) {
@@ -53,21 +55,21 @@ int get_u32_handle(__u32 *handle, char *str)
        htid = strtoul(str, &tmp, 16);
        if (tmp == str && *str != ':' && *str != 0)
                return -1;
-       if (htid>=0x1000)
+       if (htid >= 0x1000)
                return -1;
        if (*tmp) {
-               str = tmp+1;
+               str = tmp + 1;
                hash = strtoul(str, &tmp, 16);
                if (tmp == str && *str != ':' && *str != 0)
                        return -1;
-               if (hash>=0x100)
+               if (hash >= 0x100)
                        return -1;
                if (*tmp) {
-                       str = tmp+1;
+                       str = tmp + 1;
                        nodeid = strtoul(str, &tmp, 16);
                        if (tmp == str && *str != 0)
                                return -1;
-                       if (nodeid>=0x1000)
+                       if (nodeid >= 0x1000)
                                return -1;
                }
        }
@@ -75,7 +77,7 @@ int get_u32_handle(__u32 *handle, char *str)
        return 0;
 }
 
-char * sprint_u32_handle(__u32 handle, char *buf)
+static char *sprint_u32_handle(__u32 handle, char *buf)
 {
        int bsize = SPRINT_BSIZE-1;
        __u32 htid = TC_U32_HTID(handle);
@@ -89,17 +91,20 @@ char * sprint_u32_handle(__u32 handle, char *buf)
        }
        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;
                }
@@ -109,18 +114,19 @@ char * sprint_u32_handle(__u32 handle, char *buf)
        return buf;
 }
 
-static int pack_key(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int offmask)
+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; i<hwm; i++) {
+       for (i = 0; i < hwm; i++) {
                if (sel->keys[i].off == off && sel->keys[i].offmask == offmask) {
-                       __u32 intersect = mask&sel->keys[i].mask;
+                       __u32 intersect = mask & sel->keys[i].mask;
 
-                       if ((key^sel->keys[i].val) & intersect)
+                       if ((key ^ sel->keys[i].val) & intersect)
                                return -1;
                        sel->keys[i].val |= key;
                        sel->keys[i].mask |= mask;
@@ -140,14 +146,16 @@ static int pack_key(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int
        return 0;
 }
 
-static int pack_key32(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int offmask)
+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)
+static int pack_key16(struct tc_u32_sel *sel, __u32 key, __u32 mask,
+                     int off, int offmask)
 {
        if (key > 0xFFFF || mask > 0xFFFF)
                return -1;
@@ -163,7 +171,8 @@ static int pack_key16(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, in
        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)
+static int pack_key8(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off,
+                    int offmask)
 {
        if (key > 0xFF || mask > 0xFF)
                return -1;
@@ -186,7 +195,7 @@ static int pack_key8(struct tc_u32_sel *sel, __u32 key, __u32 mask, int off, int
 }
 
 
-int parse_at(int *argc_p, char ***argv_p, int *off, int *offmask)
+static int parse_at(int *argc_p, char ***argv_p, int *off, int *offmask)
 {
        int argc = *argc_p;
        char **argv = *argv_p;
@@ -215,7 +224,8 @@ int parse_at(int *argc_p, char ***argv_p, int *off, int *offmask)
 }
 
 
-static int parse_u32(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off, int offmask)
+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;
@@ -246,7 +256,8 @@ static int parse_u32(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int of
        return res;
 }
 
-static int parse_u16(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off, int offmask)
+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;
@@ -276,7 +287,8 @@ static int parse_u16(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int of
        return res;
 }
 
-static int parse_u8(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off, int offmask)
+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;
@@ -310,7 +322,8 @@ static int parse_u8(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off
        return res;
 }
 
-static int parse_ip_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off)
+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;
@@ -334,7 +347,7 @@ static int parse_ip_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, in
 
        mask = 0;
        if (addr.bitlen)
-               mask = htonl(0xFFFFFFFF<<(32-addr.bitlen));
+               mask = htonl(0xFFFFFFFF << (32 - addr.bitlen));
        if (pack_key(sel, addr.data[0], mask, off, offmask) < 0)
                return -1;
        res = 0;
@@ -344,7 +357,8 @@ static int parse_ip_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, in
        return res;
 }
 
-static int parse_ip6_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, int off)
+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;
@@ -368,14 +382,19 @@ static int parse_ip6_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, i
        }
 
        plen = addr.bitlen;
-       for (i=0; i<plen; i+=32) {
-//             if (((i+31)&~0x1F)<=plen) {
-               if (((i+31))<=plen) {
-                       if ((res = pack_key(sel, addr.data[i/32], 0xFFFFFFFF, off+4*(i/32), offmask)) < 0)
+       for (i = 0; i < plen; i += 32) {
+               /* if (((i + 31) & ~0x1F) <= plen) { */
+               if (i + 31 <= plen) {
+                       res = pack_key(sel, addr.data[i / 32],
+                                      0xFFFFFFFF, off + 4 * (i / 32), offmask);
+                       if (res < 0)
                                return -1;
-               } else if (i<plen) {
-                       __u32 mask = htonl(0xFFFFFFFF<<(32-(plen-i)));
-                       if ((res = pack_key(sel, addr.data[i/32], mask, off+4*(i/32), offmask)) < 0)
+               } else if (i < plen) {
+                       __u32 mask = htonl(0xFFFFFFFF << (32 - (plen - i)));
+
+                       res = pack_key(sel, addr.data[i / 32],
+                                      mask, off + 4 * (i / 32), offmask);
+                       if (res < 0)
                                return -1;
                }
        }
@@ -386,6 +405,83 @@ static int parse_ip6_addr(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, i
        return res;
 }
 
+static int parse_ip6_class(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
+{
+       int res = -1;
+       int argc = *argc_p;
+       char **argv = *argv_p;
+       __u32 key;
+       __u32 mask;
+       int off = 0;
+       int offmask = 0;
+
+       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;
+
+       key <<= 20;
+       mask <<= 20;
+       key = htonl(key);
+       mask = htonl(mask);
+
+       res = pack_key(sel, key, mask, off, offmask);
+       if (res < 0)
+               return -1;
+
+       *argc_p = argc;
+       *argv_p = argv;
+       return 0;
+}
+
+static int parse_ether_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;
+       __u8 addr[6];
+       int offmask = 0;
+       int i;
+
+       if (argc < 1)
+               return -1;
+
+       if (sscanf(*argv, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx",
+                  addr + 0, addr + 1, addr + 2,
+                  addr + 3, addr + 4, addr + 5) != 6) {
+               fprintf(stderr, "parse_ether_addr: improperly formed address '%s'\n",
+                       *argv);
+               return -1;
+       }
+
+       argc--; argv++;
+       if (argc > 0 && strcmp(argv[0], "at") == 0) {
+               NEXT_ARG();
+               if (parse_at(&argc, &argv, &off, &offmask))
+                       return -1;
+       }
+
+       for (i = 0; i < 6; i++) {
+               res = pack_key8(sel, addr[i], 0xFF, off + i, offmask);
+               if (res < 0)
+                       return -1;
+       }
+
+       *argc_p = argc;
+       *argv_p = argv;
+       return res;
+}
+
 static int parse_ip(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
 {
        int res = -1;
@@ -398,77 +494,47 @@ static int parse_ip(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
        if (strcmp(*argv, "src") == 0) {
                NEXT_ARG();
                res = parse_ip_addr(&argc, &argv, sel, 12);
-               goto done;
-       }
-       if (strcmp(*argv, "dst") == 0) {
+       } else if (strcmp(*argv, "dst") == 0) {
                NEXT_ARG();
                res = parse_ip_addr(&argc, &argv, sel, 16);
-               goto done;
-       }
-       if (strcmp(*argv, "tos") == 0 ||
-           matches(*argv, "dsfield") == 0) {
+       } else if (strcmp(*argv, "tos") == 0 ||
+           matches(*argv, "dsfield") == 0 ||
+           matches(*argv, "precedence") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 1, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "ihl") == 0) {
+       } else if (strcmp(*argv, "ihl") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 0, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "protocol") == 0) {
+       } else if (strcmp(*argv, "protocol") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 9, 0);
-               goto done;
-       }
-       if (matches(*argv, "precedence") == 0) {
-               NEXT_ARG();
-               res = parse_u8(&argc, &argv, sel, 1, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "nofrag") == 0) {
+       } else if (strcmp(*argv, "nofrag") == 0) {
                argc--; argv++;
                res = pack_key16(sel, 0, 0x3FFF, 6, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "firstfrag") == 0) {
+       } else if (strcmp(*argv, "firstfrag") == 0) {
                argc--; argv++;
-               res = pack_key16(sel, 0, 0x1FFF, 6, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "df") == 0) {
+               res = pack_key16(sel, 0x2000, 0x3FFF, 6, 0);
+       } else if (strcmp(*argv, "df") == 0) {
                argc--; argv++;
                res = pack_key16(sel, 0x4000, 0x4000, 6, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "mf") == 0) {
+       } else if (strcmp(*argv, "mf") == 0) {
                argc--; argv++;
                res = pack_key16(sel, 0x2000, 0x2000, 6, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "dport") == 0) {
+       } else if (strcmp(*argv, "dport") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 22, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "sport") == 0) {
+       } else if (strcmp(*argv, "sport") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 20, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "icmp_type") == 0) {
+       } else if (strcmp(*argv, "icmp_type") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 20, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "icmp_code") == 0) {
+       } else if (strcmp(*argv, "icmp_code") == 0) {
                NEXT_ARG();
-               res = parse_u8(&argc, &argv, sel, 20, 1);
-               goto done;
-       }
-       return -1;
+               res = parse_u8(&argc, &argv, sel, 21, 0);
+       } else
+               return -1;
 
-done:
        *argc_p = argc;
        *argv_p = argv;
        return res;
@@ -486,51 +552,58 @@ static int parse_ip6(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
        if (strcmp(*argv, "src") == 0) {
                NEXT_ARG();
                res = parse_ip6_addr(&argc, &argv, sel, 8);
-               goto done;
-       }
-       if (strcmp(*argv, "dst") == 0) {
+       } else if (strcmp(*argv, "dst") == 0) {
                NEXT_ARG();
                res = parse_ip6_addr(&argc, &argv, sel, 24);
-               goto done;
-       }
-       if (strcmp(*argv, "priority") == 0) {
+       } else if (strcmp(*argv, "priority") == 0) {
                NEXT_ARG();
-               res = parse_u8(&argc, &argv, sel, 4, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "protocol") == 0) {
+               res = parse_ip6_class(&argc, &argv, sel);
+       } else if (strcmp(*argv, "protocol") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 6, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "flowlabel") == 0) {
+       } else if (strcmp(*argv, "flowlabel") == 0) {
                NEXT_ARG();
                res = parse_u32(&argc, &argv, sel, 0, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "dport") == 0) {
+       } else if (strcmp(*argv, "dport") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 42, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "sport") == 0) {
+       } else if (strcmp(*argv, "sport") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 40, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "icmp_type") == 0) {
+       } else if (strcmp(*argv, "icmp_type") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 40, 0);
-               goto done;
-       }
-       if (strcmp(*argv, "icmp_code") == 0) {
+       } else if (strcmp(*argv, "icmp_code") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 41, 1);
-               goto done;
+       } else
+               return -1;
+
+       *argc_p = argc;
+       *argv_p = argv;
+       return res;
+}
+
+static int parse_ether(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
+{
+       int res = -1;
+       int argc = *argc_p;
+       char **argv = *argv_p;
+
+       if (argc < 2)
+               return -1;
+
+       if (strcmp(*argv, "src") == 0) {
+               NEXT_ARG();
+               res = parse_ether_addr(&argc, &argv, sel, -8);
+       } else if (strcmp(*argv, "dst") == 0) {
+               NEXT_ARG();
+               res = parse_ether_addr(&argc, &argv, sel, -14);
+       } else {
+               fprintf(stderr, "Unknown match: ether %s\n", *argv);
+               return -1;
        }
-       return -1;
 
-done:
        *argc_p = argc;
        *argv_p = argv;
        return res;
@@ -549,21 +622,18 @@ static int parse_udp(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
        if (strcmp(*argv, "src") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 0, -1);
-               goto done;
-       }
-       if (strcmp(*argv, "dst") == 0) {
+       } else if (strcmp(*argv, "dst") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 2, -1);
-               goto done;
-       }
-       return -1;
+       } else
+               return -1;
 
-done:
        *argc_p = argc;
        *argv_p = argv;
        return res;
 }
 
+
 static int parse_icmp(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
 {
        int res = -1;
@@ -576,16 +646,12 @@ static int parse_icmp(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
        if (strcmp(*argv, "type") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 0, -1);
-               goto done;
-       }
-       if (strcmp(*argv, "code") == 0) {
+       } else if (strcmp(*argv, "code") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 1, -1);
-               goto done;
-       }
-       return -1;
+       } else
+               return -1;
 
-done:
        *argc_p = argc;
        *argv_p = argv;
        return res;
@@ -626,7 +692,8 @@ static int parse_mark(int *argc_p, char ***argv_p, struct nlmsghdr *n)
        return res;
 }
 
-static int parse_selector(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, struct nlmsghdr *n)
+static int parse_selector(int *argc_p, char ***argv_p,
+                         struct tc_u32_sel *sel, struct nlmsghdr *n)
 {
        int argc = *argc_p;
        char **argv = *argv_p;
@@ -638,52 +705,36 @@ static int parse_selector(int *argc_p, char ***argv_p, struct tc_u32_sel *sel, s
        if (matches(*argv, "u32") == 0) {
                NEXT_ARG();
                res = parse_u32(&argc, &argv, sel, 0, 0);
-               goto done;
-       }
-       if (matches(*argv, "u16") == 0) {
+       } else if (matches(*argv, "u16") == 0) {
                NEXT_ARG();
                res = parse_u16(&argc, &argv, sel, 0, 0);
-               goto done;
-       }
-       if (matches(*argv, "u8") == 0) {
+       } else if (matches(*argv, "u8") == 0) {
                NEXT_ARG();
                res = parse_u8(&argc, &argv, sel, 0, 0);
-               goto done;
-       }
-       if (matches(*argv, "ip") == 0) {
+       } else if (matches(*argv, "ip") == 0) {
                NEXT_ARG();
                res = parse_ip(&argc, &argv, sel);
-               goto done;
-       }
-       if (matches(*argv, "ip6") == 0) {
+       } else  if (matches(*argv, "ip6") == 0) {
                NEXT_ARG();
                res = parse_ip6(&argc, &argv, sel);
-               goto done;
-       }
-       if (matches(*argv, "udp") == 0) {
+       } else if (matches(*argv, "udp") == 0) {
                NEXT_ARG();
                res = parse_udp(&argc, &argv, sel);
-               goto done;
-       }
-       if (matches(*argv, "tcp") == 0) {
+       } else if (matches(*argv, "tcp") == 0) {
                NEXT_ARG();
                res = parse_tcp(&argc, &argv, sel);
-               goto done;
-       }
-       if (matches(*argv, "icmp") == 0) {
+       } else if (matches(*argv, "icmp") == 0) {
                NEXT_ARG();
                res = parse_icmp(&argc, &argv, sel);
-               goto done;
-       }
-       if (matches(*argv, "mark") == 0) {
+       } else if (matches(*argv, "mark") == 0) {
                NEXT_ARG();
                res = parse_mark(&argc, &argv, n);
-               goto done;
-       }
-
-       return -1;
+       } else if (matches(*argv, "ether") == 0) {
+               NEXT_ARG();
+               res = parse_ether(&argc, &argv, sel);
+       } else
+               return -1;
 
-done:
        *argc_p = argc;
        *argv_p = argv;
        return res;
@@ -697,6 +748,7 @@ static int parse_offset(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
        while (argc > 0) {
                if (matches(*argv, "plus") == 0) {
                        int off;
+
                        NEXT_ARG();
                        if (get_integer(&off, *argv, 0))
                                return -1;
@@ -704,6 +756,7 @@ static int parse_offset(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
                        sel->flags |= TC_U32_OFFSET;
                } else if (matches(*argv, "at") == 0) {
                        int off;
+
                        NEXT_ARG();
                        if (get_integer(&off, *argv, 0))
                                return -1;
@@ -714,14 +767,13 @@ static int parse_offset(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
                        }
                        sel->flags |= TC_U32_VAROFFSET;
                } else if (matches(*argv, "mask") == 0) {
-                       __u16 mask;
                        NEXT_ARG();
-                       if (get_u16(&mask, *argv, 16))
+                       if (get_be16(&sel->offmask, *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;
@@ -747,13 +799,12 @@ static int parse_hashkey(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
 
        while (argc > 0) {
                if (matches(*argv, "mask") == 0) {
-                       __u32 mask;
                        NEXT_ARG();
-                       if (get_u32(&mask, *argv, 16))
+                       if (get_be32(&sel->hmask, *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;
@@ -771,7 +822,166 @@ static int parse_hashkey(int *argc_p, char ***argv_p, struct tc_u32_sel *sel)
        return 0;
 }
 
-static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n)
+static void print_ipv4(FILE *f, const struct tc_u32_key *key)
+{
+       char abuf[256];
+
+       switch (key->off) {
+       case 0:
+               switch (ntohl(key->mask)) {
+               case 0x0f000000:
+                       fprintf(f, "\n  match IP ihl %u",
+                               ntohl(key->val) >> 24);
+                       return;
+               case 0x00ff0000:
+                       fprintf(f, "\n  match IP dsfield %#x",
+                               ntohl(key->val) >> 16);
+                       return;
+               }
+               break;
+       case 8:
+               if (ntohl(key->mask) == 0x00ff0000) {
+                       fprintf(f, "\n  match IP protocol %d",
+                               ntohl(key->val) >> 16);
+                       return;
+               }
+               break;
+       case 12:
+       case 16: {
+                       int bits = mask2bits(key->mask);
+
+                       if (bits >= 0) {
+                               fprintf(f, "\n  %s %s/%d",
+                                       key->off == 12 ? "match IP src" : "match IP dst",
+                                       inet_ntop(AF_INET, &key->val,
+                                                 abuf, sizeof(abuf)),
+                                       bits);
+                               return;
+                       }
+               }
+               break;
+
+       case 20:
+               switch (ntohl(key->mask)) {
+               case 0x0000ffff:
+                       fprintf(f, "\n  match dport %u",
+                               ntohl(key->val) & 0xffff);
+                       return;
+               case 0xffff0000:
+                       fprintf(f, "\n  match sport %u",
+                               ntohl(key->val) >> 16);
+                       return;
+               case 0xffffffff:
+                       fprintf(f, "\n  match dport %u, match sport %u",
+                               ntohl(key->val) & 0xffff,
+                               ntohl(key->val) >> 16);
+
+                       return;
+               }
+               /* XXX: Default print_raw */
+       }
+}
+
+static void print_ipv6(FILE *f, const struct tc_u32_key *key)
+{
+       char abuf[256];
+
+       switch (key->off) {
+       case 0:
+               switch (ntohl(key->mask)) {
+               case 0x0f000000:
+                       fprintf(f, "\n  match IP ihl %u",
+                               ntohl(key->val) >> 24);
+                       return;
+               case 0x00ff0000:
+                       fprintf(f, "\n  match IP dsfield %#x",
+                               ntohl(key->val) >> 16);
+                       return;
+               }
+               break;
+       case 8:
+               if (ntohl(key->mask) == 0x00ff0000) {
+                       fprintf(f, "\n  match IP protocol %d",
+                               ntohl(key->val) >> 16);
+                       return;
+               }
+               break;
+       case 12:
+       case 16: {
+                       int bits = mask2bits(key->mask);
+
+                       if (bits >= 0) {
+                               fprintf(f, "\n  %s %s/%d",
+                                       key->off == 12 ? "match IP src" : "match IP dst",
+                                       inet_ntop(AF_INET, &key->val,
+                                                 abuf, sizeof(abuf)),
+                                       bits);
+                               return;
+                       }
+               }
+               break;
+
+       case 20:
+               switch (ntohl(key->mask)) {
+               case 0x0000ffff:
+                       fprintf(f, "\n  match sport %u",
+                               ntohl(key->val) & 0xffff);
+                       return;
+               case 0xffff0000:
+                       fprintf(f, "\n  match dport %u",
+                               ntohl(key->val) >> 16);
+                       return;
+               case 0xffffffff:
+                       fprintf(f, "\n  match sport %u, match dport %u",
+                               ntohl(key->val) & 0xffff,
+                               ntohl(key->val) >> 16);
+
+                       return;
+               }
+               /* XXX: Default print_raw */
+       }
+}
+
+static void print_raw(FILE *f, const struct tc_u32_key *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);
+}
+
+static const struct {
+       __u16 proto;
+       __u16 pad;
+       void (*pprinter)(FILE *f, const struct tc_u32_key *key);
+} u32_pprinters[] = {
+       {0,        0, print_raw},
+       {ETH_P_IP, 0, print_ipv4},
+       {ETH_P_IPV6, 0, print_ipv6},
+};
+
+static void show_keys(FILE *f, const struct tc_u32_key *key)
+{
+       int i = 0;
+
+       if (!show_pretty)
+               goto show_k;
+
+       for (i = 0; i < ARRAY_SIZE(u32_pprinters); i++) {
+               if (u32_pprinters[i].proto == ntohs(f_proto)) {
+show_k:
+                       u32_pprinters[i].pprinter(f, key);
+                       return;
+               }
+       }
+
+       i = 0;
+       goto show_k;
+}
+
+static int u32_parse_opt(struct filter_util *qu, char *handle,
+                        int argc, char **argv, struct nlmsghdr *n)
 {
        struct {
                struct tc_u32_sel sel;
@@ -822,16 +1032,18 @@ static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **
                        continue;
                } else if (matches(*argv, "classid") == 0 ||
                           strcmp(*argv, "flowid") == 0) {
-                       unsigned handle;
+                       unsigned int flowid;
+
                        NEXT_ARG();
-                       if (get_tc_classid(&handle, *argv)) {
+                       if (get_tc_classid(&flowid, *argv)) {
                                fprintf(stderr, "Illegal \"classid\"\n");
                                return -1;
                        }
-                       addattr_l(n, MAX_MSG, TCA_U32_CLASSID, &handle, 4);
+                       addattr_l(n, MAX_MSG, TCA_U32_CLASSID, &flowid, 4);
                        sel.sel.flags |= TC_U32_TERMINAL;
                } else if (matches(*argv, "divisor") == 0) {
-                       unsigned divisor;
+                       unsigned int divisor;
+
                        NEXT_ARG();
                        if (get_unsigned(&divisor, *argv, 0) ||
                            divisor == 0 ||
@@ -847,35 +1059,37 @@ static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **
                                return -1;
                        }
                } else if (strcmp(*argv, "link") == 0) {
-                       unsigned handle;
+                       unsigned int linkid;
+
                        NEXT_ARG();
-                       if (get_u32_handle(&handle, *argv)) {
+                       if (get_u32_handle(&linkid, *argv)) {
                                fprintf(stderr, "Illegal \"link\"\n");
                                return -1;
                        }
-                       if (handle && TC_U32_NODE(handle)) {
+                       if (linkid && TC_U32_NODE(linkid)) {
                                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;
+                       unsigned int ht;
+
                        NEXT_ARG();
-                       if (get_u32_handle(&handle, *argv)) {
+                       if (get_u32_handle(&ht, *argv)) {
                                fprintf(stderr, "Illegal \"ht\"\n");
                                return -1;
                        }
-                       if (handle && TC_U32_NODE(handle)) {
+                       if (handle && TC_U32_NODE(ht)) {
                                fprintf(stderr, "\"ht\" must be a hash table.\n");
                                return -1;
                        }
                        if (sample_ok)
-                               htid = (htid&0xFF000)|(handle&0xFFF00000);
+                               htid = (htid & 0xFF000) | (ht & 0xFFF00000);
                        else
-                               htid = (handle&0xFFFFF000);
+                               htid = (ht & 0xFFFFF000);
                } else if (strcmp(*argv, "sample") == 0) {
                        __u32 hash;
-                       unsigned divisor = 0x100;
+                       unsigned int divisor = 0x100;
 
                        struct {
                                struct tc_u32_sel sel;
@@ -893,30 +1107,33 @@ static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **
                        }
                        if (*argv != 0 && strcmp(*argv, "divisor") == 0) {
                                NEXT_ARG();
-                               if (get_unsigned(&divisor, *argv, 0) || divisor == 0 ||
-                                   divisor > 0x100 || ((divisor - 1) & divisor)) {
+                               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);
+                       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));
+
+                       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);
+                       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();
@@ -947,11 +1164,12 @@ static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **
        }
 
        /* We dont necessarily need class/flowids */
-       if (terminal_ok) 
+       if (terminal_ok)
                sel.sel.flags |= TC_U32_TERMINAL;
-       
+
        if (order) {
-               if (TC_U32_NODE(t->tcm_handle) && order != TC_U32_NODE(t->tcm_handle)) {
+               if (TC_U32_NODE(t->tcm_handle) &&
+                   order != TC_U32_NODE(t->tcm_handle)) {
                        fprintf(stderr, "\"order\" contradicts \"handle\"\n");
                        return -1;
                }
@@ -961,14 +1179,17 @@ static int u32_parse_opt(struct filter_util *qu, char *handle, int argc, char **
        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));
+               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)
+static int u32_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt,
+                        __u32 handle)
 {
-       struct rtattr *tb[TCA_U32_MAX+1];
+       struct rtattr *tb[TCA_U32_MAX + 1];
        struct tc_u32_sel *sel = NULL;
        struct tc_u32_pcnt *pf = NULL;
 
@@ -993,29 +1214,35 @@ static int u32_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __
        }
 
        if (tb[TCA_U32_DIVISOR]) {
-               fprintf(f, "ht divisor %d ", *(__u32*)RTA_DATA(tb[TCA_U32_DIVISOR]));
+               fprintf(f, "ht divisor %d ",
+                       rta_getattr_u32(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));
+               __u32 htid = rta_getattr_u32(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) {
+                       !sel || !(sel->flags & TC_U32_TERMINAL) ? "*" : "",
+                       sprint_tc_classid(rta_getattr_u32(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));
+               fprintf(f, "link %s ",
+                       sprint_u32_handle(rta_getattr_u32(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");
+                       fprintf(f, "Broken perf counters\n");
                        return -1;
                }
                pf = RTA_DATA(tb[TCA_U32_PCNT]);
@@ -1028,6 +1255,7 @@ static int u32_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __
 
        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 {
@@ -1037,29 +1265,27 @@ static int u32_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __
        }
 
        if (sel) {
-               int i;
-               struct tc_u32_key *key = sel->keys;
                if (sel->nkeys) {
-                       for (i=0; i<sel->nkeys; 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);
+                       int i;
+
+                       for (i = 0; i < sel->nkeys; i++) {
+                               show_keys(f, sel->keys + i);
                                if (show_stats && NULL != pf)
-                                       fprintf(f, " (success %lld ) ",
+                                       fprintf(f, " (success %llu ) ",
                                                (unsigned long long) pf->kcnts[i]);
                        }
                }
 
-               if (sel->flags&(TC_U32_VAROFFSET|TC_U32_OFFSET)) {
+               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->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)
+               if (sel->flags & TC_U32_EAT)
                        fprintf(f, " eat ");
 
                if (sel->hmask) {
@@ -1074,7 +1300,8 @@ static int u32_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __
        }
        if (tb[TCA_U32_INDEV]) {
                struct rtattr *idev = tb[TCA_U32_INDEV];
-               fprintf(f, "\n  input dev %s\n", (char *) RTA_DATA(idev));
+
+               fprintf(f, "\n  input dev %s\n", rta_getattr_str(idev));
        }
        if (tb[TCA_U32_ACT]) {
                tc_print_action(f, tb[TCA_U32_ACT]);