_ Git - flowspec-xdp/blob - xdp.c

   1 #include <stdint.h>
   2 #include <endian.h>
   3 #include <linux/if_ether.h>
   4 #include <linux/ip.h>
   5 #include <linux/udp.h>
   6 #include <linux/icmp.h>
   7 #include <linux/icmpv6.h>
   8 #include <arpa/inet.h>
   9
  10 #define NULL (void*)0
  11
  12 /* IP flags. */
  13 #define IP_CE           0x8000          /* Flag: "Congestion"           */
  14 #define IP_DF           0x4000          /* Flag: "Don't Fragment"       */
  15 #define IP_MF           0x2000          /* Flag: "More Fragments"       */
  16 #define IP_OFFSET       0x1FFF          /* "Fragment Offset" part       */
  17
  18 #define IP_PROTO_TCP 6
  19 #define IP_PROTO_UDP 17
  20 #define IP_PROTO_ICMP 1
  21 #define IP6_PROTO_ICMPV6 58
  22 #define IP6_PROTO_FRAG 44
  23
  24 typedef __uint128_t uint128_t;
  25
  26 // Our own ipv6hdr that uses uint128_t
  27 struct ip6hdr {
  28 #if defined(__LITTLE_ENDIAN_BITFIELD)
  29         __u8    priority:4,
  30                 version:4;
  31 #elif defined(__BIG_ENDIAN_BITFIELD)
  32         __u8    version:4,
  33                 priority:4;
  34 #else
  35 #error  "Please fix <asm/byteorder.h>"
  36 #endif
  37         __u8    flow_lbl[3];
  38
  39         __be16  payload_len;
  40         __u8            nexthdr;
  41         __u8            hop_limit;
  42
  43         uint128_t       saddr;
  44         uint128_t       daddr;
  45 } __attribute__((packed));
  46
  47 #define IP6_MF 1
  48 #define IP6_FRAGOFF 0xfff8
  49 struct ip6_fraghdr {
  50         uint8_t nexthdr;
  51         uint8_t _reserved;
  52         uint16_t frag_off; // BE low 3 bits flags, last is "more frags"
  53         uint32_t id;
  54 } __attribute__((packed));
  55
  56 // Our own ethhdr with optional vlan tags
  57 struct ethhdr_vlan {
  58         unsigned char   h_dest[ETH_ALEN];       /* destination eth addr */
  59         unsigned char   h_source[ETH_ALEN];     /* source ether addr    */
  60         __be16          vlan_magic;             /* 0x8100 */
  61         __be16          tci;            /* PCP (3 bits), DEI (1 bit), and VLAN (12 bits) */
  62         __be16          h_proto;                /* packet type ID field */
  63 } __attribute__((packed));
  64
  65 // Our own tcphdr without the flags blown up
  66 struct tcphdr {
  67         __be16  source;
  68         __be16  dest;
  69         __be32  seq;
  70         __be32  ack_seq;
  71         __u16   flags;
  72         __be16  window;
  73         __sum16 check;
  74         __be16  urg_ptr;
  75 } __attribute__((packed));
  76
  77 // Note that all operations on uint128s *stay* in Network byte order!
  78
  79 #if defined(__LITTLE_ENDIAN)
  80 #define BIGEND32(v) ((v >> 3*8) | ((v >> 8) & 0xff00) | ((v << 8) & 0xff0000) | (v << 3*8) & 0xff000000)
  81 #elif defined(__BIG_ENDIAN)
  82 #define BIGEND32(v) (v)
  83 #else
  84 #error "Need endian info"
  85 #endif
  86
  87 #if defined(__LITTLE_ENDIAN)
  88 #define BIGEND128(a, b, c, d) ( \
  89                 (((uint128_t)BIGEND32(d)) << 3*32) | \
  90                 (((uint128_t)BIGEND32(c)) << 2*32) | \
  91                 (((uint128_t)BIGEND32(b)) << 1*32) | \
  92                 (((uint128_t)BIGEND32(a)) << 0*32))
  93 #define HTON128(a) BIGEND128(a >> 3*32, a >> 2*32, a >> 1*32, a>> 0*32)
  94 // Yes, somehow macro'ing this changes LLVM's view of htons...
  95 #define BE16(a) ((((uint16_t)(a & 0xff00)) >> 8) | (((uint16_t)(a & 0xff)) << 8))
  96 #elif defined(__BIG_ENDIAN)
  97 #define BIGEND128(a, b, c, d) ((((uint128_t)a) << 3*32) | (((uint128_t)b) << 2*32) | (((uint128_t)c) << 1*32) | (((uint128_t)d) << 0*32))
  98 #define HTON128(a) (a)
  99 #else
 100 #error "Need endian info"
 101 #endif
 102
 103 #define MASK4(pfxlen) BIGEND32(~((((uint32_t)1) << (32 - pfxlen)) - 1))
 104 #define MASK6(pfxlen) HTON128(~((((uint128_t)1) << (128 - pfxlen)) - 1))
 105 #define MASK6_OFFS(offs, pfxlen) HTON128((~((((uint128_t)1) << (128 - pfxlen)) - 1)) & ((((uint128_t)1) << (128 - offs)) - 1))
 106
 107 // PARSE is used as a preprocessor flag to indicate parsing fields
 108 #define PARSE 42
 109 #include "rules.h"
 110
 111 #define unlikely(a) __builtin_expect(a, 0)
 112 #define likely(a) __builtin_expect(a, 1)
 113
 114 static const uint32_t PKT_LEN_DROP = 0;
 115 static const uint32_t VLAN_DROP = 1;
 116 static const uint32_t IHL_DROP = 2;
 117 static const uint32_t V6FRAG_DROP = 3;
 118 #define STATIC_RULE_CNT 4
 119
 120 #ifdef TEST
 121 // 64 bit version of xdp_md for testing
 122 struct xdp_md {
 123         __u64 data;
 124         __u64 data_end;
 125         __u64 data_meta;
 126         /* Below access go through struct xdp_rxq_info */
 127         __u64 ingress_ifindex; /* rxq->dev->ifindex */
 128         __u64 rx_queue_index;  /* rxq->queue_index  */
 129
 130         __u64 egress_ifindex;  /* txq->dev->ifindex */
 131 };
 132 static const int XDP_PASS = 0;
 133 static const int XDP_DROP = 1;
 134
 135 static long drop_cnt_map[RULECNT + STATIC_RULE_CNT];
 136 #define DO_RETURN(reason, ret) { \
 137                 if (ret == XDP_DROP) drop_cnt_map[reason] += 1; \
 138                 return ret; \
 139         }
 140
 141 #else
 142 #include <linux/bpf.h>
 143 #include <bpf/bpf_helpers.h>
 144
 145 struct bpf_map_def SEC("maps") drop_cnt_map = {
 146         .type = BPF_MAP_TYPE_PERCPU_ARRAY,
 147         .key_size = sizeof(uint32_t),
 148         .value_size = sizeof(long),
 149         .max_entries = RULECNT + STATIC_RULE_CNT,
 150 };
 151 #define DO_RETURN(reason, ret) {\
 152                 if (ret == XDP_DROP) { \
 153                         long *value = bpf_map_lookup_elem(&drop_cnt_map, &reason); \
 154                         if (value) \
 155                                 *value += 1; \
 156                 } \
 157                 return XDP_DROP; \
 158         }
 159
 160 SEC("xdp_drop")
 161 #endif
 162 int xdp_drop_prog(struct xdp_md *ctx)
 163 {
 164         const void *const data_end = (void *)(size_t)ctx->data_end;
 165
 166         const void * pktdata;
 167         unsigned short eth_proto;
 168
 169         {
 170                 if (unlikely((void*)(size_t)ctx->data + sizeof(struct ethhdr) > data_end))
 171                         DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 172                 const struct ethhdr *const eth = (void*)(size_t)ctx->data;
 173
 174 #if PARSE_8021Q == PARSE
 175                 if (likely(eth->h_proto == BE16(ETH_P_8021Q))) {
 176                         if (unlikely((void*)(size_t)ctx->data + sizeof(struct ethhdr_vlan) > data_end))
 177                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 178                         const struct ethhdr_vlan *const eth_vlan = (void*)(size_t)ctx->data;
 179
 180 #ifdef REQ_8021Q
 181                         if (unlikely((eth_vlan->tci & BE16(0xfff)) != BE16(REQ_8021Q)))
 182                                 DO_RETURN(VLAN_DROP, XDP_DROP);
 183 #endif
 184
 185                         eth_proto = eth_vlan->h_proto;
 186                         pktdata = (const void *)(long)ctx->data + sizeof(struct ethhdr_vlan);
 187 #else
 188                 if (unlikely(eth->h_proto == BE16(ETH_P_8021Q))) {
 189                         DO_RETURN(VLAN_DROP, PARSE_8021Q);
 190 #endif
 191                 } else {
 192 #ifdef REQ_8021Q
 193                         DO_RETURN(VLAN_DROP, XDP_DROP);
 194 #else
 195                         pktdata = (const void *)(long)ctx->data + sizeof(struct ethhdr);
 196                         eth_proto = eth->h_proto;
 197 #endif
 198                 }
 199         }
 200
 201 #ifdef NEED_V4_PARSE
 202         const struct iphdr *ip = NULL;
 203         const struct icmphdr *icmp = NULL;
 204 #endif
 205 #ifdef NEED_V6_PARSE
 206         const struct ip6hdr *ip6 = NULL;
 207         const struct icmp6hdr *icmpv6 = NULL;
 208         const struct ip6_fraghdr *frag6 = NULL;
 209 #endif
 210
 211         const void *l4hdr = NULL;
 212         const struct tcphdr *tcp = NULL;
 213         const struct udphdr *udp = NULL;
 214
 215 #ifdef NEED_V4_PARSE
 216         if (eth_proto == BE16(ETH_P_IP)) {
 217                 if (unlikely(pktdata + sizeof(struct iphdr) > data_end))
 218                         DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 219                 ip = (struct iphdr*) pktdata;
 220
 221 #if PARSE_IHL == PARSE
 222                 if (unlikely(ip->ihl < 5)) DO_RETURN(IHL_DROP, XDP_DROP);
 223                 l4hdr = pktdata + ip->ihl * 4;
 224 #else
 225                 if (ip->ihl != 5) DO_RETURN(IHL_DROP, PARSE_IHL);
 226                 l4hdr = pktdata + 5*4;
 227 #endif
 228
 229                 if (ip->protocol == IP_PROTO_TCP) {
 230                         if (unlikely(l4hdr + sizeof(struct tcphdr) > data_end))
 231                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 232                         tcp = (struct tcphdr*) l4hdr;
 233                 } else if (ip->protocol == IP_PROTO_UDP) {
 234                         if (unlikely(l4hdr + sizeof(struct udphdr) > data_end))
 235                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 236                         udp = (struct udphdr*) l4hdr;
 237                 } else if (ip->protocol == IP_PROTO_ICMP) {
 238                         if (unlikely(l4hdr + sizeof(struct icmphdr) > data_end))
 239                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 240                         icmp = (struct icmphdr*) l4hdr;
 241                 }
 242         }
 243 #endif
 244 #ifdef NEED_V6_PARSE
 245         if (eth_proto == BE16(ETH_P_IPV6)) {
 246                 if (unlikely(pktdata + sizeof(struct ip6hdr) > data_end))
 247                         DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 248                 ip6 = (struct ip6hdr*) pktdata;
 249
 250                 l4hdr = pktdata + 40;
 251
 252                 uint8_t v6nexthdr = ip6->nexthdr;
 253 #ifdef PARSE_V6_FRAG
 254 #if PARSE_V6_FRAG == PARSE
 255                 if (ip6->nexthdr == IP6_PROTO_FRAG) {
 256                         if (unlikely(l4hdr + sizeof(struct ip6_fraghdr) > data_end))
 257                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 258                         frag6 = (struct ip6_fraghdr*) l4hdr;
 259                         l4hdr = l4hdr + sizeof(struct ip6_fraghdr);
 260                         v6nexthdr = frag6->nexthdr;
 261 #else
 262                 if (unlikely(ip6->nexthdr == IP6_PROTO_FRAG)) {
 263                         DO_RETURN(V6FRAG_DROP, PARSE_V6_FRAG);
 264 #endif
 265                 }
 266 #endif
 267
 268                 if (v6nexthdr == IP_PROTO_TCP) {
 269                         if (unlikely(l4hdr + sizeof(struct tcphdr) > data_end))
 270                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 271                         tcp = (struct tcphdr*) l4hdr;
 272                 } else if (v6nexthdr == IP_PROTO_UDP) {
 273                         if (unlikely(l4hdr + sizeof(struct udphdr) > data_end))
 274                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 275                         udp = (struct udphdr*) l4hdr;
 276                 } else if (v6nexthdr == IP6_PROTO_ICMPV6) {
 277                         if (unlikely(l4hdr + sizeof(struct icmp6hdr) > data_end))
 278                                 DO_RETURN(PKT_LEN_DROP, XDP_DROP);
 279                         icmpv6 = (struct icmp6hdr*) l4hdr;
 280                 }
 281                 // TODO: Handle some options?
 282         }
 283 #endif
 284
 285         uint16_t sport, dport; // Host Endian! Only valid with tcp || udp
 286         if (tcp != NULL) {
 287                 sport = BE16(tcp->source);
 288                 dport = BE16(tcp->dest);
 289         } else if (udp != NULL) {
 290                 sport = BE16(udp->source);
 291                 dport = BE16(udp->dest);
 292         }
 293
 294         RULES
 295
 296         return XDP_PASS;
 297 }
 298
 299 #ifdef TEST
 300 #include <assert.h>
 301 #include <string.h>
 302
 303 const char d[] = TEST;
 304 int main() {
 305         struct xdp_md test = {
 306                 .data = (uint64_t)d,
 307                 // -1 because sizeof includes a trailing null in the "string"
 308                 .data_end = (uint64_t)(d + sizeof(d) - 1),
 309         };
 310         assert(xdp_drop_prog(&test) == TEST_EXP);
 311 }
 312 #endif