miniflow: Fix miniflow push of L4 port numbers.
[cascardo/ovs.git] / lib / flow.c
1 /*
2  * Copyright (c) 2008, 2009, 2010, 2011, 2012, 2013, 2014, 2015 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 /* U64 indices for segmented flow classification. */
46 const uint8_t flow_segment_u64s[4] = {
47     FLOW_SEGMENT_1_ENDS_AT / sizeof(uint64_t),
48     FLOW_SEGMENT_2_ENDS_AT / sizeof(uint64_t),
49     FLOW_SEGMENT_3_ENDS_AT / sizeof(uint64_t),
50     FLOW_U64S
51 };
52
53 /* miniflow_extract() assumes the following to be true to optimize the
54  * extraction process. */
55 BUILD_ASSERT_DECL(offsetof(struct flow, dl_type) + 2
56                   == offsetof(struct flow, vlan_tci) &&
57                   offsetof(struct flow, dl_type) / 4
58                   == offsetof(struct flow, vlan_tci) / 4 );
59
60 BUILD_ASSERT_DECL(offsetof(struct flow, nw_frag) + 3
61                   == offsetof(struct flow, nw_proto) &&
62                   offsetof(struct flow, nw_tos) + 2
63                   == offsetof(struct flow, nw_proto) &&
64                   offsetof(struct flow, nw_ttl) + 1
65                   == offsetof(struct flow, nw_proto) &&
66                   offsetof(struct flow, nw_frag) / 4
67                   == offsetof(struct flow, nw_tos) / 4 &&
68                   offsetof(struct flow, nw_ttl) / 4
69                   == offsetof(struct flow, nw_tos) / 4 &&
70                   offsetof(struct flow, nw_proto) / 4
71                   == offsetof(struct flow, nw_tos) / 4);
72
73 /* TCP flags in the middle of a BE64, zeroes in the other half. */
74 BUILD_ASSERT_DECL(offsetof(struct flow, tcp_flags) % 8 == 4);
75
76 #if WORDS_BIGENDIAN
77 #define TCP_FLAGS_BE32(tcp_ctl) ((OVS_FORCE ovs_be32)TCP_FLAGS_BE16(tcp_ctl) \
78                                  << 16)
79 #else
80 #define TCP_FLAGS_BE32(tcp_ctl) ((OVS_FORCE ovs_be32)TCP_FLAGS_BE16(tcp_ctl))
81 #endif
82
83 BUILD_ASSERT_DECL(offsetof(struct flow, tp_src) + 2
84                   == offsetof(struct flow, tp_dst) &&
85                   offsetof(struct flow, tp_src) / 4
86                   == offsetof(struct flow, tp_dst) / 4);
87
88 /* Removes 'size' bytes from the head end of '*datap', of size '*sizep', which
89  * must contain at least 'size' bytes of data.  Returns the first byte of data
90  * removed. */
91 static inline const void *
92 data_pull(void **datap, size_t *sizep, size_t size)
93 {
94     char *data = (char *)*datap;
95     *datap = data + size;
96     *sizep -= size;
97     return data;
98 }
99
100 /* If '*datap' has at least 'size' bytes of data, removes that many bytes from
101  * the head end of '*datap' and returns the first byte removed.  Otherwise,
102  * returns a null pointer without modifying '*datap'. */
103 static inline const void *
104 data_try_pull(void **datap, size_t *sizep, size_t size)
105 {
106     return OVS_LIKELY(*sizep >= size) ? data_pull(datap, sizep, size) : NULL;
107 }
108
109 /* Context for pushing data to a miniflow. */
110 struct mf_ctx {
111     uint64_t map;
112     uint64_t *data;
113     uint64_t * const end;
114 };
115
116 /* miniflow_push_* macros allow filling in a miniflow data values in order.
117  * Assertions are needed only when the layout of the struct flow is modified.
118  * 'ofs' is a compile-time constant, which allows most of the code be optimized
119  * away.  Some GCC versions gave warnings on ALWAYS_INLINE, so these are
120  * defined as macros. */
121
122 #if (FLOW_WC_SEQ != 30)
123 #define MINIFLOW_ASSERT(X) ovs_assert(X)
124 BUILD_MESSAGE("FLOW_WC_SEQ changed: miniflow_extract() will have runtime "
125                "assertions enabled. Consider updating FLOW_WC_SEQ after "
126                "testing")
127 #else
128 #define MINIFLOW_ASSERT(X)
129 #endif
130
131 #define miniflow_push_uint64_(MF, OFS, VALUE)                   \
132 {                                                               \
133     MINIFLOW_ASSERT(MF.data < MF.end && (OFS) % 8 == 0          \
134                     && !(MF.map & (UINT64_MAX << (OFS) / 8)));  \
135     *MF.data++ = VALUE;                                         \
136     MF.map |= UINT64_C(1) << (OFS) / 8;                         \
137 }
138
139 #define miniflow_push_be64_(MF, OFS, VALUE) \
140     miniflow_push_uint64_(MF, OFS, (OVS_FORCE uint64_t)(VALUE))
141
142 #define miniflow_push_uint32_(MF, OFS, VALUE)                   \
143 {                                                               \
144     MINIFLOW_ASSERT(MF.data < MF.end &&                                 \
145                     (((OFS) % 8 == 0 && !(MF.map & (UINT64_MAX << (OFS) / 8))) \
146                      || ((OFS) % 8 == 4 && MF.map & (UINT64_C(1) << (OFS) / 8) \
147                          && !(MF.map & (UINT64_MAX << ((OFS) / 8 + 1)))))); \
148                                                                         \
149     if ((OFS) % 8 == 0) {                                               \
150         *(uint32_t *)MF.data = VALUE;                                   \
151         MF.map |= UINT64_C(1) << (OFS) / 8;                             \
152     } else if ((OFS) % 8 == 4) {                                        \
153         *((uint32_t *)MF.data + 1) = VALUE;                             \
154         MF.data++;                                                      \
155     }                                                                   \
156 }
157
158 #define miniflow_push_be32_(MF, OFS, VALUE)                     \
159     miniflow_push_uint32_(MF, OFS, (OVS_FORCE uint32_t)(VALUE))
160
161 #define miniflow_push_uint16_(MF, OFS, VALUE)                           \
162 {                                                                       \
163     MINIFLOW_ASSERT(MF.data < MF.end &&                                 \
164                     (((OFS) % 8 == 0 && !(MF.map & (UINT64_MAX << (OFS) / 8))) \
165                      || ((OFS) % 2 == 0 && MF.map & (UINT64_C(1) << (OFS) / 8) \
166                          && !(MF.map & (UINT64_MAX << ((OFS) / 8 + 1)))))); \
167                                                                         \
168     if ((OFS) % 8 == 0) {                                               \
169         *(uint16_t *)MF.data = VALUE;                                   \
170         MF.map |= UINT64_C(1) << (OFS) / 8;                             \
171     } else if ((OFS) % 8 == 2) {                                        \
172         *((uint16_t *)MF.data + 1) = VALUE;                             \
173     } else if ((OFS) % 8 == 4) {                                        \
174         *((uint16_t *)MF.data + 2) = VALUE;                             \
175     } else if ((OFS) % 8 == 6) {                                        \
176         *((uint16_t *)MF.data + 3) = VALUE;                             \
177         MF.data++;                                                      \
178     }                                                                   \
179 }
180
181 #define miniflow_pad_to_64_(MF, OFS)                                    \
182 {                                                                   \
183     MINIFLOW_ASSERT((OFS) % 8 != 0);                                    \
184     MINIFLOW_ASSERT(MF.map & (UINT64_C(1) << (OFS) / 8));               \
185     MINIFLOW_ASSERT(!(MF.map & (UINT64_MAX << ((OFS) / 8 + 1))));       \
186                                                                         \
187     memset((uint8_t *)MF.data + (OFS) % 8, 0, 8 - (OFS) % 8);           \
188     MF.data++;                                                          \
189 }
190
191 #define miniflow_push_be16_(MF, OFS, VALUE)                     \
192     miniflow_push_uint16_(MF, OFS, (OVS_FORCE uint16_t)VALUE);
193
194 /* Data at 'valuep' may be unaligned. */
195 #define miniflow_push_words_(MF, OFS, VALUEP, N_WORDS)          \
196 {                                                               \
197     int ofs64 = (OFS) / 8;                                      \
198                                                                         \
199     MINIFLOW_ASSERT(MF.data + (N_WORDS) <= MF.end && (OFS) % 8 == 0     \
200                     && !(MF.map & (UINT64_MAX << ofs64)));              \
201                                                                         \
202     memcpy(MF.data, (VALUEP), (N_WORDS) * sizeof *MF.data);             \
203     MF.data += (N_WORDS);                                               \
204     MF.map |= ((UINT64_MAX >> (64 - (N_WORDS))) << ofs64);              \
205 }
206
207 /* Push 32-bit words padded to 64-bits. */
208 #define miniflow_push_words_32_(MF, OFS, VALUEP, N_WORDS)               \
209 {                                                                       \
210     int ofs64 = (OFS) / 8;                                              \
211                                                                         \
212     MINIFLOW_ASSERT(MF.data + DIV_ROUND_UP(N_WORDS, 2) <= MF.end        \
213                     && (OFS) % 8 == 0                                   \
214                     && !(MF.map & (UINT64_MAX << ofs64)));              \
215                                                                         \
216     memcpy(MF.data, (VALUEP), (N_WORDS) * sizeof(uint32_t));            \
217     MF.data += DIV_ROUND_UP(N_WORDS, 2);                                \
218     MF.map |= ((UINT64_MAX >> (64 - DIV_ROUND_UP(N_WORDS, 2))) << ofs64); \
219     if ((N_WORDS) & 1) {                                                \
220         *((uint32_t *)MF.data - 1) = 0;                                 \
221     }                                                                   \
222 }
223
224 /* Data at 'valuep' may be unaligned. */
225 /* MACs start 64-aligned, and must be followed by other data or padding. */
226 #define miniflow_push_macs_(MF, OFS, VALUEP)                    \
227 {                                                               \
228     int ofs64 = (OFS) / 8;                                      \
229                                                                 \
230     MINIFLOW_ASSERT(MF.data + 2 <= MF.end && (OFS) % 8 == 0     \
231                     && !(MF.map & (UINT64_MAX << ofs64)));      \
232                                                                 \
233     memcpy(MF.data, (VALUEP), 2 * ETH_ADDR_LEN);                \
234     MF.data += 1;                   /* First word only. */      \
235     MF.map |= UINT64_C(3) << ofs64; /* Both words. */           \
236 }
237
238 #define miniflow_push_uint32(MF, FIELD, VALUE)                      \
239     miniflow_push_uint32_(MF, offsetof(struct flow, FIELD), VALUE)
240
241 #define miniflow_push_be32(MF, FIELD, VALUE)                        \
242     miniflow_push_be32_(MF, offsetof(struct flow, FIELD), VALUE)
243
244 #define miniflow_push_uint16(MF, FIELD, VALUE)                      \
245     miniflow_push_uint16_(MF, offsetof(struct flow, FIELD), VALUE)
246
247 #define miniflow_push_be16(MF, FIELD, VALUE)                        \
248     miniflow_push_be16_(MF, offsetof(struct flow, FIELD), VALUE)
249
250 #define miniflow_pad_to_64(MF, FIELD)                       \
251     miniflow_pad_to_64_(MF, offsetof(struct flow, FIELD))
252
253 #define miniflow_push_words(MF, FIELD, VALUEP, N_WORDS)                 \
254     miniflow_push_words_(MF, offsetof(struct flow, FIELD), VALUEP, N_WORDS)
255
256 #define miniflow_push_words_32(MF, FIELD, VALUEP, N_WORDS)              \
257     miniflow_push_words_32_(MF, offsetof(struct flow, FIELD), VALUEP, N_WORDS)
258
259 #define miniflow_push_macs(MF, FIELD, VALUEP)                       \
260     miniflow_push_macs_(MF, offsetof(struct flow, FIELD), VALUEP)
261
262 /* Pulls the MPLS headers at '*datap' and returns the count of them. */
263 static inline int
264 parse_mpls(void **datap, size_t *sizep)
265 {
266     const struct mpls_hdr *mh;
267     int count = 0;
268
269     while ((mh = data_try_pull(datap, sizep, sizeof *mh))) {
270         count++;
271         if (mh->mpls_lse.lo & htons(1 << MPLS_BOS_SHIFT)) {
272             break;
273         }
274     }
275     return MIN(count, FLOW_MAX_MPLS_LABELS);
276 }
277
278 static inline ovs_be16
279 parse_vlan(void **datap, size_t *sizep)
280 {
281     const struct eth_header *eth = *datap;
282
283     struct qtag_prefix {
284         ovs_be16 eth_type;      /* ETH_TYPE_VLAN */
285         ovs_be16 tci;
286     };
287
288     data_pull(datap, sizep, ETH_ADDR_LEN * 2);
289
290     if (eth->eth_type == htons(ETH_TYPE_VLAN)) {
291         if (OVS_LIKELY(*sizep
292                        >= sizeof(struct qtag_prefix) + sizeof(ovs_be16))) {
293             const struct qtag_prefix *qp = data_pull(datap, sizep, sizeof *qp);
294             return qp->tci | htons(VLAN_CFI);
295         }
296     }
297     return 0;
298 }
299
300 static inline ovs_be16
301 parse_ethertype(void **datap, size_t *sizep)
302 {
303     const struct llc_snap_header *llc;
304     ovs_be16 proto;
305
306     proto = *(ovs_be16 *) data_pull(datap, sizep, sizeof proto);
307     if (OVS_LIKELY(ntohs(proto) >= ETH_TYPE_MIN)) {
308         return proto;
309     }
310
311     if (OVS_UNLIKELY(*sizep < sizeof *llc)) {
312         return htons(FLOW_DL_TYPE_NONE);
313     }
314
315     llc = *datap;
316     if (OVS_UNLIKELY(llc->llc.llc_dsap != LLC_DSAP_SNAP
317                      || llc->llc.llc_ssap != LLC_SSAP_SNAP
318                      || llc->llc.llc_cntl != LLC_CNTL_SNAP
319                      || memcmp(llc->snap.snap_org, SNAP_ORG_ETHERNET,
320                                sizeof llc->snap.snap_org))) {
321         return htons(FLOW_DL_TYPE_NONE);
322     }
323
324     data_pull(datap, sizep, sizeof *llc);
325
326     if (OVS_LIKELY(ntohs(llc->snap.snap_type) >= ETH_TYPE_MIN)) {
327         return llc->snap.snap_type;
328     }
329
330     return htons(FLOW_DL_TYPE_NONE);
331 }
332
333 static inline bool
334 parse_icmpv6(void **datap, size_t *sizep, const struct icmp6_hdr *icmp,
335              const struct in6_addr **nd_target,
336              uint8_t arp_buf[2][ETH_ADDR_LEN])
337 {
338     if (icmp->icmp6_code == 0 &&
339         (icmp->icmp6_type == ND_NEIGHBOR_SOLICIT ||
340          icmp->icmp6_type == ND_NEIGHBOR_ADVERT)) {
341
342         *nd_target = data_try_pull(datap, sizep, sizeof **nd_target);
343         if (OVS_UNLIKELY(!*nd_target)) {
344             return false;
345         }
346
347         while (*sizep >= 8) {
348             /* The minimum size of an option is 8 bytes, which also is
349              * the size of Ethernet link-layer options. */
350             const struct nd_opt_hdr *nd_opt = *datap;
351             int opt_len = nd_opt->nd_opt_len * 8;
352
353             if (!opt_len || opt_len > *sizep) {
354                 goto invalid;
355             }
356
357             /* Store the link layer address if the appropriate option is
358              * provided.  It is considered an error if the same link
359              * layer option is specified twice. */
360             if (nd_opt->nd_opt_type == ND_OPT_SOURCE_LINKADDR
361                     && opt_len == 8) {
362                 if (OVS_LIKELY(eth_addr_is_zero(arp_buf[0]))) {
363                     memcpy(arp_buf[0], nd_opt + 1, ETH_ADDR_LEN);
364                 } else {
365                     goto invalid;
366                 }
367             } else if (nd_opt->nd_opt_type == ND_OPT_TARGET_LINKADDR
368                     && opt_len == 8) {
369                 if (OVS_LIKELY(eth_addr_is_zero(arp_buf[1]))) {
370                     memcpy(arp_buf[1], nd_opt + 1, ETH_ADDR_LEN);
371                 } else {
372                     goto invalid;
373                 }
374             }
375
376             if (OVS_UNLIKELY(!data_try_pull(datap, sizep, opt_len))) {
377                 goto invalid;
378             }
379         }
380     }
381
382     return true;
383
384 invalid:
385     return false;
386 }
387
388 /* Initializes 'flow' members from 'packet' and 'md'
389  *
390  * Initializes 'packet' header l2 pointer to the start of the Ethernet
391  * header, and the layer offsets as follows:
392  *
393  *    - packet->l2_5_ofs to the start of the MPLS shim header, or UINT16_MAX
394  *      when there is no MPLS shim header.
395  *
396  *    - packet->l3_ofs to just past the Ethernet header, or just past the
397  *      vlan_header if one is present, to the first byte of the payload of the
398  *      Ethernet frame.  UINT16_MAX if the frame is too short to contain an
399  *      Ethernet header.
400  *
401  *    - packet->l4_ofs to just past the IPv4 header, if one is present and
402  *      has at least the content used for the fields of interest for the flow,
403  *      otherwise UINT16_MAX.
404  */
405 void
406 flow_extract(struct ofpbuf *packet, const struct pkt_metadata *md,
407              struct flow *flow)
408 {
409     struct {
410         struct miniflow mf;
411         uint64_t buf[FLOW_U64S];
412     } m;
413
414     COVERAGE_INC(flow_extract);
415
416     miniflow_initialize(&m.mf, m.buf);
417     miniflow_extract(packet, md, &m.mf);
418     miniflow_expand(&m.mf, flow);
419 }
420
421 /* Caller is responsible for initializing 'dst' with enough storage for
422  * FLOW_U64S * 8 bytes. */
423 void
424 miniflow_extract(struct ofpbuf *packet, const struct pkt_metadata *md,
425                  struct miniflow *dst)
426 {
427     void *data = ofpbuf_data(packet);
428     size_t size = ofpbuf_size(packet);
429     uint64_t *values = miniflow_values(dst);
430     struct mf_ctx mf = { 0, values, values + FLOW_U64S };
431     char *l2;
432     ovs_be16 dl_type;
433     uint8_t nw_frag, nw_tos, nw_ttl, nw_proto;
434
435     /* Metadata. */
436     if (md) {
437         if (md->tunnel.ip_dst) {
438             miniflow_push_words(mf, tunnel, &md->tunnel,
439                                 sizeof md->tunnel / sizeof(uint64_t));
440         }
441         if (md->skb_priority || md->pkt_mark) {
442             miniflow_push_uint32(mf, skb_priority, md->skb_priority);
443             miniflow_push_uint32(mf, pkt_mark, md->pkt_mark);
444         }
445         miniflow_push_uint32(mf, dp_hash, md->dp_hash);
446         miniflow_push_uint32(mf, in_port, odp_to_u32(md->in_port.odp_port));
447         if (md->recirc_id) {
448             miniflow_push_uint32(mf, recirc_id, md->recirc_id);
449             miniflow_pad_to_64(mf, conj_id);
450         }
451     }
452
453     /* Initialize packet's layer pointer and offsets. */
454     l2 = data;
455     ofpbuf_set_frame(packet, data);
456
457     /* Must have full Ethernet header to proceed. */
458     if (OVS_UNLIKELY(size < sizeof(struct eth_header))) {
459         goto out;
460     } else {
461         ovs_be16 vlan_tci;
462
463         /* Link layer. */
464         BUILD_ASSERT(offsetof(struct flow, dl_dst) + 6
465                      == offsetof(struct flow, dl_src));
466         miniflow_push_macs(mf, dl_dst, data);
467         /* dl_type, vlan_tci. */
468         vlan_tci = parse_vlan(&data, &size);
469         dl_type = parse_ethertype(&data, &size);
470         miniflow_push_be16(mf, dl_type, dl_type);
471         miniflow_push_be16(mf, vlan_tci, vlan_tci);
472     }
473
474     /* Parse mpls. */
475     if (OVS_UNLIKELY(eth_type_mpls(dl_type))) {
476         int count;
477         const void *mpls = data;
478
479         packet->l2_5_ofs = (char *)data - l2;
480         count = parse_mpls(&data, &size);
481         miniflow_push_words_32(mf, mpls_lse, mpls, count);
482     }
483
484     /* Network layer. */
485     packet->l3_ofs = (char *)data - l2;
486
487     nw_frag = 0;
488     if (OVS_LIKELY(dl_type == htons(ETH_TYPE_IP))) {
489         const struct ip_header *nh = data;
490         int ip_len;
491         uint16_t tot_len;
492
493         if (OVS_UNLIKELY(size < IP_HEADER_LEN)) {
494             goto out;
495         }
496         ip_len = IP_IHL(nh->ip_ihl_ver) * 4;
497
498         if (OVS_UNLIKELY(ip_len < IP_HEADER_LEN)) {
499             goto out;
500         }
501         if (OVS_UNLIKELY(size < ip_len)) {
502             goto out;
503         }
504         tot_len = ntohs(nh->ip_tot_len);
505         if (OVS_UNLIKELY(tot_len > size)) {
506             goto out;
507         }
508         if (OVS_UNLIKELY(size - tot_len > UINT8_MAX)) {
509             goto out;
510         }
511         ofpbuf_set_l2_pad_size(packet, size - tot_len);
512         size = tot_len;   /* Never pull padding. */
513
514         /* Push both source and destination address at once. */
515         miniflow_push_words(mf, nw_src, &nh->ip_src, 1);
516
517         miniflow_push_be32(mf, ipv6_label, 0); /* Padding for IPv4. */
518
519         nw_tos = nh->ip_tos;
520         nw_ttl = nh->ip_ttl;
521         nw_proto = nh->ip_proto;
522         if (OVS_UNLIKELY(IP_IS_FRAGMENT(nh->ip_frag_off))) {
523             nw_frag = FLOW_NW_FRAG_ANY;
524             if (nh->ip_frag_off & htons(IP_FRAG_OFF_MASK)) {
525                 nw_frag |= FLOW_NW_FRAG_LATER;
526             }
527         }
528         data_pull(&data, &size, ip_len);
529     } else if (dl_type == htons(ETH_TYPE_IPV6)) {
530         const struct ovs_16aligned_ip6_hdr *nh;
531         ovs_be32 tc_flow;
532         uint16_t plen;
533
534         if (OVS_UNLIKELY(size < sizeof *nh)) {
535             goto out;
536         }
537         nh = data_pull(&data, &size, sizeof *nh);
538
539         plen = ntohs(nh->ip6_plen);
540         if (OVS_UNLIKELY(plen > size)) {
541             goto out;
542         }
543         /* Jumbo Payload option not supported yet. */
544         if (OVS_UNLIKELY(size - plen > UINT8_MAX)) {
545             goto out;
546         }
547         ofpbuf_set_l2_pad_size(packet, size - plen);
548         size = plen;   /* Never pull padding. */
549
550         miniflow_push_words(mf, ipv6_src, &nh->ip6_src,
551                             sizeof nh->ip6_src / 8);
552         miniflow_push_words(mf, ipv6_dst, &nh->ip6_dst,
553                             sizeof nh->ip6_dst / 8);
554
555         tc_flow = get_16aligned_be32(&nh->ip6_flow);
556         {
557             ovs_be32 label = tc_flow & htonl(IPV6_LABEL_MASK);
558             miniflow_push_be32(mf, ipv6_label, label);
559         }
560
561         nw_tos = ntohl(tc_flow) >> 20;
562         nw_ttl = nh->ip6_hlim;
563         nw_proto = nh->ip6_nxt;
564
565         while (1) {
566             if (OVS_LIKELY((nw_proto != IPPROTO_HOPOPTS)
567                            && (nw_proto != IPPROTO_ROUTING)
568                            && (nw_proto != IPPROTO_DSTOPTS)
569                            && (nw_proto != IPPROTO_AH)
570                            && (nw_proto != IPPROTO_FRAGMENT))) {
571                 /* It's either a terminal header (e.g., TCP, UDP) or one we
572                  * don't understand.  In either case, we're done with the
573                  * packet, so use it to fill in 'nw_proto'. */
574                 break;
575             }
576
577             /* We only verify that at least 8 bytes of the next header are
578              * available, but many of these headers are longer.  Ensure that
579              * accesses within the extension header are within those first 8
580              * bytes. All extension headers are required to be at least 8
581              * bytes. */
582             if (OVS_UNLIKELY(size < 8)) {
583                 goto out;
584             }
585
586             if ((nw_proto == IPPROTO_HOPOPTS)
587                 || (nw_proto == IPPROTO_ROUTING)
588                 || (nw_proto == IPPROTO_DSTOPTS)) {
589                 /* These headers, while different, have the fields we care
590                  * about in the same location and with the same
591                  * interpretation. */
592                 const struct ip6_ext *ext_hdr = data;
593                 nw_proto = ext_hdr->ip6e_nxt;
594                 if (OVS_UNLIKELY(!data_try_pull(&data, &size,
595                                                 (ext_hdr->ip6e_len + 1) * 8))) {
596                     goto out;
597                 }
598             } else if (nw_proto == IPPROTO_AH) {
599                 /* A standard AH definition isn't available, but the fields
600                  * we care about are in the same location as the generic
601                  * option header--only the header length is calculated
602                  * differently. */
603                 const struct ip6_ext *ext_hdr = data;
604                 nw_proto = ext_hdr->ip6e_nxt;
605                 if (OVS_UNLIKELY(!data_try_pull(&data, &size,
606                                                 (ext_hdr->ip6e_len + 2) * 4))) {
607                     goto out;
608                 }
609             } else if (nw_proto == IPPROTO_FRAGMENT) {
610                 const struct ovs_16aligned_ip6_frag *frag_hdr = data;
611
612                 nw_proto = frag_hdr->ip6f_nxt;
613                 if (!data_try_pull(&data, &size, sizeof *frag_hdr)) {
614                     goto out;
615                 }
616
617                 /* We only process the first fragment. */
618                 if (frag_hdr->ip6f_offlg != htons(0)) {
619                     nw_frag = FLOW_NW_FRAG_ANY;
620                     if ((frag_hdr->ip6f_offlg & IP6F_OFF_MASK) != htons(0)) {
621                         nw_frag |= FLOW_NW_FRAG_LATER;
622                         nw_proto = IPPROTO_FRAGMENT;
623                         break;
624                     }
625                 }
626             }
627         }
628     } else {
629         if (dl_type == htons(ETH_TYPE_ARP) ||
630             dl_type == htons(ETH_TYPE_RARP)) {
631             uint8_t arp_buf[2][ETH_ADDR_LEN];
632             const struct arp_eth_header *arp = (const struct arp_eth_header *)
633                 data_try_pull(&data, &size, ARP_ETH_HEADER_LEN);
634
635             if (OVS_LIKELY(arp) && OVS_LIKELY(arp->ar_hrd == htons(1))
636                 && OVS_LIKELY(arp->ar_pro == htons(ETH_TYPE_IP))
637                 && OVS_LIKELY(arp->ar_hln == ETH_ADDR_LEN)
638                 && OVS_LIKELY(arp->ar_pln == 4)) {
639                 miniflow_push_be32(mf, nw_src,
640                                    get_16aligned_be32(&arp->ar_spa));
641                 miniflow_push_be32(mf, nw_dst,
642                                    get_16aligned_be32(&arp->ar_tpa));
643
644                 /* We only match on the lower 8 bits of the opcode. */
645                 if (OVS_LIKELY(ntohs(arp->ar_op) <= 0xff)) {
646                     miniflow_push_be32(mf, ipv6_label, 0); /* Pad with ARP. */
647                     miniflow_push_be32(mf, nw_frag, htonl(ntohs(arp->ar_op)));
648                 }
649
650                 /* Must be adjacent. */
651                 BUILD_ASSERT(offsetof(struct flow, arp_sha) + 6
652                              == offsetof(struct flow, arp_tha));
653
654                 memcpy(arp_buf[0], arp->ar_sha, ETH_ADDR_LEN);
655                 memcpy(arp_buf[1], arp->ar_tha, ETH_ADDR_LEN);
656                 miniflow_push_macs(mf, arp_sha, arp_buf);
657                 miniflow_pad_to_64(mf, tcp_flags);
658             }
659         }
660         goto out;
661     }
662
663     packet->l4_ofs = (char *)data - l2;
664     miniflow_push_be32(mf, nw_frag,
665                        BYTES_TO_BE32(nw_frag, nw_tos, nw_ttl, nw_proto));
666
667     if (OVS_LIKELY(!(nw_frag & FLOW_NW_FRAG_LATER))) {
668         if (OVS_LIKELY(nw_proto == IPPROTO_TCP)) {
669             if (OVS_LIKELY(size >= TCP_HEADER_LEN)) {
670                 const struct tcp_header *tcp = data;
671
672                 miniflow_push_be32(mf, arp_tha[2], 0);
673                 miniflow_push_be32(mf, tcp_flags,
674                                    TCP_FLAGS_BE32(tcp->tcp_ctl));
675                 miniflow_push_be16(mf, tp_src, tcp->tcp_src);
676                 miniflow_push_be16(mf, tp_dst, tcp->tcp_dst);
677                 miniflow_pad_to_64(mf, igmp_group_ip4);
678             }
679         } else if (OVS_LIKELY(nw_proto == IPPROTO_UDP)) {
680             if (OVS_LIKELY(size >= UDP_HEADER_LEN)) {
681                 const struct udp_header *udp = data;
682
683                 miniflow_push_be16(mf, tp_src, udp->udp_src);
684                 miniflow_push_be16(mf, tp_dst, udp->udp_dst);
685                 miniflow_pad_to_64(mf, igmp_group_ip4);
686             }
687         } else if (OVS_LIKELY(nw_proto == IPPROTO_SCTP)) {
688             if (OVS_LIKELY(size >= SCTP_HEADER_LEN)) {
689                 const struct sctp_header *sctp = data;
690
691                 miniflow_push_be16(mf, tp_src, sctp->sctp_src);
692                 miniflow_push_be16(mf, tp_dst, sctp->sctp_dst);
693                 miniflow_pad_to_64(mf, igmp_group_ip4);
694             }
695         } else if (OVS_LIKELY(nw_proto == IPPROTO_ICMP)) {
696             if (OVS_LIKELY(size >= ICMP_HEADER_LEN)) {
697                 const struct icmp_header *icmp = data;
698
699                 miniflow_push_be16(mf, tp_src, htons(icmp->icmp_type));
700                 miniflow_push_be16(mf, tp_dst, htons(icmp->icmp_code));
701                 miniflow_pad_to_64(mf, igmp_group_ip4);
702             }
703         } else if (OVS_LIKELY(nw_proto == IPPROTO_IGMP)) {
704             if (OVS_LIKELY(size >= IGMP_HEADER_LEN)) {
705                 const struct igmp_header *igmp = data;
706
707                 miniflow_push_be16(mf, tp_src, htons(igmp->igmp_type));
708                 miniflow_push_be16(mf, tp_dst, htons(igmp->igmp_code));
709                 miniflow_push_be32(mf, igmp_group_ip4,
710                                    get_16aligned_be32(&igmp->group));
711             }
712         } else if (OVS_LIKELY(nw_proto == IPPROTO_ICMPV6)) {
713             if (OVS_LIKELY(size >= sizeof(struct icmp6_hdr))) {
714                 const struct in6_addr *nd_target = NULL;
715                 uint8_t arp_buf[2][ETH_ADDR_LEN];
716                 const struct icmp6_hdr *icmp = data_pull(&data, &size,
717                                                          sizeof *icmp);
718                 memset(arp_buf, 0, sizeof arp_buf);
719                 if (OVS_LIKELY(parse_icmpv6(&data, &size, icmp, &nd_target,
720                                             arp_buf))) {
721                     if (nd_target) {
722                         miniflow_push_words(mf, nd_target, nd_target,
723                                             sizeof *nd_target / 8);
724                     }
725                     miniflow_push_macs(mf, arp_sha, arp_buf);
726                     miniflow_pad_to_64(mf, tcp_flags);
727                     miniflow_push_be16(mf, tp_src, htons(icmp->icmp6_type));
728                     miniflow_push_be16(mf, tp_dst, htons(icmp->icmp6_code));
729                     miniflow_pad_to_64(mf, igmp_group_ip4);
730                 }
731             }
732         }
733     }
734  out:
735     dst->map = mf.map;
736 }
737
738 /* For every bit of a field that is wildcarded in 'wildcards', sets the
739  * corresponding bit in 'flow' to zero. */
740 void
741 flow_zero_wildcards(struct flow *flow, const struct flow_wildcards *wildcards)
742 {
743     uint64_t *flow_u64 = (uint64_t *) flow;
744     const uint64_t *wc_u64 = (const uint64_t *) &wildcards->masks;
745     size_t i;
746
747     for (i = 0; i < FLOW_U64S; i++) {
748         flow_u64[i] &= wc_u64[i];
749     }
750 }
751
752 void
753 flow_unwildcard_tp_ports(const struct flow *flow, struct flow_wildcards *wc)
754 {
755     if (flow->nw_proto != IPPROTO_ICMP) {
756         memset(&wc->masks.tp_src, 0xff, sizeof wc->masks.tp_src);
757         memset(&wc->masks.tp_dst, 0xff, sizeof wc->masks.tp_dst);
758     } else {
759         wc->masks.tp_src = htons(0xff);
760         wc->masks.tp_dst = htons(0xff);
761     }
762 }
763
764 /* Initializes 'fmd' with the metadata found in 'flow'. */
765 void
766 flow_get_metadata(const struct flow *flow, struct flow_metadata *fmd)
767 {
768     BUILD_ASSERT_DECL(FLOW_WC_SEQ == 30);
769
770     fmd->dp_hash = flow->dp_hash;
771     fmd->recirc_id = flow->recirc_id;
772     fmd->tun_id = flow->tunnel.tun_id;
773     fmd->tun_src = flow->tunnel.ip_src;
774     fmd->tun_dst = flow->tunnel.ip_dst;
775     fmd->metadata = flow->metadata;
776     memcpy(fmd->regs, flow->regs, sizeof fmd->regs);
777     fmd->pkt_mark = flow->pkt_mark;
778     fmd->in_port = flow->in_port.ofp_port;
779 }
780
781 char *
782 flow_to_string(const struct flow *flow)
783 {
784     struct ds ds = DS_EMPTY_INITIALIZER;
785     flow_format(&ds, flow);
786     return ds_cstr(&ds);
787 }
788
789 const char *
790 flow_tun_flag_to_string(uint32_t flags)
791 {
792     switch (flags) {
793     case FLOW_TNL_F_DONT_FRAGMENT:
794         return "df";
795     case FLOW_TNL_F_CSUM:
796         return "csum";
797     case FLOW_TNL_F_KEY:
798         return "key";
799     case FLOW_TNL_F_OAM:
800         return "oam";
801     default:
802         return NULL;
803     }
804 }
805
806 void
807 format_flags(struct ds *ds, const char *(*bit_to_string)(uint32_t),
808              uint32_t flags, char del)
809 {
810     uint32_t bad = 0;
811
812     if (!flags) {
813         return;
814     }
815     while (flags) {
816         uint32_t bit = rightmost_1bit(flags);
817         const char *s;
818
819         s = bit_to_string(bit);
820         if (s) {
821             ds_put_format(ds, "%s%c", s, del);
822         } else {
823             bad |= bit;
824         }
825
826         flags &= ~bit;
827     }
828
829     if (bad) {
830         ds_put_format(ds, "0x%"PRIx32"%c", bad, del);
831     }
832     ds_chomp(ds, del);
833 }
834
835 void
836 format_flags_masked(struct ds *ds, const char *name,
837                     const char *(*bit_to_string)(uint32_t), uint32_t flags,
838                     uint32_t mask)
839 {
840     if (name) {
841         ds_put_format(ds, "%s=", name);
842     }
843     while (mask) {
844         uint32_t bit = rightmost_1bit(mask);
845         const char *s = bit_to_string(bit);
846
847         ds_put_format(ds, "%s%s", (flags & bit) ? "+" : "-",
848                       s ? s : "[Unknown]");
849         mask &= ~bit;
850     }
851 }
852
853 void
854 flow_format(struct ds *ds, const struct flow *flow)
855 {
856     struct match match;
857     struct flow_wildcards *wc = &match.wc;
858
859     match_wc_init(&match, flow);
860
861     /* As this function is most often used for formatting a packet in a
862      * packet-in message, skip formatting the packet context fields that are
863      * all-zeroes (Openflow spec encourages leaving out all-zeroes context
864      * fields from the packet-in messages).  We make an exception with the
865      * 'in_port' field, which we always format, as packets usually have an
866      * in_port, and 0 is a port just like any other port. */
867     if (!flow->skb_priority) {
868         WC_UNMASK_FIELD(wc, skb_priority);
869     }
870     if (!flow->pkt_mark) {
871         WC_UNMASK_FIELD(wc, pkt_mark);
872     }
873     if (!flow->recirc_id) {
874         WC_UNMASK_FIELD(wc, recirc_id);
875     }
876     for (int i = 0; i < FLOW_N_REGS; i++) {
877         if (!flow->regs[i]) {
878             WC_UNMASK_FIELD(wc, regs[i]);
879         }
880     }
881     if (!flow->metadata) {
882         WC_UNMASK_FIELD(wc, metadata);
883     }
884
885     match_format(&match, ds, OFP_DEFAULT_PRIORITY);
886 }
887
888 void
889 flow_print(FILE *stream, const struct flow *flow)
890 {
891     char *s = flow_to_string(flow);
892     fputs(s, stream);
893     free(s);
894 }
895 \f
896 /* flow_wildcards functions. */
897
898 /* Initializes 'wc' as a set of wildcards that matches every packet. */
899 void
900 flow_wildcards_init_catchall(struct flow_wildcards *wc)
901 {
902     memset(&wc->masks, 0, sizeof wc->masks);
903 }
904
905 /* Converts a flow into flow wildcards.  It sets the wildcard masks based on
906  * the packet headers extracted to 'flow'.  It will not set the mask for fields
907  * that do not make sense for the packet type.  OpenFlow-only metadata is
908  * wildcarded, but other metadata is unconditionally exact-matched. */
909 void flow_wildcards_init_for_packet(struct flow_wildcards *wc,
910                                     const struct flow *flow)
911 {
912     memset(&wc->masks, 0x0, sizeof wc->masks);
913
914     /* Update this function whenever struct flow changes. */
915     BUILD_ASSERT_DECL(FLOW_WC_SEQ == 30);
916
917     if (flow->tunnel.ip_dst) {
918         if (flow->tunnel.flags & FLOW_TNL_F_KEY) {
919             WC_MASK_FIELD(wc, tunnel.tun_id);
920         }
921         WC_MASK_FIELD(wc, tunnel.ip_src);
922         WC_MASK_FIELD(wc, tunnel.ip_dst);
923         WC_MASK_FIELD(wc, tunnel.flags);
924         WC_MASK_FIELD(wc, tunnel.ip_tos);
925         WC_MASK_FIELD(wc, tunnel.ip_ttl);
926         WC_MASK_FIELD(wc, tunnel.tp_src);
927         WC_MASK_FIELD(wc, tunnel.tp_dst);
928     } else if (flow->tunnel.tun_id) {
929         WC_MASK_FIELD(wc, tunnel.tun_id);
930     }
931
932     /* metadata, regs, and conj_id wildcarded. */
933
934     WC_MASK_FIELD(wc, skb_priority);
935     WC_MASK_FIELD(wc, pkt_mark);
936     WC_MASK_FIELD(wc, recirc_id);
937     WC_MASK_FIELD(wc, dp_hash);
938     WC_MASK_FIELD(wc, in_port);
939
940     /* actset_output wildcarded. */
941
942     WC_MASK_FIELD(wc, dl_dst);
943     WC_MASK_FIELD(wc, dl_src);
944     WC_MASK_FIELD(wc, dl_type);
945     WC_MASK_FIELD(wc, vlan_tci);
946
947     if (flow->dl_type == htons(ETH_TYPE_IP)) {
948         WC_MASK_FIELD(wc, nw_src);
949         WC_MASK_FIELD(wc, nw_dst);
950     } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
951         WC_MASK_FIELD(wc, ipv6_src);
952         WC_MASK_FIELD(wc, ipv6_dst);
953         WC_MASK_FIELD(wc, ipv6_label);
954     } else if (flow->dl_type == htons(ETH_TYPE_ARP) ||
955                flow->dl_type == htons(ETH_TYPE_RARP)) {
956         WC_MASK_FIELD(wc, nw_src);
957         WC_MASK_FIELD(wc, nw_dst);
958         WC_MASK_FIELD(wc, nw_proto);
959         WC_MASK_FIELD(wc, arp_sha);
960         WC_MASK_FIELD(wc, arp_tha);
961         return;
962     } else if (eth_type_mpls(flow->dl_type)) {
963         for (int i = 0; i < FLOW_MAX_MPLS_LABELS; i++) {
964             WC_MASK_FIELD(wc, mpls_lse[i]);
965             if (flow->mpls_lse[i] & htonl(MPLS_BOS_MASK)) {
966                 break;
967             }
968         }
969         return;
970     } else {
971         return; /* Unknown ethertype. */
972     }
973
974     /* IPv4 or IPv6. */
975     WC_MASK_FIELD(wc, nw_frag);
976     WC_MASK_FIELD(wc, nw_tos);
977     WC_MASK_FIELD(wc, nw_ttl);
978     WC_MASK_FIELD(wc, nw_proto);
979
980     /* No transport layer header in later fragments. */
981     if (!(flow->nw_frag & FLOW_NW_FRAG_LATER) &&
982         (flow->nw_proto == IPPROTO_ICMP ||
983          flow->nw_proto == IPPROTO_ICMPV6 ||
984          flow->nw_proto == IPPROTO_TCP ||
985          flow->nw_proto == IPPROTO_UDP ||
986          flow->nw_proto == IPPROTO_SCTP ||
987          flow->nw_proto == IPPROTO_IGMP)) {
988         WC_MASK_FIELD(wc, tp_src);
989         WC_MASK_FIELD(wc, tp_dst);
990
991         if (flow->nw_proto == IPPROTO_TCP) {
992             WC_MASK_FIELD(wc, tcp_flags);
993         } else if (flow->nw_proto == IPPROTO_ICMPV6) {
994             WC_MASK_FIELD(wc, arp_sha);
995             WC_MASK_FIELD(wc, arp_tha);
996             WC_MASK_FIELD(wc, nd_target);
997         } else if (flow->nw_proto == IPPROTO_IGMP) {
998             WC_MASK_FIELD(wc, igmp_group_ip4);
999         }
1000     }
1001 }
1002
1003 /* Return a map of possible fields for a packet of the same type as 'flow'.
1004  * Including extra bits in the returned mask is not wrong, it is just less
1005  * optimal.
1006  *
1007  * This is a less precise version of flow_wildcards_init_for_packet() above. */
1008 uint64_t
1009 flow_wc_map(const struct flow *flow)
1010 {
1011     /* Update this function whenever struct flow changes. */
1012     BUILD_ASSERT_DECL(FLOW_WC_SEQ == 30);
1013
1014     uint64_t map = (flow->tunnel.ip_dst) ? MINIFLOW_MAP(tunnel) : 0;
1015
1016     /* Metadata fields that can appear on packet input. */
1017     map |= MINIFLOW_MAP(skb_priority) | MINIFLOW_MAP(pkt_mark)
1018         | MINIFLOW_MAP(recirc_id) | MINIFLOW_MAP(dp_hash)
1019         | MINIFLOW_MAP(in_port)
1020         | MINIFLOW_MAP(dl_dst) | MINIFLOW_MAP(dl_src)
1021         | MINIFLOW_MAP(dl_type) | MINIFLOW_MAP(vlan_tci);
1022
1023     /* Ethertype-dependent fields. */
1024     if (OVS_LIKELY(flow->dl_type == htons(ETH_TYPE_IP))) {
1025         map |= MINIFLOW_MAP(nw_src) | MINIFLOW_MAP(nw_dst)
1026             | MINIFLOW_MAP(nw_proto) | MINIFLOW_MAP(nw_frag)
1027             | MINIFLOW_MAP(nw_tos) | MINIFLOW_MAP(nw_ttl);
1028         if (OVS_UNLIKELY(flow->nw_proto == IPPROTO_IGMP)) {
1029             map |= MINIFLOW_MAP(igmp_group_ip4);
1030         } else {
1031             map |= MINIFLOW_MAP(tcp_flags)
1032                 | MINIFLOW_MAP(tp_src) | MINIFLOW_MAP(tp_dst);
1033         }
1034     } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
1035         map |= MINIFLOW_MAP(ipv6_src) | MINIFLOW_MAP(ipv6_dst)
1036             | MINIFLOW_MAP(ipv6_label)
1037             | MINIFLOW_MAP(nw_proto) | MINIFLOW_MAP(nw_frag)
1038             | MINIFLOW_MAP(nw_tos) | MINIFLOW_MAP(nw_ttl);
1039         if (OVS_UNLIKELY(flow->nw_proto == IPPROTO_ICMPV6)) {
1040             map |= MINIFLOW_MAP(nd_target)
1041                 | MINIFLOW_MAP(arp_sha) | MINIFLOW_MAP(arp_tha);
1042         } else {
1043             map |= MINIFLOW_MAP(tcp_flags)
1044                 | MINIFLOW_MAP(tp_src) | MINIFLOW_MAP(tp_dst);
1045         }
1046     } else if (eth_type_mpls(flow->dl_type)) {
1047         map |= MINIFLOW_MAP(mpls_lse);
1048     } else if (flow->dl_type == htons(ETH_TYPE_ARP) ||
1049                flow->dl_type == htons(ETH_TYPE_RARP)) {
1050         map |= MINIFLOW_MAP(nw_src) | MINIFLOW_MAP(nw_dst)
1051             | MINIFLOW_MAP(nw_proto)
1052             | MINIFLOW_MAP(arp_sha) | MINIFLOW_MAP(arp_tha);
1053     }
1054
1055     return map;
1056 }
1057
1058 /* Clear the metadata and register wildcard masks. They are not packet
1059  * header fields. */
1060 void
1061 flow_wildcards_clear_non_packet_fields(struct flow_wildcards *wc)
1062 {
1063     /* Update this function whenever struct flow changes. */
1064     BUILD_ASSERT_DECL(FLOW_WC_SEQ == 30);
1065
1066     memset(&wc->masks.metadata, 0, sizeof wc->masks.metadata);
1067     memset(&wc->masks.regs, 0, sizeof wc->masks.regs);
1068     wc->masks.actset_output = 0;
1069     wc->masks.conj_id = 0;
1070 }
1071
1072 /* Returns true if 'wc' matches every packet, false if 'wc' fixes any bits or
1073  * fields. */
1074 bool
1075 flow_wildcards_is_catchall(const struct flow_wildcards *wc)
1076 {
1077     const uint64_t *wc_u64 = (const uint64_t *) &wc->masks;
1078     size_t i;
1079
1080     for (i = 0; i < FLOW_U64S; i++) {
1081         if (wc_u64[i]) {
1082             return false;
1083         }
1084     }
1085     return true;
1086 }
1087
1088 /* Sets 'dst' as the bitwise AND of wildcards in 'src1' and 'src2'.
1089  * That is, a bit or a field is wildcarded in 'dst' if it is wildcarded
1090  * in 'src1' or 'src2' or both.  */
1091 void
1092 flow_wildcards_and(struct flow_wildcards *dst,
1093                    const struct flow_wildcards *src1,
1094                    const struct flow_wildcards *src2)
1095 {
1096     uint64_t *dst_u64 = (uint64_t *) &dst->masks;
1097     const uint64_t *src1_u64 = (const uint64_t *) &src1->masks;
1098     const uint64_t *src2_u64 = (const uint64_t *) &src2->masks;
1099     size_t i;
1100
1101     for (i = 0; i < FLOW_U64S; i++) {
1102         dst_u64[i] = src1_u64[i] & src2_u64[i];
1103     }
1104 }
1105
1106 /* Sets 'dst' as the bitwise OR of wildcards in 'src1' and 'src2'.  That
1107  * is, a bit or a field is wildcarded in 'dst' if it is neither
1108  * wildcarded in 'src1' nor 'src2'. */
1109 void
1110 flow_wildcards_or(struct flow_wildcards *dst,
1111                   const struct flow_wildcards *src1,
1112                   const struct flow_wildcards *src2)
1113 {
1114     uint64_t *dst_u64 = (uint64_t *) &dst->masks;
1115     const uint64_t *src1_u64 = (const uint64_t *) &src1->masks;
1116     const uint64_t *src2_u64 = (const uint64_t *) &src2->masks;
1117     size_t i;
1118
1119     for (i = 0; i < FLOW_U64S; i++) {
1120         dst_u64[i] = src1_u64[i] | src2_u64[i];
1121     }
1122 }
1123
1124 /* Returns a hash of the wildcards in 'wc'. */
1125 uint32_t
1126 flow_wildcards_hash(const struct flow_wildcards *wc, uint32_t basis)
1127 {
1128     return flow_hash(&wc->masks, basis);
1129 }
1130
1131 /* Returns true if 'a' and 'b' represent the same wildcards, false if they are
1132  * different. */
1133 bool
1134 flow_wildcards_equal(const struct flow_wildcards *a,
1135                      const struct flow_wildcards *b)
1136 {
1137     return flow_equal(&a->masks, &b->masks);
1138 }
1139
1140 /* Returns true if at least one bit or field is wildcarded in 'a' but not in
1141  * 'b', false otherwise. */
1142 bool
1143 flow_wildcards_has_extra(const struct flow_wildcards *a,
1144                          const struct flow_wildcards *b)
1145 {
1146     const uint64_t *a_u64 = (const uint64_t *) &a->masks;
1147     const uint64_t *b_u64 = (const uint64_t *) &b->masks;
1148     size_t i;
1149
1150     for (i = 0; i < FLOW_U64S; i++) {
1151         if ((a_u64[i] & b_u64[i]) != b_u64[i]) {
1152             return true;
1153         }
1154     }
1155     return false;
1156 }
1157
1158 /* Returns true if 'a' and 'b' are equal, except that 0-bits (wildcarded bits)
1159  * in 'wc' do not need to be equal in 'a' and 'b'. */
1160 bool
1161 flow_equal_except(const struct flow *a, const struct flow *b,
1162                   const struct flow_wildcards *wc)
1163 {
1164     const uint64_t *a_u64 = (const uint64_t *) a;
1165     const uint64_t *b_u64 = (const uint64_t *) b;
1166     const uint64_t *wc_u64 = (const uint64_t *) &wc->masks;
1167     size_t i;
1168
1169     for (i = 0; i < FLOW_U64S; i++) {
1170         if ((a_u64[i] ^ b_u64[i]) & wc_u64[i]) {
1171             return false;
1172         }
1173     }
1174     return true;
1175 }
1176
1177 /* Sets the wildcard mask for register 'idx' in 'wc' to 'mask'.
1178  * (A 0-bit indicates a wildcard bit.) */
1179 void
1180 flow_wildcards_set_reg_mask(struct flow_wildcards *wc, int idx, uint32_t mask)
1181 {
1182     wc->masks.regs[idx] = mask;
1183 }
1184
1185 /* Sets the wildcard mask for register 'idx' in 'wc' to 'mask'.
1186  * (A 0-bit indicates a wildcard bit.) */
1187 void
1188 flow_wildcards_set_xreg_mask(struct flow_wildcards *wc, int idx, uint64_t mask)
1189 {
1190     flow_set_xreg(&wc->masks, idx, mask);
1191 }
1192
1193 /* Calculates the 5-tuple hash from the given miniflow.
1194  * This returns the same value as flow_hash_5tuple for the corresponding
1195  * flow. */
1196 uint32_t
1197 miniflow_hash_5tuple(const struct miniflow *flow, uint32_t basis)
1198 {
1199     uint32_t hash = basis;
1200
1201     if (flow) {
1202         ovs_be16 dl_type = MINIFLOW_GET_BE16(flow, dl_type);
1203
1204         hash = hash_add(hash, MINIFLOW_GET_U8(flow, nw_proto));
1205
1206         /* Separate loops for better optimization. */
1207         if (dl_type == htons(ETH_TYPE_IPV6)) {
1208             uint64_t map = MINIFLOW_MAP(ipv6_src) | MINIFLOW_MAP(ipv6_dst);
1209             uint64_t value;
1210
1211             MINIFLOW_FOR_EACH_IN_MAP(value, flow, map) {
1212                 hash = hash_add64(hash, value);
1213             }
1214         } else {
1215             hash = hash_add(hash, MINIFLOW_GET_U32(flow, nw_src));
1216             hash = hash_add(hash, MINIFLOW_GET_U32(flow, nw_dst));
1217         }
1218         /* Add both ports at once. */
1219         hash = hash_add(hash, MINIFLOW_GET_U32(flow, tp_src));
1220         hash = hash_finish(hash, 42); /* Arbitrary number. */
1221     }
1222     return hash;
1223 }
1224
1225 BUILD_ASSERT_DECL(offsetof(struct flow, tp_src) + 2
1226                   == offsetof(struct flow, tp_dst) &&
1227                   offsetof(struct flow, tp_src) / 4
1228                   == offsetof(struct flow, tp_dst) / 4);
1229 BUILD_ASSERT_DECL(offsetof(struct flow, ipv6_src) + 16
1230                   == offsetof(struct flow, ipv6_dst));
1231
1232 /* Calculates the 5-tuple hash from the given flow. */
1233 uint32_t
1234 flow_hash_5tuple(const struct flow *flow, uint32_t basis)
1235 {
1236     uint32_t hash = basis;
1237
1238     if (flow) {
1239         hash = hash_add(hash, flow->nw_proto);
1240
1241         if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
1242             const uint64_t *flow_u64 = (const uint64_t *)flow;
1243             int ofs = offsetof(struct flow, ipv6_src) / 8;
1244             int end = ofs + 2 * sizeof flow->ipv6_src / 8;
1245
1246             for (;ofs < end; ofs++) {
1247                 hash = hash_add64(hash, flow_u64[ofs]);
1248             }
1249         } else {
1250             hash = hash_add(hash, (OVS_FORCE uint32_t) flow->nw_src);
1251             hash = hash_add(hash, (OVS_FORCE uint32_t) flow->nw_dst);
1252         }
1253         /* Add both ports at once. */
1254         hash = hash_add(hash,
1255                         ((const uint32_t *)flow)[offsetof(struct flow, tp_src)
1256                                                  / sizeof(uint32_t)]);
1257         hash = hash_finish(hash, 42); /* Arbitrary number. */
1258     }
1259     return hash;
1260 }
1261
1262 /* Hashes 'flow' based on its L2 through L4 protocol information. */
1263 uint32_t
1264 flow_hash_symmetric_l4(const struct flow *flow, uint32_t basis)
1265 {
1266     struct {
1267         union {
1268             ovs_be32 ipv4_addr;
1269             struct in6_addr ipv6_addr;
1270         };
1271         ovs_be16 eth_type;
1272         ovs_be16 vlan_tci;
1273         ovs_be16 tp_port;
1274         uint8_t eth_addr[ETH_ADDR_LEN];
1275         uint8_t ip_proto;
1276     } fields;
1277
1278     int i;
1279
1280     memset(&fields, 0, sizeof fields);
1281     for (i = 0; i < ETH_ADDR_LEN; i++) {
1282         fields.eth_addr[i] = flow->dl_src[i] ^ flow->dl_dst[i];
1283     }
1284     fields.vlan_tci = flow->vlan_tci & htons(VLAN_VID_MASK);
1285     fields.eth_type = flow->dl_type;
1286
1287     /* UDP source and destination port are not taken into account because they
1288      * will not necessarily be symmetric in a bidirectional flow. */
1289     if (fields.eth_type == htons(ETH_TYPE_IP)) {
1290         fields.ipv4_addr = flow->nw_src ^ flow->nw_dst;
1291         fields.ip_proto = flow->nw_proto;
1292         if (fields.ip_proto == IPPROTO_TCP || fields.ip_proto == IPPROTO_SCTP) {
1293             fields.tp_port = flow->tp_src ^ flow->tp_dst;
1294         }
1295     } else if (fields.eth_type == htons(ETH_TYPE_IPV6)) {
1296         const uint8_t *a = &flow->ipv6_src.s6_addr[0];
1297         const uint8_t *b = &flow->ipv6_dst.s6_addr[0];
1298         uint8_t *ipv6_addr = &fields.ipv6_addr.s6_addr[0];
1299
1300         for (i=0; i<16; i++) {
1301             ipv6_addr[i] = a[i] ^ b[i];
1302         }
1303         fields.ip_proto = flow->nw_proto;
1304         if (fields.ip_proto == IPPROTO_TCP || fields.ip_proto == IPPROTO_SCTP) {
1305             fields.tp_port = flow->tp_src ^ flow->tp_dst;
1306         }
1307     }
1308     return jhash_bytes(&fields, sizeof fields, basis);
1309 }
1310
1311 /* Initialize a flow with random fields that matter for nx_hash_fields. */
1312 void
1313 flow_random_hash_fields(struct flow *flow)
1314 {
1315     uint16_t rnd = random_uint16();
1316
1317     /* Initialize to all zeros. */
1318     memset(flow, 0, sizeof *flow);
1319
1320     eth_addr_random(flow->dl_src);
1321     eth_addr_random(flow->dl_dst);
1322
1323     flow->vlan_tci = (OVS_FORCE ovs_be16) (random_uint16() & VLAN_VID_MASK);
1324
1325     /* Make most of the random flows IPv4, some IPv6, and rest random. */
1326     flow->dl_type = rnd < 0x8000 ? htons(ETH_TYPE_IP) :
1327         rnd < 0xc000 ? htons(ETH_TYPE_IPV6) : (OVS_FORCE ovs_be16)rnd;
1328
1329     if (dl_type_is_ip_any(flow->dl_type)) {
1330         if (flow->dl_type == htons(ETH_TYPE_IP)) {
1331             flow->nw_src = (OVS_FORCE ovs_be32)random_uint32();
1332             flow->nw_dst = (OVS_FORCE ovs_be32)random_uint32();
1333         } else {
1334             random_bytes(&flow->ipv6_src, sizeof flow->ipv6_src);
1335             random_bytes(&flow->ipv6_dst, sizeof flow->ipv6_dst);
1336         }
1337         /* Make most of IP flows TCP, some UDP or SCTP, and rest random. */
1338         rnd = random_uint16();
1339         flow->nw_proto = rnd < 0x8000 ? IPPROTO_TCP :
1340             rnd < 0xc000 ? IPPROTO_UDP :
1341             rnd < 0xd000 ? IPPROTO_SCTP : (uint8_t)rnd;
1342         if (flow->nw_proto == IPPROTO_TCP ||
1343             flow->nw_proto == IPPROTO_UDP ||
1344             flow->nw_proto == IPPROTO_SCTP) {
1345             flow->tp_src = (OVS_FORCE ovs_be16)random_uint16();
1346             flow->tp_dst = (OVS_FORCE ovs_be16)random_uint16();
1347         }
1348     }
1349 }
1350
1351 /* Masks the fields in 'wc' that are used by the flow hash 'fields'. */
1352 void
1353 flow_mask_hash_fields(const struct flow *flow, struct flow_wildcards *wc,
1354                       enum nx_hash_fields fields)
1355 {
1356     switch (fields) {
1357     case NX_HASH_FIELDS_ETH_SRC:
1358         memset(&wc->masks.dl_src, 0xff, sizeof wc->masks.dl_src);
1359         break;
1360
1361     case NX_HASH_FIELDS_SYMMETRIC_L4:
1362         memset(&wc->masks.dl_src, 0xff, sizeof wc->masks.dl_src);
1363         memset(&wc->masks.dl_dst, 0xff, sizeof wc->masks.dl_dst);
1364         if (flow->dl_type == htons(ETH_TYPE_IP)) {
1365             memset(&wc->masks.nw_src, 0xff, sizeof wc->masks.nw_src);
1366             memset(&wc->masks.nw_dst, 0xff, sizeof wc->masks.nw_dst);
1367         } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
1368             memset(&wc->masks.ipv6_src, 0xff, sizeof wc->masks.ipv6_src);
1369             memset(&wc->masks.ipv6_dst, 0xff, sizeof wc->masks.ipv6_dst);
1370         }
1371         if (is_ip_any(flow)) {
1372             memset(&wc->masks.nw_proto, 0xff, sizeof wc->masks.nw_proto);
1373             flow_unwildcard_tp_ports(flow, wc);
1374         }
1375         wc->masks.vlan_tci |= htons(VLAN_VID_MASK | VLAN_CFI);
1376         break;
1377
1378     default:
1379         OVS_NOT_REACHED();
1380     }
1381 }
1382
1383 /* Hashes the portions of 'flow' designated by 'fields'. */
1384 uint32_t
1385 flow_hash_fields(const struct flow *flow, enum nx_hash_fields fields,
1386                  uint16_t basis)
1387 {
1388     switch (fields) {
1389
1390     case NX_HASH_FIELDS_ETH_SRC:
1391         return jhash_bytes(flow->dl_src, sizeof flow->dl_src, basis);
1392
1393     case NX_HASH_FIELDS_SYMMETRIC_L4:
1394         return flow_hash_symmetric_l4(flow, basis);
1395     }
1396
1397     OVS_NOT_REACHED();
1398 }
1399
1400 /* Returns a string representation of 'fields'. */
1401 const char *
1402 flow_hash_fields_to_str(enum nx_hash_fields fields)
1403 {
1404     switch (fields) {
1405     case NX_HASH_FIELDS_ETH_SRC: return "eth_src";
1406     case NX_HASH_FIELDS_SYMMETRIC_L4: return "symmetric_l4";
1407     default: return "<unknown>";
1408     }
1409 }
1410
1411 /* Returns true if the value of 'fields' is supported. Otherwise false. */
1412 bool
1413 flow_hash_fields_valid(enum nx_hash_fields fields)
1414 {
1415     return fields == NX_HASH_FIELDS_ETH_SRC
1416         || fields == NX_HASH_FIELDS_SYMMETRIC_L4;
1417 }
1418
1419 /* Returns a hash value for the bits of 'flow' that are active based on
1420  * 'wc', given 'basis'. */
1421 uint32_t
1422 flow_hash_in_wildcards(const struct flow *flow,
1423                        const struct flow_wildcards *wc, uint32_t basis)
1424 {
1425     const uint64_t *wc_u64 = (const uint64_t *) &wc->masks;
1426     const uint64_t *flow_u64 = (const uint64_t *) flow;
1427     uint32_t hash;
1428     size_t i;
1429
1430     hash = basis;
1431     for (i = 0; i < FLOW_U64S; i++) {
1432         hash = hash_add64(hash, flow_u64[i] & wc_u64[i]);
1433     }
1434     return hash_finish(hash, 8 * FLOW_U64S);
1435 }
1436
1437 /* Sets the VLAN VID that 'flow' matches to 'vid', which is interpreted as an
1438  * OpenFlow 1.0 "dl_vlan" value:
1439  *
1440  *      - If it is in the range 0...4095, 'flow->vlan_tci' is set to match
1441  *        that VLAN.  Any existing PCP match is unchanged (it becomes 0 if
1442  *        'flow' previously matched packets without a VLAN header).
1443  *
1444  *      - If it is OFP_VLAN_NONE, 'flow->vlan_tci' is set to match a packet
1445  *        without a VLAN tag.
1446  *
1447  *      - Other values of 'vid' should not be used. */
1448 void
1449 flow_set_dl_vlan(struct flow *flow, ovs_be16 vid)
1450 {
1451     if (vid == htons(OFP10_VLAN_NONE)) {
1452         flow->vlan_tci = htons(0);
1453     } else {
1454         vid &= htons(VLAN_VID_MASK);
1455         flow->vlan_tci &= ~htons(VLAN_VID_MASK);
1456         flow->vlan_tci |= htons(VLAN_CFI) | vid;
1457     }
1458 }
1459
1460 /* Sets the VLAN VID that 'flow' matches to 'vid', which is interpreted as an
1461  * OpenFlow 1.2 "vlan_vid" value, that is, the low 13 bits of 'vlan_tci' (VID
1462  * plus CFI). */
1463 void
1464 flow_set_vlan_vid(struct flow *flow, ovs_be16 vid)
1465 {
1466     ovs_be16 mask = htons(VLAN_VID_MASK | VLAN_CFI);
1467     flow->vlan_tci &= ~mask;
1468     flow->vlan_tci |= vid & mask;
1469 }
1470
1471 /* Sets the VLAN PCP that 'flow' matches to 'pcp', which should be in the
1472  * range 0...7.
1473  *
1474  * This function has no effect on the VLAN ID that 'flow' matches.
1475  *
1476  * After calling this function, 'flow' will not match packets without a VLAN
1477  * header. */
1478 void
1479 flow_set_vlan_pcp(struct flow *flow, uint8_t pcp)
1480 {
1481     pcp &= 0x07;
1482     flow->vlan_tci &= ~htons(VLAN_PCP_MASK);
1483     flow->vlan_tci |= htons((pcp << VLAN_PCP_SHIFT) | VLAN_CFI);
1484 }
1485
1486 /* Returns the number of MPLS LSEs present in 'flow'
1487  *
1488  * Returns 0 if the 'dl_type' of 'flow' is not an MPLS ethernet type.
1489  * Otherwise traverses 'flow''s MPLS label stack stopping at the
1490  * first entry that has the BoS bit set. If no such entry exists then
1491  * the maximum number of LSEs that can be stored in 'flow' is returned.
1492  */
1493 int
1494 flow_count_mpls_labels(const struct flow *flow, struct flow_wildcards *wc)
1495 {
1496     /* dl_type is always masked. */
1497     if (eth_type_mpls(flow->dl_type)) {
1498         int i;
1499         int cnt;
1500
1501         cnt = 0;
1502         for (i = 0; i < FLOW_MAX_MPLS_LABELS; i++) {
1503             if (wc) {
1504                 wc->masks.mpls_lse[i] |= htonl(MPLS_BOS_MASK);
1505             }
1506             if (flow->mpls_lse[i] & htonl(MPLS_BOS_MASK)) {
1507                 return i + 1;
1508             }
1509             if (flow->mpls_lse[i]) {
1510                 cnt++;
1511             }
1512         }
1513         return cnt;
1514     } else {
1515         return 0;
1516     }
1517 }
1518
1519 /* Returns the number consecutive of MPLS LSEs, starting at the
1520  * innermost LSE, that are common in 'a' and 'b'.
1521  *
1522  * 'an' must be flow_count_mpls_labels(a).
1523  * 'bn' must be flow_count_mpls_labels(b).
1524  */
1525 int
1526 flow_count_common_mpls_labels(const struct flow *a, int an,
1527                               const struct flow *b, int bn,
1528                               struct flow_wildcards *wc)
1529 {
1530     int min_n = MIN(an, bn);
1531     if (min_n == 0) {
1532         return 0;
1533     } else {
1534         int common_n = 0;
1535         int a_last = an - 1;
1536         int b_last = bn - 1;
1537         int i;
1538
1539         for (i = 0; i < min_n; i++) {
1540             if (wc) {
1541                 wc->masks.mpls_lse[a_last - i] = OVS_BE32_MAX;
1542                 wc->masks.mpls_lse[b_last - i] = OVS_BE32_MAX;
1543             }
1544             if (a->mpls_lse[a_last - i] != b->mpls_lse[b_last - i]) {
1545                 break;
1546             } else {
1547                 common_n++;
1548             }
1549         }
1550
1551         return common_n;
1552     }
1553 }
1554
1555 /* Adds a new outermost MPLS label to 'flow' and changes 'flow''s Ethernet type
1556  * to 'mpls_eth_type', which must be an MPLS Ethertype.
1557  *
1558  * If the new label is the first MPLS label in 'flow', it is generated as;
1559  *
1560  *     - label: 2, if 'flow' is IPv6, otherwise 0.
1561  *
1562  *     - TTL: IPv4 or IPv6 TTL, if present and nonzero, otherwise 64.
1563  *
1564  *     - TC: IPv4 or IPv6 TOS, if present, otherwise 0.
1565  *
1566  *     - BoS: 1.
1567  *
1568  * If the new label is the second or later label MPLS label in 'flow', it is
1569  * generated as;
1570  *
1571  *     - label: Copied from outer label.
1572  *
1573  *     - TTL: Copied from outer label.
1574  *
1575  *     - TC: Copied from outer label.
1576  *
1577  *     - BoS: 0.
1578  *
1579  * 'n' must be flow_count_mpls_labels(flow).  'n' must be less than
1580  * FLOW_MAX_MPLS_LABELS (because otherwise flow->mpls_lse[] would overflow).
1581  */
1582 void
1583 flow_push_mpls(struct flow *flow, int n, ovs_be16 mpls_eth_type,
1584                struct flow_wildcards *wc)
1585 {
1586     ovs_assert(eth_type_mpls(mpls_eth_type));
1587     ovs_assert(n < FLOW_MAX_MPLS_LABELS);
1588
1589     if (n) {
1590         int i;
1591
1592         if (wc) {
1593             memset(&wc->masks.mpls_lse, 0xff, sizeof *wc->masks.mpls_lse * n);
1594         }
1595         for (i = n; i >= 1; i--) {
1596             flow->mpls_lse[i] = flow->mpls_lse[i - 1];
1597         }
1598         flow->mpls_lse[0] = (flow->mpls_lse[1] & htonl(~MPLS_BOS_MASK));
1599     } else {
1600         int label = 0;          /* IPv4 Explicit Null. */
1601         int tc = 0;
1602         int ttl = 64;
1603
1604         if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
1605             label = 2;
1606         }
1607
1608         if (is_ip_any(flow)) {
1609             tc = (flow->nw_tos & IP_DSCP_MASK) >> 2;
1610             if (wc) {
1611                 wc->masks.nw_tos |= IP_DSCP_MASK;
1612                 wc->masks.nw_ttl = 0xff;
1613             }
1614
1615             if (flow->nw_ttl) {
1616                 ttl = flow->nw_ttl;
1617             }
1618         }
1619
1620         flow->mpls_lse[0] = set_mpls_lse_values(ttl, tc, 1, htonl(label));
1621
1622         /* Clear all L3 and L4 fields and dp_hash. */
1623         BUILD_ASSERT(FLOW_WC_SEQ == 30);
1624         memset((char *) flow + FLOW_SEGMENT_2_ENDS_AT, 0,
1625                sizeof(struct flow) - FLOW_SEGMENT_2_ENDS_AT);
1626         flow->dp_hash = 0;
1627     }
1628     flow->dl_type = mpls_eth_type;
1629 }
1630
1631 /* Tries to remove the outermost MPLS label from 'flow'.  Returns true if
1632  * successful, false otherwise.  On success, sets 'flow''s Ethernet type to
1633  * 'eth_type'.
1634  *
1635  * 'n' must be flow_count_mpls_labels(flow). */
1636 bool
1637 flow_pop_mpls(struct flow *flow, int n, ovs_be16 eth_type,
1638               struct flow_wildcards *wc)
1639 {
1640     int i;
1641
1642     if (n == 0) {
1643         /* Nothing to pop. */
1644         return false;
1645     } else if (n == FLOW_MAX_MPLS_LABELS) {
1646         if (wc) {
1647             wc->masks.mpls_lse[n - 1] |= htonl(MPLS_BOS_MASK);
1648         }
1649         if (!(flow->mpls_lse[n - 1] & htonl(MPLS_BOS_MASK))) {
1650             /* Can't pop because don't know what to fill in mpls_lse[n - 1]. */
1651             return false;
1652         }
1653     }
1654
1655     if (wc) {
1656         memset(&wc->masks.mpls_lse[1], 0xff,
1657                sizeof *wc->masks.mpls_lse * (n - 1));
1658     }
1659     for (i = 1; i < n; i++) {
1660         flow->mpls_lse[i - 1] = flow->mpls_lse[i];
1661     }
1662     flow->mpls_lse[n - 1] = 0;
1663     flow->dl_type = eth_type;
1664     return true;
1665 }
1666
1667 /* Sets the MPLS Label that 'flow' matches to 'label', which is interpreted
1668  * as an OpenFlow 1.1 "mpls_label" value. */
1669 void
1670 flow_set_mpls_label(struct flow *flow, int idx, ovs_be32 label)
1671 {
1672     set_mpls_lse_label(&flow->mpls_lse[idx], label);
1673 }
1674
1675 /* Sets the MPLS TTL that 'flow' matches to 'ttl', which should be in the
1676  * range 0...255. */
1677 void
1678 flow_set_mpls_ttl(struct flow *flow, int idx, uint8_t ttl)
1679 {
1680     set_mpls_lse_ttl(&flow->mpls_lse[idx], ttl);
1681 }
1682
1683 /* Sets the MPLS TC that 'flow' matches to 'tc', which should be in the
1684  * range 0...7. */
1685 void
1686 flow_set_mpls_tc(struct flow *flow, int idx, uint8_t tc)
1687 {
1688     set_mpls_lse_tc(&flow->mpls_lse[idx], tc);
1689 }
1690
1691 /* Sets the MPLS BOS bit that 'flow' matches to which should be 0 or 1. */
1692 void
1693 flow_set_mpls_bos(struct flow *flow, int idx, uint8_t bos)
1694 {
1695     set_mpls_lse_bos(&flow->mpls_lse[idx], bos);
1696 }
1697
1698 /* Sets the entire MPLS LSE. */
1699 void
1700 flow_set_mpls_lse(struct flow *flow, int idx, ovs_be32 lse)
1701 {
1702     flow->mpls_lse[idx] = lse;
1703 }
1704
1705 static size_t
1706 flow_compose_l4(struct ofpbuf *b, const struct flow *flow)
1707 {
1708     size_t l4_len = 0;
1709
1710     if (!(flow->nw_frag & FLOW_NW_FRAG_ANY)
1711         || !(flow->nw_frag & FLOW_NW_FRAG_LATER)) {
1712         if (flow->nw_proto == IPPROTO_TCP) {
1713             struct tcp_header *tcp;
1714
1715             l4_len = sizeof *tcp;
1716             tcp = ofpbuf_put_zeros(b, l4_len);
1717             tcp->tcp_src = flow->tp_src;
1718             tcp->tcp_dst = flow->tp_dst;
1719             tcp->tcp_ctl = TCP_CTL(ntohs(flow->tcp_flags), 5);
1720         } else if (flow->nw_proto == IPPROTO_UDP) {
1721             struct udp_header *udp;
1722
1723             l4_len = sizeof *udp;
1724             udp = ofpbuf_put_zeros(b, l4_len);
1725             udp->udp_src = flow->tp_src;
1726             udp->udp_dst = flow->tp_dst;
1727         } else if (flow->nw_proto == IPPROTO_SCTP) {
1728             struct sctp_header *sctp;
1729
1730             l4_len = sizeof *sctp;
1731             sctp = ofpbuf_put_zeros(b, l4_len);
1732             sctp->sctp_src = flow->tp_src;
1733             sctp->sctp_dst = flow->tp_dst;
1734         } else if (flow->nw_proto == IPPROTO_ICMP) {
1735             struct icmp_header *icmp;
1736
1737             l4_len = sizeof *icmp;
1738             icmp = ofpbuf_put_zeros(b, l4_len);
1739             icmp->icmp_type = ntohs(flow->tp_src);
1740             icmp->icmp_code = ntohs(flow->tp_dst);
1741             icmp->icmp_csum = csum(icmp, ICMP_HEADER_LEN);
1742         } else if (flow->nw_proto == IPPROTO_IGMP) {
1743             struct igmp_header *igmp;
1744
1745             l4_len = sizeof *igmp;
1746             igmp = ofpbuf_put_zeros(b, l4_len);
1747             igmp->igmp_type = ntohs(flow->tp_src);
1748             igmp->igmp_code = ntohs(flow->tp_dst);
1749             put_16aligned_be32(&igmp->group, flow->igmp_group_ip4);
1750             igmp->igmp_csum = csum(igmp, IGMP_HEADER_LEN);
1751         } else if (flow->nw_proto == IPPROTO_ICMPV6) {
1752             struct icmp6_hdr *icmp;
1753
1754             l4_len = sizeof *icmp;
1755             icmp = ofpbuf_put_zeros(b, l4_len);
1756             icmp->icmp6_type = ntohs(flow->tp_src);
1757             icmp->icmp6_code = ntohs(flow->tp_dst);
1758
1759             if (icmp->icmp6_code == 0 &&
1760                 (icmp->icmp6_type == ND_NEIGHBOR_SOLICIT ||
1761                  icmp->icmp6_type == ND_NEIGHBOR_ADVERT)) {
1762                 struct in6_addr *nd_target;
1763                 struct nd_opt_hdr *nd_opt;
1764
1765                 l4_len += sizeof *nd_target;
1766                 nd_target = ofpbuf_put_zeros(b, sizeof *nd_target);
1767                 *nd_target = flow->nd_target;
1768
1769                 if (!eth_addr_is_zero(flow->arp_sha)) {
1770                     l4_len += 8;
1771                     nd_opt = ofpbuf_put_zeros(b, 8);
1772                     nd_opt->nd_opt_len = 1;
1773                     nd_opt->nd_opt_type = ND_OPT_SOURCE_LINKADDR;
1774                     memcpy(nd_opt + 1, flow->arp_sha, ETH_ADDR_LEN);
1775                 }
1776                 if (!eth_addr_is_zero(flow->arp_tha)) {
1777                     l4_len += 8;
1778                     nd_opt = ofpbuf_put_zeros(b, 8);
1779                     nd_opt->nd_opt_len = 1;
1780                     nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR;
1781                     memcpy(nd_opt + 1, flow->arp_tha, ETH_ADDR_LEN);
1782                 }
1783             }
1784             icmp->icmp6_cksum = (OVS_FORCE uint16_t)
1785                 csum(icmp, (char *)ofpbuf_tail(b) - (char *)icmp);
1786         }
1787     }
1788     return l4_len;
1789 }
1790
1791 /* Puts into 'b' a packet that flow_extract() would parse as having the given
1792  * 'flow'.
1793  *
1794  * (This is useful only for testing, obviously, and the packet isn't really
1795  * valid. It hasn't got some checksums filled in, for one, and lots of fields
1796  * are just zeroed.) */
1797 void
1798 flow_compose(struct ofpbuf *b, const struct flow *flow)
1799 {
1800     size_t l4_len;
1801
1802     /* eth_compose() sets l3 pointer and makes sure it is 32-bit aligned. */
1803     eth_compose(b, flow->dl_dst, flow->dl_src, ntohs(flow->dl_type), 0);
1804     if (flow->dl_type == htons(FLOW_DL_TYPE_NONE)) {
1805         struct eth_header *eth = ofpbuf_l2(b);
1806         eth->eth_type = htons(ofpbuf_size(b));
1807         return;
1808     }
1809
1810     if (flow->vlan_tci & htons(VLAN_CFI)) {
1811         eth_push_vlan(b, htons(ETH_TYPE_VLAN), flow->vlan_tci);
1812     }
1813
1814     if (flow->dl_type == htons(ETH_TYPE_IP)) {
1815         struct ip_header *ip;
1816
1817         ip = ofpbuf_put_zeros(b, sizeof *ip);
1818         ip->ip_ihl_ver = IP_IHL_VER(5, 4);
1819         ip->ip_tos = flow->nw_tos;
1820         ip->ip_ttl = flow->nw_ttl;
1821         ip->ip_proto = flow->nw_proto;
1822         put_16aligned_be32(&ip->ip_src, flow->nw_src);
1823         put_16aligned_be32(&ip->ip_dst, flow->nw_dst);
1824
1825         if (flow->nw_frag & FLOW_NW_FRAG_ANY) {
1826             ip->ip_frag_off |= htons(IP_MORE_FRAGMENTS);
1827             if (flow->nw_frag & FLOW_NW_FRAG_LATER) {
1828                 ip->ip_frag_off |= htons(100);
1829             }
1830         }
1831
1832         ofpbuf_set_l4(b, ofpbuf_tail(b));
1833
1834         l4_len = flow_compose_l4(b, flow);
1835
1836         ip = ofpbuf_l3(b);
1837         ip->ip_tot_len = htons(b->l4_ofs - b->l3_ofs + l4_len);
1838         ip->ip_csum = csum(ip, sizeof *ip);
1839     } else if (flow->dl_type == htons(ETH_TYPE_IPV6)) {
1840         struct ovs_16aligned_ip6_hdr *nh;
1841
1842         nh = ofpbuf_put_zeros(b, sizeof *nh);
1843         put_16aligned_be32(&nh->ip6_flow, htonl(6 << 28) |
1844                            htonl(flow->nw_tos << 20) | flow->ipv6_label);
1845         nh->ip6_hlim = flow->nw_ttl;
1846         nh->ip6_nxt = flow->nw_proto;
1847
1848         memcpy(&nh->ip6_src, &flow->ipv6_src, sizeof(nh->ip6_src));
1849         memcpy(&nh->ip6_dst, &flow->ipv6_dst, sizeof(nh->ip6_dst));
1850
1851         ofpbuf_set_l4(b, ofpbuf_tail(b));
1852
1853         l4_len = flow_compose_l4(b, flow);
1854
1855         nh = ofpbuf_l3(b);
1856         nh->ip6_plen = htons(l4_len);
1857     } else if (flow->dl_type == htons(ETH_TYPE_ARP) ||
1858                flow->dl_type == htons(ETH_TYPE_RARP)) {
1859         struct arp_eth_header *arp;
1860
1861         arp = ofpbuf_put_zeros(b, sizeof *arp);
1862         ofpbuf_set_l3(b, arp);
1863         arp->ar_hrd = htons(1);
1864         arp->ar_pro = htons(ETH_TYPE_IP);
1865         arp->ar_hln = ETH_ADDR_LEN;
1866         arp->ar_pln = 4;
1867         arp->ar_op = htons(flow->nw_proto);
1868
1869         if (flow->nw_proto == ARP_OP_REQUEST ||
1870             flow->nw_proto == ARP_OP_REPLY) {
1871             put_16aligned_be32(&arp->ar_spa, flow->nw_src);
1872             put_16aligned_be32(&arp->ar_tpa, flow->nw_dst);
1873             memcpy(arp->ar_sha, flow->arp_sha, ETH_ADDR_LEN);
1874             memcpy(arp->ar_tha, flow->arp_tha, ETH_ADDR_LEN);
1875         }
1876     }
1877
1878     if (eth_type_mpls(flow->dl_type)) {
1879         int n;
1880
1881         b->l2_5_ofs = b->l3_ofs;
1882         for (n = 1; n < FLOW_MAX_MPLS_LABELS; n++) {
1883             if (flow->mpls_lse[n - 1] & htonl(MPLS_BOS_MASK)) {
1884                 break;
1885             }
1886         }
1887         while (n > 0) {
1888             push_mpls(b, flow->dl_type, flow->mpls_lse[--n]);
1889         }
1890     }
1891 }
1892 \f
1893 /* Compressed flow. */
1894
1895 static int
1896 miniflow_n_values(const struct miniflow *flow)
1897 {
1898     return count_1bits(flow->map);
1899 }
1900
1901 static uint64_t *
1902 miniflow_alloc_values(struct miniflow *flow, int n)
1903 {
1904     int size = MINIFLOW_VALUES_SIZE(n);
1905
1906     if (size <= sizeof flow->inline_values) {
1907         flow->values_inline = true;
1908         return flow->inline_values;
1909     } else {
1910         COVERAGE_INC(miniflow_malloc);
1911         flow->values_inline = false;
1912         flow->offline_values = xmalloc(size);
1913         return flow->offline_values;
1914     }
1915 }
1916
1917 /* Completes an initialization of 'dst' as a miniflow copy of 'src' begun by
1918  * the caller.  The caller must have already initialized 'dst->map' properly
1919  * to indicate the significant uint64_t elements of 'src'.  'n' must be the
1920  * number of 1-bits in 'dst->map'.
1921  *
1922  * Normally the significant elements are the ones that are non-zero.  However,
1923  * when a miniflow is initialized from a (mini)mask, the values can be zeroes,
1924  * so that the flow and mask always have the same maps.
1925  *
1926  * This function initializes values (either inline if possible or with
1927  * malloc() otherwise) and copies the uint64_t elements of 'src' indicated by
1928  * 'dst->map' into it. */
1929 static void
1930 miniflow_init__(struct miniflow *dst, const struct flow *src, int n)
1931 {
1932     const uint64_t *src_u64 = (const uint64_t *) src;
1933     uint64_t *dst_u64 = miniflow_alloc_values(dst, n);
1934     int idx;
1935
1936     MAP_FOR_EACH_INDEX(idx, dst->map) {
1937         *dst_u64++ = src_u64[idx];
1938     }
1939 }
1940
1941 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
1942  * with miniflow_destroy().
1943  * Always allocates offline storage. */
1944 void
1945 miniflow_init(struct miniflow *dst, const struct flow *src)
1946 {
1947     const uint64_t *src_u64 = (const uint64_t *) src;
1948     unsigned int i;
1949     int n;
1950
1951     /* Initialize dst->map, counting the number of nonzero elements. */
1952     n = 0;
1953     dst->map = 0;
1954
1955     for (i = 0; i < FLOW_U64S; i++) {
1956         if (src_u64[i]) {
1957             dst->map |= UINT64_C(1) << i;
1958             n++;
1959         }
1960     }
1961
1962     miniflow_init__(dst, src, n);
1963 }
1964
1965 /* Initializes 'dst' as a copy of 'src', using 'mask->map' as 'dst''s map.  The
1966  * caller must eventually free 'dst' with miniflow_destroy(). */
1967 void
1968 miniflow_init_with_minimask(struct miniflow *dst, const struct flow *src,
1969                             const struct minimask *mask)
1970 {
1971     dst->map = mask->masks.map;
1972     miniflow_init__(dst, src, miniflow_n_values(dst));
1973 }
1974
1975 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
1976  * with miniflow_destroy(). */
1977 void
1978 miniflow_clone(struct miniflow *dst, const struct miniflow *src)
1979 {
1980     int size = MINIFLOW_VALUES_SIZE(miniflow_n_values(src));
1981     uint64_t *values;
1982
1983     dst->map = src->map;
1984     if (size <= sizeof dst->inline_values) {
1985         dst->values_inline = true;
1986         values = dst->inline_values;
1987     } else {
1988         dst->values_inline = false;
1989         COVERAGE_INC(miniflow_malloc);
1990         dst->offline_values = xmalloc(size);
1991         values = dst->offline_values;
1992     }
1993     memcpy(values, miniflow_get_values(src), size);
1994 }
1995
1996 /* Initializes 'dst' as a copy of 'src'.  The caller must have allocated
1997  * 'dst' to have inline space all data in 'src'. */
1998 void
1999 miniflow_clone_inline(struct miniflow *dst, const struct miniflow *src,
2000                       size_t n_values)
2001 {
2002     dst->values_inline = true;
2003     dst->map = src->map;
2004     memcpy(dst->inline_values, miniflow_get_values(src),
2005            MINIFLOW_VALUES_SIZE(n_values));
2006 }
2007
2008 /* Initializes 'dst' with the data in 'src', destroying 'src'.
2009  * The caller must eventually free 'dst' with miniflow_destroy().
2010  * 'dst' must be regularly sized miniflow, but 'src' can have
2011  * storage for more than the default MINI_N_INLINE inline
2012  * values. */
2013 void
2014 miniflow_move(struct miniflow *dst, struct miniflow *src)
2015 {
2016     int size = MINIFLOW_VALUES_SIZE(miniflow_n_values(src));
2017
2018     dst->map = src->map;
2019     if (size <= sizeof dst->inline_values) {
2020         dst->values_inline = true;
2021         memcpy(dst->inline_values, miniflow_get_values(src), size);
2022         miniflow_destroy(src);
2023     } else if (src->values_inline) {
2024         dst->values_inline = false;
2025         COVERAGE_INC(miniflow_malloc);
2026         dst->offline_values = xmalloc(size);
2027         memcpy(dst->offline_values, src->inline_values, size);
2028     } else {
2029         dst->values_inline = false;
2030         dst->offline_values = src->offline_values;
2031     }
2032 }
2033
2034 /* Frees any memory owned by 'flow'.  Does not free the storage in which 'flow'
2035  * itself resides; the caller is responsible for that. */
2036 void
2037 miniflow_destroy(struct miniflow *flow)
2038 {
2039     if (!flow->values_inline) {
2040         free(flow->offline_values);
2041     }
2042 }
2043
2044 /* Initializes 'dst' as a copy of 'src'. */
2045 void
2046 miniflow_expand(const struct miniflow *src, struct flow *dst)
2047 {
2048     memset(dst, 0, sizeof *dst);
2049     flow_union_with_miniflow(dst, src);
2050 }
2051
2052 /* Returns true if 'a' and 'b' are the equal miniflow, false otherwise. */
2053 bool
2054 miniflow_equal(const struct miniflow *a, const struct miniflow *b)
2055 {
2056     const uint64_t *ap = miniflow_get_values(a);
2057     const uint64_t *bp = miniflow_get_values(b);
2058
2059     if (OVS_LIKELY(a->map == b->map)) {
2060         int count = miniflow_n_values(a);
2061
2062         return !memcmp(ap, bp, count * sizeof *ap);
2063     } else {
2064         uint64_t map;
2065
2066         for (map = a->map | b->map; map; map = zero_rightmost_1bit(map)) {
2067             uint64_t bit = rightmost_1bit(map);
2068
2069             if ((a->map & bit ? *ap++ : 0) != (b->map & bit ? *bp++ : 0)) {
2070                 return false;
2071             }
2072         }
2073     }
2074
2075     return true;
2076 }
2077
2078 /* Returns false if 'a' and 'b' differ at the places where there are 1-bits
2079  * in 'mask', true otherwise. */
2080 bool
2081 miniflow_equal_in_minimask(const struct miniflow *a, const struct miniflow *b,
2082                            const struct minimask *mask)
2083 {
2084     const uint64_t *p = miniflow_get_values(&mask->masks);
2085     int idx;
2086
2087     MAP_FOR_EACH_INDEX(idx, mask->masks.map) {
2088         if ((miniflow_get(a, idx) ^ miniflow_get(b, idx)) & *p++) {
2089             return false;
2090         }
2091     }
2092
2093     return true;
2094 }
2095
2096 /* Returns true if 'a' and 'b' are equal at the places where there are 1-bits
2097  * in 'mask', false if they differ. */
2098 bool
2099 miniflow_equal_flow_in_minimask(const struct miniflow *a, const struct flow *b,
2100                                 const struct minimask *mask)
2101 {
2102     const uint64_t *b_u64 = (const uint64_t *) b;
2103     const uint64_t *p = miniflow_get_values(&mask->masks);
2104     int idx;
2105
2106     MAP_FOR_EACH_INDEX(idx, mask->masks.map) {
2107         if ((miniflow_get(a, idx) ^ b_u64[idx]) & *p++) {
2108             return false;
2109         }
2110     }
2111
2112     return true;
2113 }
2114
2115 \f
2116 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
2117  * with minimask_destroy(). */
2118 void
2119 minimask_init(struct minimask *mask, const struct flow_wildcards *wc)
2120 {
2121     miniflow_init(&mask->masks, &wc->masks);
2122 }
2123
2124 /* Initializes 'dst' as a copy of 'src'.  The caller must eventually free 'dst'
2125  * with minimask_destroy(). */
2126 void
2127 minimask_clone(struct minimask *dst, const struct minimask *src)
2128 {
2129     miniflow_clone(&dst->masks, &src->masks);
2130 }
2131
2132 /* Initializes 'dst' with the data in 'src', destroying 'src'.
2133  * The caller must eventually free 'dst' with minimask_destroy(). */
2134 void
2135 minimask_move(struct minimask *dst, struct minimask *src)
2136 {
2137     miniflow_move(&dst->masks, &src->masks);
2138 }
2139
2140 /* Initializes 'dst_' as the bit-wise "and" of 'a_' and 'b_'.
2141  *
2142  * The caller must provide room for FLOW_U64S "uint64_t"s in 'storage', for use
2143  * by 'dst_'.  The caller must *not* free 'dst_' with minimask_destroy(). */
2144 void
2145 minimask_combine(struct minimask *dst_,
2146                  const struct minimask *a_, const struct minimask *b_,
2147                  uint64_t storage[FLOW_U64S])
2148 {
2149     struct miniflow *dst = &dst_->masks;
2150     uint64_t *dst_values = storage;
2151     const struct miniflow *a = &a_->masks;
2152     const struct miniflow *b = &b_->masks;
2153     int idx;
2154
2155     dst->values_inline = false;
2156     dst->offline_values = storage;
2157
2158     dst->map = 0;
2159     MAP_FOR_EACH_INDEX(idx, a->map & b->map) {
2160         /* Both 'a' and 'b' have non-zero data at 'idx'. */
2161         uint64_t mask = miniflow_get__(a, idx) & miniflow_get__(b, idx);
2162
2163         if (mask) {
2164             dst->map |= UINT64_C(1) << idx;
2165             *dst_values++ = mask;
2166         }
2167     }
2168 }
2169
2170 /* Frees any memory owned by 'mask'.  Does not free the storage in which 'mask'
2171  * itself resides; the caller is responsible for that. */
2172 void
2173 minimask_destroy(struct minimask *mask)
2174 {
2175     miniflow_destroy(&mask->masks);
2176 }
2177
2178 /* Initializes 'dst' as a copy of 'src'. */
2179 void
2180 minimask_expand(const struct minimask *mask, struct flow_wildcards *wc)
2181 {
2182     miniflow_expand(&mask->masks, &wc->masks);
2183 }
2184
2185 /* Returns true if 'a' and 'b' are the same flow mask, false otherwise.
2186  * Minimasks may not have zero data values, so for the minimasks to be the
2187  * same, they need to have the same map and the same data values. */
2188 bool
2189 minimask_equal(const struct minimask *a, const struct minimask *b)
2190 {
2191     return a->masks.map == b->masks.map &&
2192         !memcmp(miniflow_get_values(&a->masks),
2193                 miniflow_get_values(&b->masks),
2194                 count_1bits(a->masks.map) * sizeof *a->masks.inline_values);
2195 }
2196
2197 /* Returns true if at least one bit matched by 'b' is wildcarded by 'a',
2198  * false otherwise. */
2199 bool
2200 minimask_has_extra(const struct minimask *a, const struct minimask *b)
2201 {
2202     const uint64_t *ap = miniflow_get_values(&a->masks);
2203     const uint64_t *bp = miniflow_get_values(&b->masks);
2204     int idx;
2205
2206     MAP_FOR_EACH_INDEX(idx, b->masks.map) {
2207         uint64_t b_u64 = *bp++;
2208
2209         /* 'b_u64' is non-zero, check if the data in 'a' is either zero
2210          * or misses some of the bits in 'b_u64'. */
2211         if (!(a->masks.map & (UINT64_C(1) << idx))
2212             || ((miniflow_values_get__(ap, a->masks.map, idx) & b_u64)
2213                 != b_u64)) {
2214             return true; /* 'a' wildcards some bits 'b' doesn't. */
2215         }
2216     }
2217
2218     return false;
2219 }