src/plugins/map/map.h

   1 /*
   2  * Copyright (c) 2015 Cisco and/or its affiliates.
   3  * Licensed under the Apache License, Version 2.0 (the "License");
   4  * you may not use this file except in compliance with the License.
   5  * You may obtain a copy of the License at:
   6  *
   7  *     http://www.apache.org/licenses/LICENSE-2.0
   8  *
   9  * Unless required by applicable law or agreed to in writing, software
  10  * distributed under the License is distributed on an "AS IS" BASIS,
  11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  12  * See the License for the specific language governing permissions and
  13  * limitations under the License.
  14  */
  15 #include <stdbool.h>
  16 #include <vppinfra/error.h>
  17 #include <vnet/vnet.h>
  18 #include <vnet/ip/ip.h>
  19 #include <vlib/vlib.h>
  20 #include <vnet/fib/fib_types.h>
  21 #include <vnet/fib/ip4_fib.h>
  22 #include <vnet/adj/adj.h>
  23 #include <vnet/dpo/load_balance.h>
  24 #include "lpm.h"
  25
  26 #define MAP_SKIP_IP6_LOOKUP 1
  27
  28 #define MAP_ERR_GOOD                    0
  29 #define MAP_ERR_BAD_POOL_SIZE           -1
  30 #define MAP_ERR_BAD_HT_RATIO            -2
  31 #define MAP_ERR_BAD_LIFETIME            -3
  32 #define MAP_ERR_BAD_BUFFERS             -4
  33 #define MAP_ERR_BAD_BUFFERS_TOO_LARGE   -5
  34
  35 int map_create_domain (ip4_address_t * ip4_prefix, u8 ip4_prefix_len,
  36                        ip6_address_t * ip6_prefix, u8 ip6_prefix_len,
  37                        ip6_address_t * ip6_src, u8 ip6_src_len,
  38                        u8 ea_bits_len, u8 psid_offset, u8 psid_length,
  39                        u32 * map_domain_index, u16 mtu, u8 flags);
  40 int map_delete_domain (u32 map_domain_index);
  41 int map_add_del_psid (u32 map_domain_index, u16 psid, ip6_address_t * tep,
  42                       bool is_add);
  43 int map_if_enable_disable (bool is_enable, u32 sw_if_index,
  44                            bool is_translation);
  45 u8 *format_map_trace (u8 * s, va_list * args);
  46
  47 int map_param_set_fragmentation (bool inner, bool ignore_df);
  48 int map_param_set_icmp (ip4_address_t * ip4_err_relay_src);
  49 int map_param_set_icmp6 (u8 enable_unreachable);
  50 void map_pre_resolve (ip4_address_t * ip4, ip6_address_t * ip6, bool is_del);
  51 int map_param_set_reassembly (bool is_ipv6, u16 lifetime_ms,
  52                               u16 pool_size, u32 buffers, f64 ht_ratio,
  53                               u32 * reass, u32 * packets);
  54 int map_param_set_security_check (bool enable, bool fragments);
  55 int map_param_set_traffic_class (bool copy, u8 tc);
  56 int map_param_set_tcp (u16 tcp_mss);
  57
  58
  59 typedef enum
  60 {
  61   MAP_DOMAIN_PREFIX = 1 << 0,
  62   MAP_DOMAIN_TRANSLATION = 1 << 1,      // The domain uses MAP-T
  63   MAP_DOMAIN_RFC6052 = 1 << 2,
  64 } __attribute__ ((__packed__)) map_domain_flags_e;
  65
  66 /**
  67  * IP4 reassembly logic:
  68  * One virtually reassembled flow requires a map_ip4_reass_t structure in order
  69  * to keep the first-fragment port number and, optionally, cache out of sequence
  70  * packets.
  71  * There are up to MAP_IP4_REASS_MAX_REASSEMBLY such structures.
  72  * When in use, those structures are stored in a hash table of MAP_IP4_REASS_BUCKETS buckets.
  73  * When a new structure needs to be used, it is allocated from available ones.
  74  * If there is no structure available, the oldest in use is selected and used if and
  75  * only if it was first allocated more than MAP_IP4_REASS_LIFETIME seconds ago.
  76  * In case no structure can be allocated, the fragment is dropped.
  77  */
  78
  79 #define MAP_IP4_REASS_LIFETIME_DEFAULT (100)    /* ms */
  80 #define MAP_IP4_REASS_HT_RATIO_DEFAULT (1.0)
  81 #define MAP_IP4_REASS_POOL_SIZE_DEFAULT 1024    // Number of reassembly structures
  82 #define MAP_IP4_REASS_BUFFERS_DEFAULT 2048
  83
  84 #define MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY 5    // Number of fragment per reassembly
  85
  86 #define MAP_IP6_REASS_LIFETIME_DEFAULT (100)    /* ms */
  87 #define MAP_IP6_REASS_HT_RATIO_DEFAULT (1.0)
  88 #define MAP_IP6_REASS_POOL_SIZE_DEFAULT 1024    // Number of reassembly structures
  89 #define MAP_IP6_REASS_BUFFERS_DEFAULT 2048
  90
  91 #define MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY 5
  92
  93 #define MAP_IP6_REASS_COUNT_BYTES
  94 #define MAP_IP4_REASS_COUNT_BYTES
  95
  96 //#define IP6_MAP_T_OVERRIDE_TOS 0
  97
  98 /*
  99  * This structure _MUST_ be no larger than a single cache line (64 bytes).
 100  * If more space is needed make a union of ip6_prefix and *rules, those are mutually exclusive.
 101  */
 102 typedef struct
 103 {
 104   /* Required for pool_get_aligned */
 105   CLIB_CACHE_LINE_ALIGN_MARK (cacheline0);
 106   ip6_address_t ip6_src;
 107   ip6_address_t ip6_prefix;
 108   ip6_address_t *rules;
 109   u32 suffix_mask;
 110   ip4_address_t ip4_prefix;
 111   u16 psid_mask;
 112   u16 mtu;
 113   map_domain_flags_e flags;
 114   u8 ip6_prefix_len;
 115   u8 ip6_src_len;
 116   u8 ea_bits_len;
 117   u8 psid_offset;
 118   u8 psid_length;
 119
 120   /* helpers */
 121   u8 psid_shift;
 122   u8 suffix_shift;
 123   u8 ea_shift;
 124
 125   /* not used by forwarding */
 126   u8 ip4_prefix_len;
 127 } map_domain_t;
 128
 129 STATIC_ASSERT ((sizeof (map_domain_t) <= CLIB_CACHE_LINE_BYTES),
 130                "MAP domain fits in one cacheline");
 131
 132 #define MAP_REASS_INDEX_NONE ((u16)0xffff)
 133
 134 /*
 135  * Hash key, padded out to 16 bytes for fast compare
 136  */
 137 /* *INDENT-OFF* */
 138 typedef union {
 139   CLIB_PACKED (struct {
 140     ip4_address_t src;
 141     ip4_address_t dst;
 142     u16 fragment_id;
 143     u8 protocol;
 144   });
 145   u64 as_u64[2];
 146   u32 as_u32[4];
 147 } map_ip4_reass_key_t;
 148 /* *INDENT-ON* */
 149
 150 typedef struct
 151 {
 152   map_ip4_reass_key_t key;
 153   f64 ts;
 154 #ifdef MAP_IP4_REASS_COUNT_BYTES
 155   u16 expected_total;
 156   u16 forwarded;
 157 #endif
 158   i32 port;
 159   u16 bucket;
 160   u16 bucket_next;
 161   u16 fifo_prev;
 162   u16 fifo_next;
 163   u32 fragments[MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY];
 164 } map_ip4_reass_t;
 165
 166 /*
 167  * MAP domain counters
 168  */
 169 typedef enum
 170 {
 171   /* Simple counters */
 172   MAP_DOMAIN_IPV4_FRAGMENT = 0,
 173   /* Combined counters */
 174   MAP_DOMAIN_COUNTER_RX = 0,
 175   MAP_DOMAIN_COUNTER_TX,
 176   MAP_N_DOMAIN_COUNTER
 177 } map_domain_counter_t;
 178
 179 /*
 180  * main_main_t
 181  */
 182 /* *INDENT-OFF* */
 183 typedef union {
 184   CLIB_PACKED (struct {
 185     ip6_address_t src;
 186     ip6_address_t dst;
 187     u32 fragment_id;
 188     u8 protocol;
 189   });
 190   u64 as_u64[5];
 191   u32 as_u32[10];
 192 } map_ip6_reass_key_t;
 193 /* *INDENT-OFF* */
 194
 195 typedef struct {
 196   u32 pi; //Cached packet or ~0
 197   u16 next_data_offset; //The data offset of the additional 20 bytes or ~0
 198   u8 next_data_len; //Number of bytes ready to be copied (20 if not last fragment)
 199   u8 next_data[20]; //The 20 additional bytes
 200 } map_ip6_fragment_t;
 201
 202 typedef struct {
 203   map_ip6_reass_key_t key;
 204   f64 ts;
 205 #ifdef MAP_IP6_REASS_COUNT_BYTES
 206   u16 expected_total;
 207   u16 forwarded;
 208 #endif
 209   u16 bucket; //What hash bucket this element is linked in
 210   u16 bucket_next;
 211   u16 fifo_prev;
 212   u16 fifo_next;
 213   ip4_header_t ip4_header;
 214   map_ip6_fragment_t fragments[MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY];
 215 } map_ip6_reass_t;
 216
 217 #ifdef MAP_SKIP_IP6_LOOKUP
 218 /**
 219  * A pre-resolved next-hop
 220  */
 221 typedef struct map_main_pre_resolved_t_
 222 {
 223   /**
 224    * Linkage into the FIB graph
 225    */
 226   fib_node_t node;
 227
 228   /**
 229    * The FIB entry index of the next-hop
 230    */
 231   fib_node_index_t fei;
 232
 233   /**
 234    * This object sibling index on the FIB entry's child dependency list
 235    */
 236   u32 sibling;
 237
 238   /**
 239    * The Load-balance object index to use to forward
 240    */
 241   dpo_id_t dpo;
 242 } map_main_pre_resolved_t;
 243
 244 /**
 245  * Pre-resolved next hops for v4 and v6. Why these are global and not
 246  * per-domain is beyond me.
 247  */
 248 extern map_main_pre_resolved_t pre_resolved[FIB_PROTOCOL_MAX];
 249 #endif
 250
 251 typedef struct {
 252   /* pool of MAP domains */
 253   map_domain_t *domains;
 254
 255   /* MAP Domain packet/byte counters indexed by map domain index */
 256   vlib_simple_counter_main_t *simple_domain_counters;
 257   vlib_combined_counter_main_t *domain_counters;
 258   volatile u32 *counter_lock;
 259
 260   /* API message id base */
 261   u16 msg_id_base;
 262
 263   /* Traffic class: zero, copy (~0) or fixed value */
 264   u8 tc;
 265   bool tc_copy;
 266
 267   bool sec_check;               /* Inbound security check */
 268   bool sec_check_frag;          /* Inbound security check for (subsequent) fragments */
 269   bool icmp6_enabled;           /* Send destination unreachable for security check failure */
 270
 271   u16 tcp_mss;                  /* TCP MSS clamp value */
 272
 273   /* ICMPv6 -> ICMPv4 relay parameters */
 274   ip4_address_t icmp4_src_address;
 275   vlib_simple_counter_main_t icmp_relayed;
 276
 277   /* convenience */
 278   vlib_main_t *vlib_main;
 279   vnet_main_t *vnet_main;
 280
 281   /*
 282    * IPv4 encap and decap reassembly
 283    */
 284   /* Configuration */
 285   f32 ip4_reass_conf_ht_ratio; //Size of ht is 2^ceil(log2(ratio*pool_size))
 286   u16 ip4_reass_conf_pool_size; //Max number of allocated reass structures
 287   u16 ip4_reass_conf_lifetime_ms; //Time a reassembly struct is considered valid in ms
 288   u32 ip4_reass_conf_buffers; //Maximum number of buffers used by ip4 reassembly
 289
 290   /* Runtime */
 291   map_ip4_reass_t *ip4_reass_pool;
 292   u8 ip4_reass_ht_log2len; //Hash table size is 2^log2len
 293   u16 ip4_reass_allocated;
 294   u16 *ip4_reass_hash_table;
 295   u16 ip4_reass_fifo_last;
 296   volatile u32 *ip4_reass_lock;
 297
 298   /* Counters */
 299   u32 ip4_reass_buffered_counter;
 300
 301   bool frag_inner;              /* Inner or outer fragmentation */
 302   bool frag_ignore_df;          /* Fragment (outer) packet even if DF is set */
 303
 304   /*
 305    * IPv6 decap reassembly
 306    */
 307   /* Configuration */
 308   f32 ip6_reass_conf_ht_ratio; //Size of ht is 2^ceil(log2(ratio*pool_size))
 309   u16 ip6_reass_conf_pool_size; //Max number of allocated reass structures
 310   u16 ip6_reass_conf_lifetime_ms; //Time a reassembly struct is considered valid in ms
 311   u32 ip6_reass_conf_buffers; //Maximum number of buffers used by ip6 reassembly
 312
 313   /* Runtime */
 314   map_ip6_reass_t *ip6_reass_pool;
 315   u8 ip6_reass_ht_log2len; //Hash table size is 2^log2len
 316   u16 ip6_reass_allocated;
 317   u16 *ip6_reass_hash_table;
 318   u16 ip6_reass_fifo_last;
 319   volatile u32 *ip6_reass_lock;
 320
 321   /* Counters */
 322   u32 ip6_reass_buffered_counter;
 323
 324   /* Graph node state */
 325   uword *bm_trans_enabled_by_sw_if;
 326   uword *bm_encap_enabled_by_sw_if;
 327
 328   /* Lookup tables */
 329   lpm_t *ip4_prefix_tbl;
 330   lpm_t *ip6_prefix_tbl;
 331   lpm_t *ip6_src_prefix_tbl;
 332 } map_main_t;
 333
 334 /*
 335  * MAP Error counters/messages
 336  */
 337 #define foreach_map_error                               \
 338   /* Must be first. */                                  \
 339  _(NONE, "valid MAP packets")                           \
 340  _(BAD_PROTOCOL, "bad protocol")                        \
 341  _(SEC_CHECK, "security check failed")                  \
 342  _(ENCAP_SEC_CHECK, "encap security check failed")      \
 343  _(DECAP_SEC_CHECK, "decap security check failed")      \
 344  _(ICMP, "unable to translate ICMP")                    \
 345  _(ICMP_RELAY, "unable to relay ICMP")                  \
 346  _(UNKNOWN, "unknown")                                  \
 347  _(NO_BINDING, "no binding")                            \
 348  _(NO_DOMAIN, "no domain")                              \
 349  _(FRAGMENTED, "packet is a fragment")                  \
 350  _(FRAGMENT_MEMORY, "could not cache fragment")         \
 351  _(FRAGMENT_MALFORMED, "fragment has unexpected format")\
 352  _(FRAGMENT_DROPPED, "dropped cached fragment")         \
 353  _(MALFORMED, "malformed packet")                       \
 354  _(DF_SET, "can't fragment, DF set")
 355
 356 typedef enum {
 357 #define _(sym,str) MAP_ERROR_##sym,
 358    foreach_map_error
 359 #undef _
 360    MAP_N_ERROR,
 361  } map_error_t;
 362
 363 u64 map_error_counter_get(u32 node_index, map_error_t map_error);
 364
 365 typedef struct {
 366   u32 map_domain_index;
 367   u16 port;
 368 } map_trace_t;
 369
 370 extern map_main_t map_main;
 371
 372 extern vlib_node_registration_t ip4_map_node;
 373 extern vlib_node_registration_t ip6_map_node;
 374
 375 extern vlib_node_registration_t ip4_map_t_node;
 376 extern vlib_node_registration_t ip4_map_t_fragmented_node;
 377 extern vlib_node_registration_t ip4_map_t_tcp_udp_node;
 378 extern vlib_node_registration_t ip4_map_t_icmp_node;
 379
 380 extern vlib_node_registration_t ip6_map_t_node;
 381 extern vlib_node_registration_t ip6_map_t_fragmented_node;
 382 extern vlib_node_registration_t ip6_map_t_tcp_udp_node;
 383 extern vlib_node_registration_t ip6_map_t_icmp_node;
 384
 385 /*
 386  * map_get_pfx
 387  */
 388 static_always_inline u64
 389 map_get_pfx (map_domain_t *d, u32 addr, u16 port)
 390 {
 391   u16 psid = (port >> d->psid_shift) & d->psid_mask;
 392
 393   if (d->ea_bits_len == 0 && d->rules)
 394     return clib_net_to_host_u64(d->rules[psid].as_u64[0]);
 395
 396   u32 suffix = (addr >> d->suffix_shift) & d->suffix_mask;
 397   u64 ea = d->ea_bits_len == 0 ? 0 : (((u64) suffix << d->psid_length)) | psid;
 398
 399   return clib_net_to_host_u64(d->ip6_prefix.as_u64[0]) | ea << d->ea_shift;
 400 }
 401
 402 static_always_inline u64
 403 map_get_pfx_net (map_domain_t *d, u32 addr, u16 port)
 404 {
 405   return clib_host_to_net_u64(map_get_pfx(d, clib_net_to_host_u32(addr),
 406                                           clib_net_to_host_u16(port)));
 407 }
 408
 409 /*
 410  * map_get_sfx
 411  */
 412 static_always_inline u64
 413 map_get_sfx (map_domain_t *d, u32 addr, u16 port)
 414 {
 415   u16 psid = (port >> d->psid_shift) & d->psid_mask;
 416
 417   /* Shared 1:1 mode. */
 418   if (d->ea_bits_len == 0 && d->rules)
 419     return clib_net_to_host_u64(d->rules[psid].as_u64[1]);
 420   if (d->ip6_prefix_len == 128)
 421     return clib_net_to_host_u64(d->ip6_prefix.as_u64[1]);
 422
 423   if (d->ip6_src_len == 96)
 424     return (clib_net_to_host_u64(d->ip6_prefix.as_u64[1]) | addr);
 425
 426   /* IPv4 prefix */
 427   if (d->flags & MAP_DOMAIN_PREFIX)
 428     return (u64) (addr & (0xFFFFFFFF << d->suffix_shift)) << 16;
 429
 430   /* Shared or full IPv4 address */
 431   return ((u64) addr << 16) | psid;
 432 }
 433
 434 static_always_inline u64
 435 map_get_sfx_net (map_domain_t *d, u32 addr, u16 port)
 436 {
 437   return clib_host_to_net_u64(map_get_sfx(d, clib_net_to_host_u32(addr),
 438                                           clib_net_to_host_u16(port)));
 439 }
 440
 441 static_always_inline u32
 442 map_get_ip4 (ip6_address_t *addr, u16 prefix_len)
 443 {
 444   ASSERT(prefix_len == 64 || prefix_len == 96);
 445   if (prefix_len == 96)
 446     return clib_host_to_net_u32(clib_net_to_host_u64(addr->as_u64[1]));
 447   else
 448     return clib_host_to_net_u32(clib_net_to_host_u64(addr->as_u64[1]) >> 16);
 449 }
 450
 451 static_always_inline map_domain_t *
 452 ip4_map_get_domain (ip4_address_t *addr, u32 *map_domain_index, u8 *error)
 453 {
 454   map_main_t *mm = &map_main;
 455
 456   u32 mdi = mm->ip4_prefix_tbl->lookup(mm->ip4_prefix_tbl, addr, 32);
 457   if (mdi == ~0) {
 458     *error = MAP_ERROR_NO_DOMAIN;
 459     return 0;
 460   }
 461   *map_domain_index = mdi;
 462   return pool_elt_at_index(mm->domains, mdi);
 463 }
 464
 465 /*
 466  * Get the MAP domain from an IPv6 address.
 467  * If the IPv6 address or
 468  * prefix is shared the IPv4 address must be used.
 469  */
 470 static_always_inline map_domain_t *
 471 ip6_map_get_domain (ip6_address_t *addr,
 472                     u32 *map_domain_index,
 473                     u8 *error)
 474 {
 475   map_main_t *mm = &map_main;
 476   u32 mdi = mm->ip6_src_prefix_tbl->lookup(mm->ip6_src_prefix_tbl, addr, 128);
 477   if (mdi == ~0) {
 478     *error = MAP_ERROR_NO_DOMAIN;
 479     return 0;
 480   }
 481
 482   *map_domain_index = mdi;
 483   return pool_elt_at_index(mm->domains, mdi);
 484 }
 485
 486 map_ip4_reass_t *
 487 map_ip4_reass_get(u32 src, u32 dst, u16 fragment_id,
 488                   u8 protocol, u32 **pi_to_drop);
 489 void
 490 map_ip4_reass_free(map_ip4_reass_t *r, u32 **pi_to_drop);
 491
 492 #define map_ip4_reass_lock() while (clib_atomic_test_and_set (map_main.ip4_reass_lock)) {}
 493 #define map_ip4_reass_unlock() do {CLIB_MEMORY_BARRIER(); *map_main.ip4_reass_lock = 0;} while(0)
 494
 495 static_always_inline void
 496 map_ip4_reass_get_fragments(map_ip4_reass_t *r, u32 **pi)
 497 {
 498   int i;
 499   for (i=0; i<MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
 500     if(r->fragments[i] != ~0) {
 501       vec_add1(*pi, r->fragments[i]);
 502       r->fragments[i] = ~0;
 503       map_main.ip4_reass_buffered_counter--;
 504     }
 505 }
 506
 507 clib_error_t * map_plugin_api_hookup (vlib_main_t * vm);
 508
 509 int map_ip4_reass_add_fragment(map_ip4_reass_t *r, u32 pi);
 510
 511 map_ip6_reass_t *
 512 map_ip6_reass_get(ip6_address_t *src, ip6_address_t *dst, u32 fragment_id,
 513                   u8 protocol, u32 **pi_to_drop);
 514 void
 515 map_ip6_reass_free(map_ip6_reass_t *r, u32 **pi_to_drop);
 516
 517 #define map_ip6_reass_lock() while (clib_atomic_test_and_set (map_main.ip6_reass_lock)) {}
 518 #define map_ip6_reass_unlock() do {CLIB_MEMORY_BARRIER(); *map_main.ip6_reass_lock = 0;} while(0)
 519
 520 int
 521 map_ip6_reass_add_fragment(map_ip6_reass_t *r, u32 pi,
 522                            u16 data_offset, u16 next_data_offset,
 523                            u8 *data_start, u16 data_len);
 524
 525 void map_ip4_drop_pi(u32 pi);
 526
 527 int map_ip4_reass_conf_ht_ratio(f32 ht_ratio, u32 *trashed_reass, u32 *dropped_packets);
 528 #define MAP_IP4_REASS_CONF_HT_RATIO_MAX 100
 529 int map_ip4_reass_conf_pool_size(u16 pool_size, u32 *trashed_reass, u32 *dropped_packets);
 530 #define MAP_IP4_REASS_CONF_POOL_SIZE_MAX (0xfeff)
 531 int map_ip4_reass_conf_lifetime(u16 lifetime_ms);
 532 #define MAP_IP4_REASS_CONF_LIFETIME_MAX 0xffff
 533 int map_ip4_reass_conf_buffers(u32 buffers);
 534 #define MAP_IP4_REASS_CONF_BUFFERS_MAX (0xffffffff)
 535
 536 void map_ip6_drop_pi(u32 pi);
 537
 538
 539 int map_ip6_reass_conf_ht_ratio(f32 ht_ratio, u32 *trashed_reass, u32 *dropped_packets);
 540 #define MAP_IP6_REASS_CONF_HT_RATIO_MAX 100
 541 int map_ip6_reass_conf_pool_size(u16 pool_size, u32 *trashed_reass, u32 *dropped_packets);
 542 #define MAP_IP6_REASS_CONF_POOL_SIZE_MAX (0xfeff)
 543 int map_ip6_reass_conf_lifetime(u16 lifetime_ms);
 544 #define MAP_IP6_REASS_CONF_LIFETIME_MAX 0xffff
 545 int map_ip6_reass_conf_buffers(u32 buffers);
 546 #define MAP_IP6_REASS_CONF_BUFFERS_MAX (0xffffffff)
 547
 548 /*
 549  * Supports prefix of 96 or 64 (with u-octet)
 550  */
 551 static_always_inline void
 552 ip4_map_t_embedded_address (map_domain_t *d,
 553                             ip6_address_t *ip6, const ip4_address_t *ip4)
 554 {
 555   ASSERT(d->ip6_src_len == 96 || d->ip6_src_len == 64); //No support for other lengths for now
 556   u8 offset = d->ip6_src_len == 64 ? 9 : 12;
 557   ip6->as_u64[0] = d->ip6_src.as_u64[0];
 558   ip6->as_u64[1] = d->ip6_src.as_u64[1];
 559   clib_memcpy_fast(&ip6->as_u8[offset], ip4, 4);
 560 }
 561
 562 static_always_inline u32
 563 ip6_map_t_embedded_address (map_domain_t *d, ip6_address_t *addr)
 564 {
 565   ASSERT(d->ip6_src_len == 64 || d->ip6_src_len == 96);
 566   u32 x;
 567   u8 offset = d->ip6_src_len == 64 ? 9 : 12;
 568   clib_memcpy(&x, &addr->as_u8[offset], 4);
 569   return x;
 570 }
 571
 572 static inline void
 573 map_domain_counter_lock (map_main_t *mm)
 574 {
 575   if (mm->counter_lock)
 576     while (clib_atomic_test_and_set (mm->counter_lock))
 577       /* zzzz */ ;
 578 }
 579 static inline void
 580 map_domain_counter_unlock (map_main_t *mm)
 581 {
 582   if (mm->counter_lock)
 583     clib_atomic_release (mm->counter_lock);
 584 }
 585
 586
 587 static_always_inline void
 588 map_send_all_to_node(vlib_main_t *vm, u32 *pi_vector,
 589                      vlib_node_runtime_t *node, vlib_error_t *error,
 590                      u32 next)
 591 {
 592   u32 n_left_from, *from, next_index, *to_next, n_left_to_next;
 593   //Deal with fragments that are ready
 594   from = pi_vector;
 595   n_left_from = vec_len(pi_vector);
 596   next_index = node->cached_next_index;
 597   while (n_left_from > 0) {
 598     vlib_get_next_frame(vm, node, next_index, to_next, n_left_to_next);
 599     while (n_left_from > 0 && n_left_to_next > 0) {
 600       u32 pi0 = to_next[0] = from[0];
 601       from += 1;
 602       n_left_from -= 1;
 603       to_next += 1;
 604       n_left_to_next -= 1;
 605       vlib_buffer_t *p0 = vlib_get_buffer(vm, pi0);
 606       p0->error = *error;
 607       vlib_validate_buffer_enqueue_x1(vm, node, next_index, to_next, n_left_to_next, pi0, next);
 608     }
 609     vlib_put_next_frame(vm, node, next_index, n_left_to_next);
 610   }
 611 }
 612
 613 static_always_inline void
 614 map_mss_clamping (tcp_header_t * tcp, ip_csum_t * sum, u16 mss_clamping)
 615 {
 616   u8 *data;
 617   u8 opt_len, opts_len, kind;
 618   u16 mss;
 619   u16 mss_value_net = clib_host_to_net_u16(mss_clamping);
 620
 621   if (!tcp_syn (tcp))
 622     return;
 623
 624   opts_len = (tcp_doff (tcp) << 2) - sizeof (tcp_header_t);
 625   data = (u8 *) (tcp + 1);
 626   for (; opts_len > 0; opts_len -= opt_len, data += opt_len)
 627     {
 628       kind = data[0];
 629
 630       if (kind == TCP_OPTION_EOL)
 631         break;
 632       else if (kind == TCP_OPTION_NOOP)
 633         {
 634           opt_len = 1;
 635           continue;
 636         }
 637       else
 638         {
 639           if (opts_len < 2)
 640             return;
 641           opt_len = data[1];
 642
 643           if (opt_len < 2 || opt_len > opts_len)
 644             return;
 645         }
 646
 647       if (kind == TCP_OPTION_MSS)
 648         {
 649           mss = *(u16 *) (data + 2);
 650           if (clib_net_to_host_u16 (mss) > mss_clamping)
 651             {
 652               *sum =
 653                 ip_csum_update (*sum, mss, mss_value_net, ip4_header_t,
 654                                 length);
 655               clib_memcpy (data + 2, &mss_value_net, 2);
 656             }
 657           return;
 658         }
 659     }
 660 }
 661
 662 /*
 663  * fd.io coding-style-patch-verification: ON
 664  *
 665  * Local Variables:
 666  * eval: (c-set-style "gnu")
 667  * End:
 668  */