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