lib/flow.c

   1 /*
   2  * Copyright (c) 2008, 2009, 2010, 2011, 2012, 2013 Nicira, Inc.
   3  *
   4  * Licensed under the Apache License, Version 2.0 (the "License");
   5  * you may not use this file except in compliance with the License.
   6  * You may obtain a copy of the License at:
   7  *
   8  *     http://www.apache.org/licenses/LICENSE-2.0
   9  *
  10  * Unless required by applicable law or agreed to in writing, software
  11  * distributed under the License is distributed on an "AS IS" BASIS,
  12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13  * See the License for the specific language governing permissions and
  14  * limitations under the License.
  15  */
  16 #include <config.h>
  17 #include <sys/types.h>
  18 #include "flow.h"
  19 #include <errno.h>
  20 #include <inttypes.h>
  21 #include <limits.h>
  22 #include <netinet/in.h>
  23 #include <netinet/icmp6.h>
  24 #include <netinet/ip6.h>
  25 #include <stdint.h>
  26 #include <stdlib.h>
  27 #include <string.h>
  28 #include "byte-order.h"
  29 #include "coverage.h"
  30 #include "csum.h"
  31 #include "dynamic-string.h"
  32 #include "hash.h"
  33 #include "jhash.h"
  34 #include "match.h"
  35 #include "ofpbuf.h"
  36 #include "openflow/openflow.h"
  37 #include "packets.h"
  38 #include "random.h"
  39 #include "unaligned.h"
  40
  41 COVERAGE_DEFINE(flow_extract);
  42 COVERAGE_DEFINE(miniflow_malloc);
  43
  44 /* U32 indices for segmented flow classification. */
  45 const uint8_t flow_segment_u32s[4] = {
  46     FLOW_SEGMENT_1_ENDS_AT / 4,
  47     FLOW_SEGMENT_2_ENDS_AT / 4,
  48     FLOW_SEGMENT_3_ENDS_AT / 4,
  49     FLOW_U32S
  50 };
  51
  52 static struct arp_eth_header *
  53 pull_arp(struct ofpbuf *packet)
  54 {
  55     return ofpbuf_try_pull(packet, ARP_ETH_HEADER_LEN);
  56 }
  57
  58 static struct ip_header *
  59 pull_ip(struct ofpbuf *packet)
  60 {
  61     if (packet->size >= IP_HEADER_LEN) {
  62         struct ip_header *ip = packet->data;
  63         int ip_len = IP_IHL(ip->ip_ihl_ver) * 4;
  64         if (ip_len >= IP_HEADER_LEN && packet->size >= ip_len) {
  65             return ofpbuf_pull(packet, ip_len);
  66         }
  67     }
  68     return NULL;
  69 }
  70
  71 static struct tcp_header *
  72 pull_tcp(struct ofpbuf *packet)
  73 {
  74     if (packet->size >= TCP_HEADER_LEN) {
  75         struct tcp_header *tcp = packet->data;
  76         int tcp_len = TCP_OFFSET(tcp->tcp_ctl) * 4;
  77         if (tcp_len >= TCP_HEADER_LEN && packet->size >= tcp_len) {
  78             return ofpbuf_pull(packet, tcp_len);
  79         }
  80     }
  81     return NULL;
  82 }
  83
  84 static struct udp_header *
  85 pull_udp(struct ofpbuf *packet)
  86 {
  87     return ofpbuf_try_pull(packet, UDP_HEADER_LEN);
  88 }
  89
  90 static struct sctp_header *
  91 pull_sctp(struct ofpbuf *packet)
  92 {
  93     return ofpbuf_try_pull(packet, SCTP_HEADER_LEN);
  94 }
  95
  96 static struct icmp_header *
  97 pull_icmp(struct ofpbuf *packet)
  98 {
  99     return ofpbuf_try_pull(packet, ICMP_HEADER_LEN);
 100 }
 101
 102 static struct icmp6_hdr *
 103 pull_icmpv6(struct ofpbuf *packet)
 104 {
 105     return ofpbuf_try_pull(packet, sizeof(struct icmp6_hdr));
 106 }
 107
 108 static void
 109 parse_mpls(struct ofpbuf *b, struct flow *flow)
 110 {
 111     struct mpls_hdr *mh;
 112     bool top = true;
 113
 114     while ((mh = ofpbuf_try_pull(b, sizeof *mh))) {
 115         if (top) {
 116             top = false;
 117             flow->mpls_lse = mh->mpls_lse;
 118         }
 119         if (mh->mpls_lse & htonl(MPLS_BOS_MASK)) {
 120             break;
 121         }
 122     }
 123 }
 124
 125 static void
 126 parse_vlan(struct ofpbuf *b, struct flow *flow)
 127 {
 128     struct qtag_prefix {
 129         ovs_be16 eth_type;      /* ETH_TYPE_VLAN */
 130         ovs_be16 tci;
 131     };
 132
 133     if (b->size >= sizeof(struct qtag_prefix) + sizeof(ovs_be16)) {
 134         struct qtag_prefix *qp = ofpbuf_pull(b, sizeof *qp);
 135         flow->vlan_tci = qp->tci | htons(VLAN_CFI);
 136     }
 137 }
 138
 139 static ovs_be16
 140 parse_ethertype(struct ofpbuf *b)
 141 {
 142     struct llc_snap_header *llc;
 143     ovs_be16 proto;
 144
 145     proto = *(ovs_be16 *) ofpbuf_pull(b, sizeof proto);
 146     if (ntohs(proto) >= ETH_TYPE_MIN) {
 147         return proto;
 148     }
 149
 150     if (b->size < sizeof *llc) {
 151         return htons(FLOW_DL_TYPE_NONE);
 152     }
 153
 154     llc = b->data;
 155     if (llc->llc.llc_dsap != LLC_DSAP_SNAP
 156         || llc->llc.llc_ssap != LLC_SSAP_SNAP
 157         || llc->llc.llc_cntl != LLC_CNTL_SNAP
 158         || memcmp(llc->snap.snap_org, SNAP_ORG_ETHERNET,
 159                   sizeof llc->snap.snap_org)) {
 160         return htons(FLOW_DL_TYPE_NONE);
 161     }
 162
 163     ofpbuf_pull(b, sizeof *llc);
 164
 165     if (ntohs(llc->snap.snap_type) >= ETH_TYPE_MIN) {
 166         return llc->snap.snap_type;
 167     }
 168
 169     return htons(FLOW_DL_TYPE_NONE);
 170 }
 171
 172 static int
 173 parse_ipv6(struct ofpbuf *packet, struct flow *flow)
 174 {
 175     const struct ovs_16aligned_ip6_hdr *nh;
 176     ovs_be32 tc_flow;
 177     int nexthdr;
 178
 179     nh = ofpbuf_try_pull(packet, sizeof *nh);
 180     if (!nh) {
 181         return EINVAL;
 182     }
 183
 184     nexthdr = nh->ip6_nxt;
 185
 186     memcpy(&flow->ipv6_src, &nh->ip6_src, sizeof flow->ipv6_src);
 187     memcpy(&flow->ipv6_dst, &nh->ip6_dst, sizeof flow->ipv6_dst);
 188
 189     tc_flow = get_16aligned_be32(&nh->ip6_flow);
 190     flow->nw_tos = ntohl(tc_flow) >> 20;
 191     flow->ipv6_label = tc_flow & htonl(IPV6_LABEL_MASK);
 192     flow->nw_ttl = nh->ip6_hlim;
 193     flow->nw_proto = IPPROTO_NONE;
 194
 195     while (1) {
 196         if ((nexthdr != IPPROTO_HOPOPTS)
 197                 && (nexthdr != IPPROTO_ROUTING)
 198                 && (nexthdr != IPPROTO_DSTOPTS)
 199                 && (nexthdr != IPPROTO_AH)
 200                 && (nexthdr != IPPROTO_FRAGMENT)) {
 201             /* It's either a terminal header (e.g., TCP, UDP) or one we
 202              * don't understand.  In either case, we're done with the
 203              * packet, so use it to fill in 'nw_proto'. */
 204             break;
 205         }
 206
 207         /* We only verify that at least 8 bytes of the next header are
 208          * available, but many of these headers are longer.  Ensure that
 209          * accesses within the extension header are within those first 8
 210          * bytes. All extension headers are required to be at least 8
 211          * bytes. */
 212         if (packet->size < 8) {
 213             return EINVAL;
 214         }
 215
 216         if ((nexthdr == IPPROTO_HOPOPTS)
 217                 || (nexthdr == IPPROTO_ROUTING)
 218                 || (nexthdr == IPPROTO_DSTOPTS)) {
 219             /* These headers, while different, have the fields we care about
 220              * in the same location and with the same interpretation. */
 221             const struct ip6_ext *ext_hdr = packet->data;
 222             nexthdr = ext_hdr->ip6e_nxt;
 223             if (!ofpbuf_try_pull(packet, (ext_hdr->ip6e_len + 1) * 8)) {
 224                 return EINVAL;
 225             }
 226         } else if (nexthdr == IPPROTO_AH) {
 227             /* A standard AH definition isn't available, but the fields
 228              * we care about are in the same location as the generic
 229              * option header--only the header length is calculated
 230              * differently. */
 231             const struct ip6_ext *ext_hdr = packet->data;
 232             nexthdr = ext_hdr->ip6e_nxt;
 233             if (!ofpbuf_try_pull(packet, (ext_hdr->ip6e_len + 2) * 4)) {
 234                return EINVAL;
 235             }
 236         } else if (nexthdr == IPPROTO_FRAGMENT) {
 237             const struct ovs_16aligned_ip6_frag *frag_hdr = packet->data;
 238
 239             nexthdr = frag_hdr->ip6f_nxt;
 240             if (!ofpbuf_try_pull(packet, sizeof *frag_hdr)) {
 241                 return EINVAL;
 242             }
 243
 244             /* We only process the first fragment. */
 245             if (frag_hdr->ip6f_offlg != htons(0)) {
 246                 flow->nw_frag = FLOW_NW_FRAG_ANY;
 247                 if ((frag_hdr->ip6f_offlg & IP6F_OFF_MASK) != htons(0)) {
 248                     flow->nw_frag |= FLOW_NW_FRAG_LATER;
 249                     nexthdr = IPPROTO_FRAGMENT;
 250                     break;
 251                 }
 252             }
 253         }
 254     }
 255
 256     flow->nw_proto = nexthdr;
 257     return 0;
 258 }
 259
 260 static void
 261 parse_tcp(struct ofpbuf *packet, struct ofpbuf *b, struct flow *flow)
 262 {
 263     const struct tcp_header *tcp = pull_tcp(b);
 264     if (tcp) {
 265         flow->tp_src = tcp->tcp_src;
 266         flow->tp_dst = tcp->tcp_dst;
 267         flow->tcp_flags = tcp->tcp_ctl & htons(0x0fff);
 268         packet->l7 = b->data;
 269     }
 270 }
 271
 272 static void
 273 parse_udp(struct ofpbuf *packet, struct ofpbuf *b, struct flow *flow)
 274 {
 275     const struct udp_header *udp = pull_udp(b);
 276     if (udp) {
 277         flow->tp_src = udp->udp_src;
 278         flow->tp_dst = udp->udp_dst;
 279         packet->l7 = b->data;
 280     }
 281 }
 282
 283 static void
 284 parse_sctp(struct ofpbuf *packet, struct ofpbuf *b, struct flow *flow)
 285 {
 286     const struct sctp_header *sctp = pull_sctp(b);
 287     if (sctp) {
 288         flow->tp_src = sctp->sctp_src;
 289         flow->tp_dst = sctp->sctp_dst;
 290         packet->l7 = b->data;
 291     }
 292 }
 293
 294 static bool
 295 parse_icmpv6(struct ofpbuf *b, struct flow *flow)
 296 {
 297     const struct icmp6_hdr *icmp = pull_icmpv6(b);
 298
 299     if (!icmp) {
 300         return false;
 301     }
 302
 303     /* The ICMPv6 type and code fields use the 16-bit transport port
 304      * fields, so we need to store them in 16-bit network byte order. */
 305     flow->tp_src = htons(icmp->icmp6_type);
 306     flow->tp_dst = htons(icmp->icmp6_code);
 307
 308     if (icmp->icmp6_code == 0 &&
 309         (icmp->icmp6_type == ND_NEIGHBOR_SOLICIT ||
 310          icmp->icmp6_type == ND_NEIGHBOR_ADVERT)) {
 311         const struct in6_addr *nd_target;
 312
 313         nd_target = ofpbuf_try_pull(b, sizeof *nd_target);
 314         if (!nd_target) {
 315             return false;
 316         }
 317         flow->nd_target = *nd_target;
 318
 319         while (b->size >= 8) {
 320             /* The minimum size of an option is 8 bytes, which also is
 321              * the size of Ethernet link-layer options. */
 322             const struct nd_opt_hdr *nd_opt = b->data;
 323             int opt_len = nd_opt->nd_opt_len * 8;
 324
 325             if (!opt_len || opt_len > b->size) {
 326                 goto invalid;
 327             }
 328
 329             /* Store the link layer address if the appropriate option is
 330              * provided.  It is considered an error if the same link
 331              * layer option is specified twice. */
 332             if (nd_opt->nd_opt_type == ND_OPT_SOURCE_LINKADDR
 333                     && opt_len == 8) {
 334                 if (eth_addr_is_zero(flow->arp_sha)) {
 335                     memcpy(flow->arp_sha, nd_opt + 1, ETH_ADDR_LEN);
 336                 } else {
 337                     goto invalid;
 338                 }
 339             } else if (nd_opt->nd_opt_type == ND_OPT_TARGET_LINKADDR
 340                     && opt_len == 8) {
 341                 if (eth_addr_is_zero(flow->arp_tha)) {
 342                     memcpy(flow->arp_tha, nd_opt + 1, ETH_ADDR_LEN);
 343                 } else {
 344                     goto invalid;
 345                 }
 346             }
 347
 348             if (!ofpbuf_try_pull(b, opt_len)) {
 349                 goto invalid;
 350             }
 351         }
 352     }
 353
 354     return true;
 355
 356 invalid:
 357     memset(&flow->nd_target, 0, sizeof(flow->nd_target));
 358     memset(flow->arp_sha, 0, sizeof(flow->arp_sha));
 359     memset(flow->arp_tha, 0, sizeof(flow->arp_tha));
 360
 361     return false;
 362
 363 }
 364
 365 /* Initializes 'flow' members from 'packet', 'skb_priority', 'tnl', and
 366  * 'in_port'.
 367  *
 368  * Initializes 'packet' header pointers as follows:
 369  *
 370  *    - packet->l2 to the start of the Ethernet header.
 371  *
 372  *    - packet->l2_5 to the start of the MPLS shim header.
 373  *
 374  *    - packet->l3 to just past the Ethernet header, or just past the
 375  *      vlan_header if one is present, to the first byte of the payload of the
 376  *      Ethernet frame.
 377  *
 378  *    - packet->l4 to just past the IPv4 header, if one is present and has a
 379  *      correct length, and otherwise NULL.
 380  *
 381  *    - packet->l7 to just past the TCP/UDP/SCTP/ICMP header, if one is
 382  *      present and has a correct length, and otherwise NULL.
 383  */
 384 void
 385 flow_extract(struct ofpbuf *packet, uint32_t skb_priority, uint32_t pkt_mark,
 386              const struct flow_tnl *tnl, const union flow_in_port *in_port,
 387              struct flow *flow)
 388 {
 389     struct ofpbuf b = *packet;
 390     struct eth_header *eth;
 391
 392     COVERAGE_INC(flow_extract);
 393
 394     memset(flow, 0, sizeof *flow);
 395
 396     if (tnl) {
 397         ovs_assert(tnl != &flow->tunnel);
 398         flow->tunnel = *tnl;
 399     }
 400     if (in_port) {
 401         flow->in_port = *in_port;
 402     }
 403     flow->skb_priority = skb_priority;
 404     flow->pkt_mark = pkt_mark;
 405
 406     packet->l2   = b.data;
 407     packet->l2_5 = NULL;
 408     packet->l3   = NULL;
 409     packet->l4   = NULL;
 410     packet->l7   = NULL;
 411
 412     if (b.size < sizeof *eth) {
 413         return;
 414     }
 415
 416     /* Link layer. */
 417     eth = b.data;
 418     memcpy(flow->dl_src, eth->eth_src, ETH_ADDR_LEN);
 419     memcpy(flow->dl_dst, eth->eth_dst, ETH_ADDR_LEN);
 420
 421     /* dl_type, vlan_tci. */
 422     ofpbuf_pull(&b, ETH_ADDR_LEN * 2);
 423     if (eth->eth_type == htons(ETH_TYPE_VLAN)) {
 424         parse_vlan(&b, flow);
 425     }
 426     flow->dl_type = parse_ethertype(&b);
 427
 428     /* Parse mpls, copy l3 ttl. */
 429     if (eth_type_mpls(flow->dl_type)) {
 430         packet->l2_5 = b.data;
 431         parse_mpls(&b, flow);
 432     }
 433
 434     /* Network layer. */
 435     packet->l3 = b.data;
 436     if (flow->dl_type == htons(ETH_TYPE_IP)) {
 437         const struct ip_header *nh = pull_ip(&b);
 438         if (nh) {
 439             packet->l4 = b.data;
 440
 441             flow->nw_src = get_16aligned_be32(&nh->ip_src);
 442             flow->nw_dst = get_16aligned_be32(&nh->ip_dst);
 443             flow->nw_proto = nh->ip_proto;
 444
 445             flow->nw_tos = nh->ip_tos;
 446             if (IP_IS_FRAGMENT(nh->ip_frag_off)) {
 447                 flow->nw_frag = FLOW_NW_FRAG_ANY;
 448                 if (nh->ip_frag_off & htons(IP_FRAG_OFF_MASK)) {
 449                     flow->nw_frag |= FLOW_NW_FRAG_LATER;
 450                 }
 451             }
 452             flow->nw_ttl = nh->ip_ttl;
 453
 454             if (!(nh->ip_frag_off & htons(IP_FRAG_OFF_MASK))) {
 455                 if (flow->nw_proto == IPPROTO_TCP) {
 456                     parse_tcp(packet, &b, flow);
 457                 } else if (flow->nw_proto == IPPROTO_UDP) {
 458                     parse_udp(packet, &b, flow);
 459                 } else if (flow->nw_proto == IPPROTO_SCTP) {
 460                     parse_sctp(packet, &b, flow);
 461                 } else if (flow->nw_proto == IPPROTO_ICMP) {
 462                     const struct icmp_header *icmp = pull_icmp(&b);
 463                     if (icmp) {
 464                         flow->tp_src = htons(icmp->icmp_type);
 465                         flow->tp_dst = htons(icmp->icmp_code);
 466                         packet->l7 = b.data;
 467                     }
 468                 }
 469             }
 470         }
 471     } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
 472         if (parse_ipv6(&b, flow)) {
 473             return;
 474         }
 475
 476         packet->l4 = b.data;
 477         if (flow->nw_proto == IPPROTO_TCP) {
 478             parse_tcp(packet, &b, flow);
 479         } else if (flow->nw_proto == IPPROTO_UDP) {
 480             parse_udp(packet, &b, flow);
 481         } else if (flow->nw_proto == IPPROTO_SCTP) {
 482             parse_sctp(packet, &b, flow);
 483         } else if (flow->nw_proto == IPPROTO_ICMPV6) {
 484             if (parse_icmpv6(&b, flow)) {
 485                 packet->l7 = b.data;
 486             }
 487         }
 488     } else if (flow->dl_type == htons(ETH_TYPE_ARP) ||
 489                flow->dl_type == htons(ETH_TYPE_RARP)) {
 490         const struct arp_eth_header *arp = pull_arp(&b);
 491         if (arp && arp->ar_hrd == htons(1)
 492             && arp->ar_pro == htons(ETH_TYPE_IP)
 493             && arp->ar_hln == ETH_ADDR_LEN
 494             && arp->ar_pln == 4) {
 495             /* We only match on the lower 8 bits of the opcode. */
 496             if (ntohs(arp->ar_op) <= 0xff) {
 497                 flow->nw_proto = ntohs(arp->ar_op);
 498             }
 499
 500             flow->nw_src = get_16aligned_be32(&arp->ar_spa);
 501             flow->nw_dst = get_16aligned_be32(&arp->ar_tpa);
 502             memcpy(flow->arp_sha, arp->ar_sha, ETH_ADDR_LEN);
 503             memcpy(flow->arp_tha, arp->ar_tha, ETH_ADDR_LEN);
 504         }
 505     }
 506 }
 507
 508 /* For every bit of a field that is wildcarded in 'wildcards', sets the
 509  * corresponding bit in 'flow' to zero. */
 510 void
 511 flow_zero_wildcards(struct flow *flow, const struct flow_wildcards *wildcards)
 512 {
 513     uint32_t *flow_u32 = (uint32_t *) flow;
 514     const uint32_t *wc_u32 = (const uint32_t *) &wildcards->masks;
 515     size_t i;
 516
 517     for (i = 0; i < FLOW_U32S; i++) {
 518         flow_u32[i] &= wc_u32[i];
 519     }
 520 }
 521
 522 /* Initializes 'fmd' with the metadata found in 'flow'. */
 523 void
 524 flow_get_metadata(const struct flow *flow, struct flow_metadata *fmd)
 525 {
 526     BUILD_ASSERT_DECL(FLOW_WC_SEQ == 23);
 527
 528     fmd->tun_id = flow->tunnel.tun_id;
 529     fmd->tun_src = flow->tunnel.ip_src;
 530     fmd->tun_dst = flow->tunnel.ip_dst;
 531     fmd->metadata = flow->metadata;
 532     memcpy(fmd->regs, flow->regs, sizeof fmd->regs);
 533     fmd->pkt_mark = flow->pkt_mark;
 534     fmd->in_port = flow->in_port.ofp_port;
 535 }
 536
 537 char *
 538 flow_to_string(const struct flow *flow)
 539 {
 540     struct ds ds = DS_EMPTY_INITIALIZER;
 541     flow_format(&ds, flow);
 542     return ds_cstr(&ds);
 543 }
 544
 545 const char *
 546 flow_tun_flag_to_string(uint32_t flags)
 547 {
 548     switch (flags) {
 549     case FLOW_TNL_F_DONT_FRAGMENT:
 550         return "df";
 551     case FLOW_TNL_F_CSUM:
 552         return "csum";
 553     case FLOW_TNL_F_KEY:
 554         return "key";
 555     default:
 556         return NULL;
 557     }
 558 }
 559
 560 void
 561 format_flags(struct ds *ds, const char *(*bit_to_string)(uint32_t),
 562              uint32_t flags, char del)
 563 {
 564     uint32_t bad = 0;
 565
 566     if (!flags) {
 567         return;
 568     }
 569     while (flags) {
 570         uint32_t bit = rightmost_1bit(flags);
 571         const char *s;
 572
 573         s = bit_to_string(bit);
 574         if (s) {
 575             ds_put_format(ds, "%s%c", s, del);
 576         } else {
 577             bad |= bit;
 578         }
 579
 580         flags &= ~bit;
 581     }
 582
 583     if (bad) {
 584         ds_put_format(ds, "0x%"PRIx32"%c", bad, del);
 585     }
 586     ds_chomp(ds, del);
 587 }
 588
 589 void
 590 format_flags_masked(struct ds *ds, const char *name,
 591                     const char *(*bit_to_string)(uint32_t), uint32_t flags,
 592                     uint32_t mask)
 593 {
 594     if (name) {
 595         ds_put_format(ds, "%s=", name);
 596     }
 597     while (mask) {
 598         uint32_t bit = rightmost_1bit(mask);
 599         const char *s = bit_to_string(bit);
 600
 601         ds_put_format(ds, "%s%s", (flags & bit) ? "+" : "-",
 602                       s ? s : "[Unknown]");
 603         mask &= ~bit;
 604     }
 605 }
 606
 607 void
 608 flow_format(struct ds *ds, const struct flow *flow)
 609 {
 610     struct match match;
 611
 612     match_wc_init(&match, flow);
 613     match_format(&match, ds, OFP_DEFAULT_PRIORITY);
 614 }
 615
 616 void
 617 flow_print(FILE *stream, const struct flow *flow)
 618 {
 619     char *s = flow_to_string(flow);
 620     fputs(s, stream);
 621     free(s);
 622 }
 623 \f
 624 /* flow_wildcards functions. */
 625
 626 /* Initializes 'wc' as a set of wildcards that matches every packet. */
 627 void
 628 flow_wildcards_init_catchall(struct flow_wildcards *wc)
 629 {
 630     memset(&wc->masks, 0, sizeof wc->masks);
 631 }
 632
 633 /* Clear the metadata and register wildcard masks. They are not packet
 634  * header fields. */
 635 void
 636 flow_wildcards_clear_non_packet_fields(struct flow_wildcards *wc)
 637 {
 638     memset(&wc->masks.metadata, 0, sizeof wc->masks.metadata);
 639     memset(&wc->masks.regs, 0, sizeof wc->masks.regs);
 640 }
 641
 642 /* Returns true if 'wc' matches every packet, false if 'wc' fixes any bits or
 643  * fields. */
 644 bool
 645 flow_wildcards_is_catchall(const struct flow_wildcards *wc)
 646 {
 647     const uint32_t *wc_u32 = (const uint32_t *) &wc->masks;
 648     size_t i;
 649
 650     for (i = 0; i < FLOW_U32S; i++) {
 651         if (wc_u32[i]) {
 652             return false;
 653         }
 654     }
 655     return true;
 656 }
 657
 658 /* Sets 'dst' as the bitwise AND of wildcards in 'src1' and 'src2'.
 659  * That is, a bit or a field is wildcarded in 'dst' if it is wildcarded
 660  * in 'src1' or 'src2' or both.  */
 661 void
 662 flow_wildcards_and(struct flow_wildcards *dst,
 663                    const struct flow_wildcards *src1,
 664                    const struct flow_wildcards *src2)
 665 {
 666     uint32_t *dst_u32 = (uint32_t *) &dst->masks;
 667     const uint32_t *src1_u32 = (const uint32_t *) &src1->masks;
 668     const uint32_t *src2_u32 = (const uint32_t *) &src2->masks;
 669     size_t i;
 670
 671     for (i = 0; i < FLOW_U32S; i++) {
 672         dst_u32[i] = src1_u32[i] & src2_u32[i];
 673     }
 674 }
 675
 676 /* Sets 'dst' as the bitwise OR of wildcards in 'src1' and 'src2'.  That
 677  * is, a bit or a field is wildcarded in 'dst' if it is neither
 678  * wildcarded in 'src1' nor 'src2'. */
 679 void
 680 flow_wildcards_or(struct flow_wildcards *dst,
 681                   const struct flow_wildcards *src1,
 682                   const struct flow_wildcards *src2)
 683 {
 684     uint32_t *dst_u32 = (uint32_t *) &dst->masks;
 685     const uint32_t *src1_u32 = (const uint32_t *) &src1->masks;
 686     const uint32_t *src2_u32 = (const uint32_t *) &src2->masks;
 687     size_t i;
 688
 689     for (i = 0; i < FLOW_U32S; i++) {
 690         dst_u32[i] = src1_u32[i] | src2_u32[i];
 691     }
 692 }
 693
 694 /* Perform a bitwise OR of miniflow 'src' flow data with the equivalent
 695  * fields in 'dst', storing the result in 'dst'. */
 696 static void
 697 flow_union_with_miniflow(struct flow *dst, const struct miniflow *src)
 698 {
 699     uint32_t *dst_u32 = (uint32_t *) dst;
 700     const uint32_t *p = src->values;
 701     uint64_t map;
 702
 703     for (map = src->map; map; map = zero_rightmost_1bit(map)) {
 704         dst_u32[raw_ctz(map)] |= *p++;
 705     }
 706 }
 707
 708 /* Fold minimask 'mask''s wildcard mask into 'wc's wildcard mask. */
 709 void
 710 flow_wildcards_fold_minimask(struct flow_wildcards *wc,
 711                              const struct minimask *mask)
 712 {
 713     flow_union_with_miniflow(&wc->masks, &mask->masks);
 714 }
 715
 716 inline uint64_t
 717 miniflow_get_map_in_range(const struct miniflow *miniflow,
 718                           uint8_t start, uint8_t end, const uint32_t **data)
 719 {
 720     uint64_t map = miniflow->map;
 721     uint32_t *p = miniflow->values;
 722
 723     if (start > 0) {
 724         uint64_t msk = (UINT64_C(1) << start) - 1; /* 'start' LSBs set */
 725         p += count_1bits(map & msk);  /* Skip to start. */
 726         map &= ~msk;
 727     }
 728     if (end < FLOW_U32S) {
 729         uint64_t msk = (UINT64_C(1) << end) - 1; /* 'end' LSBs set */
 730         map &= msk;
 731     }
 732
 733     *data = p;
 734     return map;
 735 }
 736
 737 /* Fold minimask 'mask''s wildcard mask into 'wc's wildcard mask
 738  * in range [start, end). */
 739 void
 740 flow_wildcards_fold_minimask_range(struct flow_wildcards *wc,
 741                                    const struct minimask *mask,
 742                                    uint8_t start, uint8_t end)
 743 {
 744     uint32_t *dst_u32 = (uint32_t *)&wc->masks;
 745     const uint32_t *p;
 746     uint64_t map = miniflow_get_map_in_range(&mask->masks, start, end, &p);
 747
 748     for (; map; map = zero_rightmost_1bit(map)) {
 749         dst_u32[raw_ctz(map)] |= *p++;
 750     }
 751 }
 752
 753 /* Returns a hash of the wildcards in 'wc'. */
 754 uint32_t
 755 flow_wildcards_hash(const struct flow_wildcards *wc, uint32_t basis)
 756 {
 757     return flow_hash(&wc->masks, basis);
 758 }
 759
 760 /* Returns true if 'a' and 'b' represent the same wildcards, false if they are
 761  * different. */
 762 bool
 763 flow_wildcards_equal(const struct flow_wildcards *a,
 764                      const struct flow_wildcards *b)
 765 {
 766     return flow_equal(&a->masks, &b->masks);
 767 }
 768
 769 /* Returns true if at least one bit or field is wildcarded in 'a' but not in
 770  * 'b', false otherwise. */
 771 bool
 772 flow_wildcards_has_extra(const struct flow_wildcards *a,
 773                          const struct flow_wildcards *b)
 774 {
 775     const uint32_t *a_u32 = (const uint32_t *) &a->masks;
 776     const uint32_t *b_u32 = (const uint32_t *) &b->masks;
 777     size_t i;
 778
 779     for (i = 0; i < FLOW_U32S; i++) {
 780         if ((a_u32[i] & b_u32[i]) != b_u32[i]) {
 781             return true;
 782         }
 783     }
 784     return false;
 785 }
 786
 787 /* Returns true if 'a' and 'b' are equal, except that 0-bits (wildcarded bits)
 788  * in 'wc' do not need to be equal in 'a' and 'b'. */
 789 bool
 790 flow_equal_except(const struct flow *a, const struct flow *b,
 791                   const struct flow_wildcards *wc)
 792 {
 793     const uint32_t *a_u32 = (const uint32_t *) a;
 794     const uint32_t *b_u32 = (const uint32_t *) b;
 795     const uint32_t *wc_u32 = (const uint32_t *) &wc->masks;
 796     size_t i;
 797
 798     for (i = 0; i < FLOW_U32S; i++) {
 799         if ((a_u32[i] ^ b_u32[i]) & wc_u32[i]) {
 800             return false;
 801         }
 802     }
 803     return true;
 804 }
 805
 806 /* Sets the wildcard mask for register 'idx' in 'wc' to 'mask'.
 807  * (A 0-bit indicates a wildcard bit.) */
 808 void
 809 flow_wildcards_set_reg_mask(struct flow_wildcards *wc, int idx, uint32_t mask)
 810 {
 811     wc->masks.regs[idx] = mask;
 812 }
 813
 814 /* Hashes 'flow' based on its L2 through L4 protocol information. */
 815 uint32_t
 816 flow_hash_symmetric_l4(const struct flow *flow, uint32_t basis)
 817 {
 818     struct {
 819         union {
 820             ovs_be32 ipv4_addr;
 821             struct in6_addr ipv6_addr;
 822         };
 823         ovs_be16 eth_type;
 824         ovs_be16 vlan_tci;
 825         ovs_be16 tp_port;
 826         uint8_t eth_addr[ETH_ADDR_LEN];
 827         uint8_t ip_proto;
 828     } fields;
 829
 830     int i;
 831
 832     memset(&fields, 0, sizeof fields);
 833     for (i = 0; i < ETH_ADDR_LEN; i++) {
 834         fields.eth_addr[i] = flow->dl_src[i] ^ flow->dl_dst[i];
 835     }
 836     fields.vlan_tci = flow->vlan_tci & htons(VLAN_VID_MASK);
 837     fields.eth_type = flow->dl_type;
 838
 839     /* UDP source and destination port are not taken into account because they
 840      * will not necessarily be symmetric in a bidirectional flow. */
 841     if (fields.eth_type == htons(ETH_TYPE_IP)) {
 842         fields.ipv4_addr = flow->nw_src ^ flow->nw_dst;
 843         fields.ip_proto = flow->nw_proto;
 844         if (fields.ip_proto == IPPROTO_TCP || fields.ip_proto == IPPROTO_SCTP) {
 845             fields.tp_port = flow->tp_src ^ flow->tp_dst;
 846         }
 847     } else if (fields.eth_type == htons(ETH_TYPE_IPV6)) {
 848         const uint8_t *a = &flow->ipv6_src.s6_addr[0];
 849         const uint8_t *b = &flow->ipv6_dst.s6_addr[0];
 850         uint8_t *ipv6_addr = &fields.ipv6_addr.s6_addr[0];
 851
 852         for (i=0; i<16; i++) {
 853             ipv6_addr[i] = a[i] ^ b[i];
 854         }
 855         fields.ip_proto = flow->nw_proto;
 856         if (fields.ip_proto == IPPROTO_TCP || fields.ip_proto == IPPROTO_SCTP) {
 857             fields.tp_port = flow->tp_src ^ flow->tp_dst;
 858         }
 859     }
 860     return jhash_bytes(&fields, sizeof fields, basis);
 861 }
 862
 863 /* Initialize a flow with random fields that matter for nx_hash_fields. */
 864 void
 865 flow_random_hash_fields(struct flow *flow)
 866 {
 867     uint16_t rnd = random_uint16();
 868
 869     /* Initialize to all zeros. */
 870     memset(flow, 0, sizeof *flow);
 871
 872     eth_addr_random(flow->dl_src);
 873     eth_addr_random(flow->dl_dst);
 874
 875     flow->vlan_tci = (OVS_FORCE ovs_be16) (random_uint16() & VLAN_VID_MASK);
 876
 877     /* Make most of the random flows IPv4, some IPv6, and rest random. */
 878     flow->dl_type = rnd < 0x8000 ? htons(ETH_TYPE_IP) :
 879         rnd < 0xc000 ? htons(ETH_TYPE_IPV6) : (OVS_FORCE ovs_be16)rnd;
 880
 881     if (dl_type_is_ip_any(flow->dl_type)) {
 882         if (flow->dl_type == htons(ETH_TYPE_IP)) {
 883             flow->nw_src = (OVS_FORCE ovs_be32)random_uint32();
 884             flow->nw_dst = (OVS_FORCE ovs_be32)random_uint32();
 885         } else {
 886             random_bytes(&flow->ipv6_src, sizeof flow->ipv6_src);
 887             random_bytes(&flow->ipv6_dst, sizeof flow->ipv6_dst);
 888         }
 889         /* Make most of IP flows TCP, some UDP or SCTP, and rest random. */
 890         rnd = random_uint16();
 891         flow->nw_proto = rnd < 0x8000 ? IPPROTO_TCP :
 892             rnd < 0xc000 ? IPPROTO_UDP :
 893             rnd < 0xd000 ? IPPROTO_SCTP : (uint8_t)rnd;
 894         if (flow->nw_proto == IPPROTO_TCP ||
 895             flow->nw_proto == IPPROTO_UDP ||
 896             flow->nw_proto == IPPROTO_SCTP) {
 897             flow->tp_src = (OVS_FORCE ovs_be16)random_uint16();
 898             flow->tp_dst = (OVS_FORCE ovs_be16)random_uint16();
 899         }
 900     }
 901 }
 902
 903 /* Masks the fields in 'wc' that are used by the flow hash 'fields'. */
 904 void
 905 flow_mask_hash_fields(const struct flow *flow, struct flow_wildcards *wc,
 906                       enum nx_hash_fields fields)
 907 {
 908     switch (fields) {
 909     case NX_HASH_FIELDS_ETH_SRC:
 910         memset(&wc->masks.dl_src, 0xff, sizeof wc->masks.dl_src);
 911         break;
 912
 913     case NX_HASH_FIELDS_SYMMETRIC_L4:
 914         memset(&wc->masks.dl_src, 0xff, sizeof wc->masks.dl_src);
 915         memset(&wc->masks.dl_dst, 0xff, sizeof wc->masks.dl_dst);
 916         if (flow->dl_type == htons(ETH_TYPE_IP)) {
 917             memset(&wc->masks.nw_src, 0xff, sizeof wc->masks.nw_src);
 918             memset(&wc->masks.nw_dst, 0xff, sizeof wc->masks.nw_dst);
 919         } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
 920             memset(&wc->masks.ipv6_src, 0xff, sizeof wc->masks.ipv6_src);
 921             memset(&wc->masks.ipv6_dst, 0xff, sizeof wc->masks.ipv6_dst);
 922         }
 923         if (is_ip_any(flow)) {
 924             memset(&wc->masks.nw_proto, 0xff, sizeof wc->masks.nw_proto);
 925             memset(&wc->masks.tp_src, 0xff, sizeof wc->masks.tp_src);
 926             memset(&wc->masks.tp_dst, 0xff, sizeof wc->masks.tp_dst);
 927         }
 928         wc->masks.vlan_tci |= htons(VLAN_VID_MASK | VLAN_CFI);
 929         break;
 930
 931     default:
 932         NOT_REACHED();
 933     }
 934 }
 935
 936 /* Hashes the portions of 'flow' designated by 'fields'. */
 937 uint32_t
 938 flow_hash_fields(const struct flow *flow, enum nx_hash_fields fields,
 939                  uint16_t basis)
 940 {
 941     switch (fields) {
 942
 943     case NX_HASH_FIELDS_ETH_SRC:
 944         return jhash_bytes(flow->dl_src, sizeof flow->dl_src, basis);
 945
 946     case NX_HASH_FIELDS_SYMMETRIC_L4:
 947         return flow_hash_symmetric_l4(flow, basis);
 948     }
 949
 950     NOT_REACHED();
 951 }
 952
 953 /* Returns a string representation of 'fields'. */
 954 const char *
 955 flow_hash_fields_to_str(enum nx_hash_fields fields)
 956 {
 957     switch (fields) {
 958     case NX_HASH_FIELDS_ETH_SRC: return "eth_src";
 959     case NX_HASH_FIELDS_SYMMETRIC_L4: return "symmetric_l4";
 960     default: return "<unknown>";
 961     }
 962 }
 963
 964 /* Returns true if the value of 'fields' is supported. Otherwise false. */
 965 bool
 966 flow_hash_fields_valid(enum nx_hash_fields fields)
 967 {
 968     return fields == NX_HASH_FIELDS_ETH_SRC
 969         || fields == NX_HASH_FIELDS_SYMMETRIC_L4;
 970 }
 971
 972 /* Returns a hash value for the bits of 'flow' that are active based on
 973  * 'wc', given 'basis'. */
 974 uint32_t
 975 flow_hash_in_wildcards(const struct flow *flow,
 976                        const struct flow_wildcards *wc, uint32_t basis)
 977 {
 978     const uint32_t *wc_u32 = (const uint32_t *) &wc->masks;
 979     const uint32_t *flow_u32 = (const uint32_t *) flow;
 980     uint32_t hash;
 981     size_t i;
 982
 983     hash = basis;
 984     for (i = 0; i < FLOW_U32S; i++) {
 985         hash = mhash_add(hash, flow_u32[i] & wc_u32[i]);
 986     }
 987     return mhash_finish(hash, 4 * FLOW_U32S);
 988 }
 989
 990 /* Sets the VLAN VID that 'flow' matches to 'vid', which is interpreted as an
 991  * OpenFlow 1.0 "dl_vlan" value:
 992  *
 993  *      - If it is in the range 0...4095, 'flow->vlan_tci' is set to match
 994  *        that VLAN.  Any existing PCP match is unchanged (it becomes 0 if
 995  *        'flow' previously matched packets without a VLAN header).
 996  *
 997  *      - If it is OFP_VLAN_NONE, 'flow->vlan_tci' is set to match a packet
 998  *        without a VLAN tag.
 999  *
1000  *      - Other values of 'vid' should not be used. */
1001 void
1002 flow_set_dl_vlan(struct flow *flow, ovs_be16 vid)
1003 {
1004     if (vid == htons(OFP10_VLAN_NONE)) {
1005         flow->vlan_tci = htons(0);
1006     } else {
1007         vid &= htons(VLAN_VID_MASK);
1008         flow->vlan_tci &= ~htons(VLAN_VID_MASK);
1009         flow->vlan_tci |= htons(VLAN_CFI) | vid;
1010     }
1011 }
1012
1013 /* Sets the VLAN VID that 'flow' matches to 'vid', which is interpreted as an
1014  * OpenFlow 1.2 "vlan_vid" value, that is, the low 13 bits of 'vlan_tci' (VID
1015  * plus CFI). */
1016 void
1017 flow_set_vlan_vid(struct flow *flow, ovs_be16 vid)
1018 {
1019     ovs_be16 mask = htons(VLAN_VID_MASK | VLAN_CFI);
1020     flow->vlan_tci &= ~mask;
1021     flow->vlan_tci |= vid & mask;
1022 }
1023
1024 /* Sets the VLAN PCP that 'flow' matches to 'pcp', which should be in the
1025  * range 0...7.
1026  *
1027  * This function has no effect on the VLAN ID that 'flow' matches.
1028  *
1029  * After calling this function, 'flow' will not match packets without a VLAN
1030  * header. */
1031 void
1032 flow_set_vlan_pcp(struct flow *flow, uint8_t pcp)
1033 {
1034     pcp &= 0x07;
1035     flow->vlan_tci &= ~htons(VLAN_PCP_MASK);
1036     flow->vlan_tci |= htons((pcp << VLAN_PCP_SHIFT) | VLAN_CFI);
1037 }
1038
1039 /* Sets the MPLS Label that 'flow' matches to 'label', which is interpreted
1040  * as an OpenFlow 1.1 "mpls_label" value. */
1041 void
1042 flow_set_mpls_label(struct flow *flow, ovs_be32 label)
1043 {
1044     set_mpls_lse_label(&flow->mpls_lse, label);
1045 }
1046
1047 /* Sets the MPLS TTL that 'flow' matches to 'ttl', which should be in the
1048  * range 0...255. */
1049 void
1050 flow_set_mpls_ttl(struct flow *flow, uint8_t ttl)
1051 {
1052     set_mpls_lse_ttl(&flow->mpls_lse, ttl);
1053 }
1054
1055 /* Sets the MPLS TC that 'flow' matches to 'tc', which should be in the
1056  * range 0...7. */
1057 void
1058 flow_set_mpls_tc(struct flow *flow, uint8_t tc)
1059 {
1060     set_mpls_lse_tc(&flow->mpls_lse, tc);
1061 }
1062
1063 /* Sets the MPLS BOS bit that 'flow' matches to which should be 0 or 1. */
1064 void
1065 flow_set_mpls_bos(struct flow *flow, uint8_t bos)
1066 {
1067     set_mpls_lse_bos(&flow->mpls_lse, bos);
1068 }
1069
1070
1071 static void
1072 flow_compose_l4(struct ofpbuf *b, const struct flow *flow)
1073 {
1074     if (!(flow->nw_frag & FLOW_NW_FRAG_ANY)
1075         || !(flow->nw_frag & FLOW_NW_FRAG_LATER)) {
1076         if (flow->nw_proto == IPPROTO_TCP) {
1077             struct tcp_header *tcp;
1078
1079             tcp = ofpbuf_put_zeros(b, sizeof *tcp);
1080             tcp->tcp_src = flow->tp_src;
1081             tcp->tcp_dst = flow->tp_dst;
1082             tcp->tcp_ctl = TCP_CTL(ntohs(flow->tcp_flags), 5);
1083             b->l7 = ofpbuf_tail(b);
1084         } else if (flow->nw_proto == IPPROTO_UDP) {
1085             struct udp_header *udp;
1086
1087             udp = ofpbuf_put_zeros(b, sizeof *udp);
1088             udp->udp_src = flow->tp_src;
1089             udp->udp_dst = flow->tp_dst;
1090             b->l7 = ofpbuf_tail(b);
1091         } else if (flow->nw_proto == IPPROTO_SCTP) {
1092             struct sctp_header *sctp;
1093
1094             sctp = ofpbuf_put_zeros(b, sizeof *sctp);
1095             sctp->sctp_src = flow->tp_src;
1096             sctp->sctp_dst = flow->tp_dst;
1097             b->l7 = ofpbuf_tail(b);
1098         } else if (flow->nw_proto == IPPROTO_ICMP) {
1099             struct icmp_header *icmp;
1100
1101             icmp = ofpbuf_put_zeros(b, sizeof *icmp);
1102             icmp->icmp_type = ntohs(flow->tp_src);
1103             icmp->icmp_code = ntohs(flow->tp_dst);
1104             icmp->icmp_csum = csum(icmp, ICMP_HEADER_LEN);
1105             b->l7 = ofpbuf_tail(b);
1106         } else if (flow->nw_proto == IPPROTO_ICMPV6) {
1107             struct icmp6_hdr *icmp;
1108
1109             icmp = ofpbuf_put_zeros(b, sizeof *icmp);
1110             icmp->icmp6_type = ntohs(flow->tp_src);
1111             icmp->icmp6_code = ntohs(flow->tp_dst);
1112
1113             if (icmp->icmp6_code == 0 &&
1114                 (icmp->icmp6_type == ND_NEIGHBOR_SOLICIT ||
1115                  icmp->icmp6_type == ND_NEIGHBOR_ADVERT)) {
1116                 struct in6_addr *nd_target;
1117                 struct nd_opt_hdr *nd_opt;
1118
1119                 nd_target = ofpbuf_put_zeros(b, sizeof *nd_target);
1120                 *nd_target = flow->nd_target;
1121
1122                 if (!eth_addr_is_zero(flow->arp_sha)) {
1123                     nd_opt = ofpbuf_put_zeros(b, 8);
1124                     nd_opt->nd_opt_len = 1;
1125                     nd_opt->nd_opt_type = ND_OPT_SOURCE_LINKADDR;
1126                     memcpy(nd_opt + 1, flow->arp_sha, ETH_ADDR_LEN);
1127                 }
1128                 if (!eth_addr_is_zero(flow->arp_tha)) {
1129                     nd_opt = ofpbuf_put_zeros(b, 8);
1130                     nd_opt->nd_opt_len = 1;
1131                     nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR;
1132                     memcpy(nd_opt + 1, flow->arp_tha, ETH_ADDR_LEN);
1133                 }
1134             }
1135             icmp->icmp6_cksum = (OVS_FORCE uint16_t)
1136                 csum(icmp, (char *)ofpbuf_tail(b) - (char *)icmp);
1137             b->l7 = ofpbuf_tail(b);
1138         }
1139     }
1140 }
1141
1142 /* Puts into 'b' a packet that flow_extract() would parse as having the given
1143  * 'flow'.
1144  *
1145  * (This is useful only for testing, obviously, and the packet isn't really
1146  * valid. It hasn't got some checksums filled in, for one, and lots of fields
1147  * are just zeroed.) */
1148 void
1149 flow_compose(struct ofpbuf *b, const struct flow *flow)
1150 {
1151     /* eth_compose() sets l3 pointer and makes sure it is 32-bit aligned. */
1152     eth_compose(b, flow->dl_dst, flow->dl_src, ntohs(flow->dl_type), 0);
1153     if (flow->dl_type == htons(FLOW_DL_TYPE_NONE)) {
1154         struct eth_header *eth = b->l2;
1155         eth->eth_type = htons(b->size);
1156         return;
1157     }
1158
1159     if (flow->vlan_tci & htons(VLAN_CFI)) {
1160         eth_push_vlan(b, flow->vlan_tci);
1161     }
1162
1163     if (flow->dl_type == htons(ETH_TYPE_IP)) {
1164         struct ip_header *ip;
1165
1166         ip = ofpbuf_put_zeros(b, sizeof *ip);
1167         ip->ip_ihl_ver = IP_IHL_VER(5, 4);
1168         ip->ip_tos = flow->nw_tos;
1169         ip->ip_ttl = flow->nw_ttl;
1170         ip->ip_proto = flow->nw_proto;
1171         put_16aligned_be32(&ip->ip_src, flow->nw_src);
1172         put_16aligned_be32(&ip->ip_dst, flow->nw_dst);
1173
1174         if (flow->nw_frag & FLOW_NW_FRAG_ANY) {
1175             ip->ip_frag_off |= htons(IP_MORE_FRAGMENTS);
1176             if (flow->nw_frag & FLOW_NW_FRAG_LATER) {
1177                 ip->ip_frag_off |= htons(100);
1178             }
1179         }
1180
1181         b->l4 = ofpbuf_tail(b);
1182
1183         flow_compose_l4(b, flow);
1184
1185         ip->ip_tot_len = htons((uint8_t *) b->data + b->size
1186                                - (uint8_t *) b->l3);
1187         ip->ip_csum = csum(ip, sizeof *ip);
1188     } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
1189         struct ovs_16aligned_ip6_hdr *nh;
1190
1191         nh = ofpbuf_put_zeros(b, sizeof *nh);
1192         put_16aligned_be32(&nh->ip6_flow, htonl(6 << 28) |
1193                            htonl(flow->nw_tos << 20) | flow->ipv6_label);
1194         nh->ip6_hlim = flow->nw_ttl;
1195         nh->ip6_nxt = flow->nw_proto;
1196
1197         memcpy(&nh->ip6_src, &flow->ipv6_src, sizeof(nh->ip6_src));
1198         memcpy(&nh->ip6_dst, &flow->ipv6_dst, sizeof(nh->ip6_dst));
1199
1200         b->l4 = ofpbuf_tail(b);
1201
1202         flow_compose_l4(b, flow);
1203
1204         nh->ip6_plen =
1205             b->l7 ? htons((uint8_t *) b->l7 - (uint8_t *) b->l4) : htons(0);
1206     } else if (flow->dl_type == htons(ETH_TYPE_ARP) ||
1207                flow->dl_type == htons(ETH_TYPE_RARP)) {
1208         struct arp_eth_header *arp;
1209
1210         b->l3 = arp = ofpbuf_put_zeros(b, sizeof *arp);
1211         arp->ar_hrd = htons(1);
1212         arp->ar_pro = htons(ETH_TYPE_IP);
1213         arp->ar_hln = ETH_ADDR_LEN;
1214         arp->ar_pln = 4;
1215         arp->ar_op = htons(flow->nw_proto);
1216
1217         if (flow->nw_proto == ARP_OP_REQUEST ||
1218             flow->nw_proto == ARP_OP_REPLY) {
1219             put_16aligned_be32(&arp->ar_spa, flow->nw_src);
1220             put_16aligned_be32(&arp->ar_tpa, flow->nw_dst);
1221             memcpy(arp->ar_sha, flow->arp_sha, ETH_ADDR_LEN);
1222             memcpy(arp->ar_tha, flow->arp_tha, ETH_ADDR_LEN);
1223         }
1224     }
1225
1226     if (eth_type_mpls(flow->dl_type)) {
1227         b->l2_5 = b->l3;
1228         push_mpls(b, flow->dl_type, flow->mpls_lse);
1229     }
1230 }
1231 \f
1232 /* Compressed flow. */
1233
1234 static int
1235 miniflow_n_values(const struct miniflow *flow)
1236 {
1237     return count_1bits(flow->map);
1238 }
1239
1240 static uint32_t *
1241 miniflow_alloc_values(struct miniflow *flow, int n)
1242 {
1243     if (n <= MINI_N_INLINE) {
1244         return flow->inline_values;
1245     } else {
1246         COVERAGE_INC(miniflow_malloc);
1247         return xmalloc(n * sizeof *flow->values);
1248     }
1249 }
1250
1251 /* Completes an initialization of 'dst' as a miniflow copy of 'src' begun by
1252  * the caller.  The caller must have already initialized 'dst->map' properly
1253  * to indicate the significant uint32_t elements of 'src'.  'n' must be the
1254  * number of 1-bits in 'dst->map'.
1255  *
1256  * Normally the significant elements are the ones that are non-zero.  However,
1257  * when a miniflow is initialized from a (mini)mask, the values can be zeroes,
1258  * so that the flow and mask always have the same maps.
1259  *
1260  * This function initializes 'dst->values' (either inline if possible or with
1261  * malloc() otherwise) and copies the uint32_t elements of 'src' indicated by
1262  * 'dst->map' into it. */
1263 static void
1264 miniflow_init__(struct miniflow *dst, const struct flow *src, int n)
1265 {
1266     const uint32_t *src_u32 = (const uint32_t *) src;
1267     unsigned int ofs;
1268     uint64_t map;
1269
1270     dst->values = miniflow_alloc_values(dst, n);
1271     ofs = 0;
1272     for (map = dst->map; map; map = zero_rightmost_1bit(map)) {
1273         dst->values[ofs++] = src_u32[raw_ctz(map)];
1274     }
1275 }
1276
1277 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
1278  * with miniflow_destroy(). */
1279 void
1280 miniflow_init(struct miniflow *dst, const struct flow *src)
1281 {
1282     const uint32_t *src_u32 = (const uint32_t *) src;
1283     unsigned int i;
1284     int n;
1285
1286     /* Initialize dst->map, counting the number of nonzero elements. */
1287     n = 0;
1288     dst->map = 0;
1289
1290     for (i = 0; i < FLOW_U32S; i++) {
1291         if (src_u32[i]) {
1292             dst->map |= UINT64_C(1) << i;
1293             n++;
1294         }
1295     }
1296
1297     miniflow_init__(dst, src, n);
1298 }
1299
1300 /* Initializes 'dst' as a copy of 'src', using 'mask->map' as 'dst''s map.  The
1301  * caller must eventually free 'dst' with miniflow_destroy(). */
1302 void
1303 miniflow_init_with_minimask(struct miniflow *dst, const struct flow *src,
1304                             const struct minimask *mask)
1305 {
1306     dst->map = mask->masks.map;
1307     miniflow_init__(dst, src, miniflow_n_values(dst));
1308 }
1309
1310 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
1311  * with miniflow_destroy(). */
1312 void
1313 miniflow_clone(struct miniflow *dst, const struct miniflow *src)
1314 {
1315     int n = miniflow_n_values(src);
1316     dst->map = src->map;
1317     dst->values = miniflow_alloc_values(dst, n);
1318     memcpy(dst->values, src->values, n * sizeof *dst->values);
1319 }
1320
1321 /* Initializes 'dst' with the data in 'src', destroying 'src'.
1322  * The caller must eventually free 'dst' with miniflow_destroy(). */
1323 void
1324 miniflow_move(struct miniflow *dst, struct miniflow *src)
1325 {
1326     if (src->values == src->inline_values) {
1327         dst->values = dst->inline_values;
1328         memcpy(dst->values, src->values,
1329                miniflow_n_values(src) * sizeof *dst->values);
1330     } else {
1331         dst->values = src->values;
1332     }
1333     dst->map = src->map;
1334 }
1335
1336 /* Frees any memory owned by 'flow'.  Does not free the storage in which 'flow'
1337  * itself resides; the caller is responsible for that. */
1338 void
1339 miniflow_destroy(struct miniflow *flow)
1340 {
1341     if (flow->values != flow->inline_values) {
1342         free(flow->values);
1343     }
1344 }
1345
1346 /* Initializes 'dst' as a copy of 'src'. */
1347 void
1348 miniflow_expand(const struct miniflow *src, struct flow *dst)
1349 {
1350     memset(dst, 0, sizeof *dst);
1351     flow_union_with_miniflow(dst, src);
1352 }
1353
1354 static const uint32_t *
1355 miniflow_get__(const struct miniflow *flow, unsigned int u32_ofs)
1356 {
1357     if (!(flow->map & (UINT64_C(1) << u32_ofs))) {
1358         static const uint32_t zero = 0;
1359         return &zero;
1360     }
1361     return flow->values +
1362            count_1bits(flow->map & ((UINT64_C(1) << u32_ofs) - 1));
1363 }
1364
1365 /* Returns the uint32_t that would be at byte offset '4 * u32_ofs' if 'flow'
1366  * were expanded into a "struct flow". */
1367 uint32_t
1368 miniflow_get(const struct miniflow *flow, unsigned int u32_ofs)
1369 {
1370     return *miniflow_get__(flow, u32_ofs);
1371 }
1372
1373 /* Returns the ovs_be16 that would be at byte offset 'u8_ofs' if 'flow' were
1374  * expanded into a "struct flow". */
1375 static ovs_be16
1376 miniflow_get_be16(const struct miniflow *flow, unsigned int u8_ofs)
1377 {
1378     const uint32_t *u32p = miniflow_get__(flow, u8_ofs / 4);
1379     const ovs_be16 *be16p = (const ovs_be16 *) u32p;
1380     return be16p[u8_ofs % 4 != 0];
1381 }
1382
1383 /* Returns the VID within the vlan_tci member of the "struct flow" represented
1384  * by 'flow'. */
1385 uint16_t
1386 miniflow_get_vid(const struct miniflow *flow)
1387 {
1388     ovs_be16 tci = miniflow_get_be16(flow, offsetof(struct flow, vlan_tci));
1389     return vlan_tci_to_vid(tci);
1390 }
1391
1392 /* Returns true if 'a' and 'b' are the same flow, false otherwise.  */
1393 bool
1394 miniflow_equal(const struct miniflow *a, const struct miniflow *b)
1395 {
1396     const uint32_t *ap = a->values;
1397     const uint32_t *bp = b->values;
1398     const uint64_t a_map = a->map;
1399     const uint64_t b_map = b->map;
1400     uint64_t map;
1401
1402     if (a_map == b_map) {
1403         for (map = a_map; map; map = zero_rightmost_1bit(map)) {
1404             if (*ap++ != *bp++) {
1405                 return false;
1406             }
1407         }
1408     } else {
1409         for (map = a_map | b_map; map; map = zero_rightmost_1bit(map)) {
1410             uint64_t bit = rightmost_1bit(map);
1411             uint64_t a_value = a_map & bit ? *ap++ : 0;
1412             uint64_t b_value = b_map & bit ? *bp++ : 0;
1413
1414             if (a_value != b_value) {
1415                 return false;
1416             }
1417         }
1418     }
1419
1420     return true;
1421 }
1422
1423 /* Returns true if 'a' and 'b' are equal at the places where there are 1-bits
1424  * in 'mask', false if they differ. */
1425 bool
1426 miniflow_equal_in_minimask(const struct miniflow *a, const struct miniflow *b,
1427                            const struct minimask *mask)
1428 {
1429     const uint32_t *p;
1430     uint64_t map;
1431
1432     p = mask->masks.values;
1433
1434     for (map = mask->masks.map; map; map = zero_rightmost_1bit(map)) {
1435         int ofs = raw_ctz(map);
1436
1437         if ((miniflow_get(a, ofs) ^ miniflow_get(b, ofs)) & *p) {
1438             return false;
1439         }
1440         p++;
1441     }
1442
1443     return true;
1444 }
1445
1446 /* Returns true if 'a' and 'b' are equal at the places where there are 1-bits
1447  * in 'mask', false if they differ. */
1448 bool
1449 miniflow_equal_flow_in_minimask(const struct miniflow *a, const struct flow *b,
1450                                 const struct minimask *mask)
1451 {
1452     const uint32_t *b_u32 = (const uint32_t *) b;
1453     const uint32_t *p;
1454     uint64_t map;
1455
1456     p = mask->masks.values;
1457
1458     for (map = mask->masks.map; map; map = zero_rightmost_1bit(map)) {
1459         int ofs = raw_ctz(map);
1460
1461         if ((miniflow_get(a, ofs) ^ b_u32[ofs]) & *p) {
1462             return false;
1463         }
1464         p++;
1465     }
1466
1467     return true;
1468 }
1469
1470 /* Returns a hash value for 'flow', given 'basis'. */
1471 uint32_t
1472 miniflow_hash(const struct miniflow *flow, uint32_t basis)
1473 {
1474     const uint32_t *p = flow->values;
1475     uint32_t hash = basis;
1476     uint64_t hash_map = 0;
1477     uint64_t map;
1478
1479     for (map = flow->map; map; map = zero_rightmost_1bit(map)) {
1480         if (*p) {
1481             hash = mhash_add(hash, *p);
1482             hash_map |= rightmost_1bit(map);
1483         }
1484         p++;
1485     }
1486     hash = mhash_add(hash, hash_map);
1487     hash = mhash_add(hash, hash_map >> 32);
1488
1489     return mhash_finish(hash, p - flow->values);
1490 }
1491
1492 /* Returns a hash value for the bits of 'flow' where there are 1-bits in
1493  * 'mask', given 'basis'.
1494  *
1495  * The hash values returned by this function are the same as those returned by
1496  * flow_hash_in_minimask(), only the form of the arguments differ. */
1497 uint32_t
1498 miniflow_hash_in_minimask(const struct miniflow *flow,
1499                           const struct minimask *mask, uint32_t basis)
1500 {
1501     const uint32_t *p = mask->masks.values;
1502     uint32_t hash;
1503     uint64_t map;
1504
1505     hash = basis;
1506
1507     for (map = mask->masks.map; map; map = zero_rightmost_1bit(map)) {
1508         if (*p) {
1509             int ofs = raw_ctz(map);
1510             hash = mhash_add(hash, miniflow_get(flow, ofs) & *p);
1511         }
1512         p++;
1513     }
1514
1515     return mhash_finish(hash, (p - mask->masks.values) * 4);
1516 }
1517
1518 /* Returns a hash value for the bits of 'flow' where there are 1-bits in
1519  * 'mask', given 'basis'.
1520  *
1521  * The hash values returned by this function are the same as those returned by
1522  * miniflow_hash_in_minimask(), only the form of the arguments differ. */
1523 uint32_t
1524 flow_hash_in_minimask(const struct flow *flow, const struct minimask *mask,
1525                       uint32_t basis)
1526 {
1527     const uint32_t *flow_u32 = (const uint32_t *)flow;
1528     const uint32_t *p = mask->masks.values;
1529     uint32_t hash;
1530     uint64_t map;
1531
1532     hash = basis;
1533     for (map = mask->masks.map; map; map = zero_rightmost_1bit(map)) {
1534         if (*p) {
1535             hash = mhash_add(hash, flow_u32[raw_ctz(map)] & *p);
1536         }
1537         p++;
1538     }
1539
1540     return mhash_finish(hash, (p - mask->masks.values) * 4);
1541 }
1542
1543 /* Returns a hash value for the bits of range [start, end) in 'flow',
1544  * where there are 1-bits in 'mask', given 'hash'.
1545  *
1546  * The hash values returned by this function are the same as those returned by
1547  * minimatch_hash_range(), only the form of the arguments differ. */
1548 uint32_t
1549 flow_hash_in_minimask_range(const struct flow *flow,
1550                             const struct minimask *mask,
1551                             uint8_t start, uint8_t end, uint32_t *basis)
1552 {
1553     const uint32_t *flow_u32 = (const uint32_t *)flow;
1554     const uint32_t *p;
1555     uint64_t map = miniflow_get_map_in_range(&mask->masks, start, end, &p);
1556     uint32_t hash = *basis;
1557
1558     for (; map; map = zero_rightmost_1bit(map)) {
1559         if (*p) {
1560             hash = mhash_add(hash, flow_u32[raw_ctz(map)] & *p);
1561         }
1562         p++;
1563     }
1564
1565     *basis = hash; /* Allow continuation from the unfinished value. */
1566     return mhash_finish(hash, (p - mask->masks.values) * 4);
1567 }
1568
1569 \f
1570 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
1571  * with minimask_destroy(). */
1572 void
1573 minimask_init(struct minimask *mask, const struct flow_wildcards *wc)
1574 {
1575     miniflow_init(&mask->masks, &wc->masks);
1576 }
1577
1578 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
1579  * with minimask_destroy(). */
1580 void
1581 minimask_clone(struct minimask *dst, const struct minimask *src)
1582 {
1583     miniflow_clone(&dst->masks, &src->masks);
1584 }
1585
1586 /* Initializes 'dst' with the data in 'src', destroying 'src'.
1587  * The caller must eventually free 'dst' with minimask_destroy(). */
1588 void
1589 minimask_move(struct minimask *dst, struct minimask *src)
1590 {
1591     miniflow_move(&dst->masks, &src->masks);
1592 }
1593
1594 /* Initializes 'dst_' as the bit-wise "and" of 'a_' and 'b_'.
1595  *
1596  * The caller must provide room for FLOW_U32S "uint32_t"s in 'storage', for use
1597  * by 'dst_'.  The caller must *not* free 'dst_' with minimask_destroy(). */
1598 void
1599 minimask_combine(struct minimask *dst_,
1600                  const struct minimask *a_, const struct minimask *b_,
1601                  uint32_t storage[FLOW_U32S])
1602 {
1603     struct miniflow *dst = &dst_->masks;
1604     const struct miniflow *a = &a_->masks;
1605     const struct miniflow *b = &b_->masks;
1606     uint64_t map;
1607     int n = 0;
1608
1609     dst->values = storage;
1610
1611     dst->map = 0;
1612     for (map = a->map & b->map; map; map = zero_rightmost_1bit(map)) {
1613         int ofs = raw_ctz(map);
1614         uint32_t mask = miniflow_get(a, ofs) & miniflow_get(b, ofs);
1615
1616         if (mask) {
1617             dst->map |= rightmost_1bit(map);
1618             dst->values[n++] = mask;
1619         }
1620     }
1621 }
1622
1623 /* Frees any memory owned by 'mask'.  Does not free the storage in which 'mask'
1624  * itself resides; the caller is responsible for that. */
1625 void
1626 minimask_destroy(struct minimask *mask)
1627 {
1628     miniflow_destroy(&mask->masks);
1629 }
1630
1631 /* Initializes 'dst' as a copy of 'src'. */
1632 void
1633 minimask_expand(const struct minimask *mask, struct flow_wildcards *wc)
1634 {
1635     miniflow_expand(&mask->masks, &wc->masks);
1636 }
1637
1638 /* Returns the uint32_t that would be at byte offset '4 * u32_ofs' if 'mask'
1639  * were expanded into a "struct flow_wildcards". */
1640 uint32_t
1641 minimask_get(const struct minimask *mask, unsigned int u32_ofs)
1642 {
1643     return miniflow_get(&mask->masks, u32_ofs);
1644 }
1645
1646 /* Returns the VID mask within the vlan_tci member of the "struct
1647  * flow_wildcards" represented by 'mask'. */
1648 uint16_t
1649 minimask_get_vid_mask(const struct minimask *mask)
1650 {
1651     return miniflow_get_vid(&mask->masks);
1652 }
1653
1654 /* Returns true if 'a' and 'b' are the same flow mask, false otherwise.  */
1655 bool
1656 minimask_equal(const struct minimask *a, const struct minimask *b)
1657 {
1658     return miniflow_equal(&a->masks, &b->masks);
1659 }
1660
1661 /* Returns a hash value for 'mask', given 'basis'. */
1662 uint32_t
1663 minimask_hash(const struct minimask *mask, uint32_t basis)
1664 {
1665     return miniflow_hash(&mask->masks, basis);
1666 }
1667
1668 /* Returns true if at least one bit is wildcarded in 'a_' but not in 'b_',
1669  * false otherwise. */
1670 bool
1671 minimask_has_extra(const struct minimask *a_, const struct minimask *b_)
1672 {
1673     const struct miniflow *a = &a_->masks;
1674     const struct miniflow *b = &b_->masks;
1675     uint64_t map;
1676
1677     for (map = a->map | b->map; map; map = zero_rightmost_1bit(map)) {
1678         int ofs = raw_ctz(map);
1679         uint32_t a_u32 = miniflow_get(a, ofs);
1680         uint32_t b_u32 = miniflow_get(b, ofs);
1681
1682         if ((a_u32 & b_u32) != b_u32) {
1683             return true;
1684         }
1685     }
1686
1687     return false;
1688 }
1689
1690 /* Returns true if 'mask' matches every packet, false if 'mask' fixes any bits
1691  * or fields. */
1692 bool
1693 minimask_is_catchall(const struct minimask *mask_)
1694 {
1695     const struct miniflow *mask = &mask_->masks;
1696     const uint32_t *p = mask->values;
1697     uint64_t map;
1698
1699     for (map = mask->map; map; map = zero_rightmost_1bit(map)) {
1700         if (*p++) {
1701             return false;
1702         }
1703     }
1704     return true;
1705 }