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 <map/map_dpo.h>
  24 #include <vnet/dpo/load_balance.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                       u8 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, int 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 } map_main_t;
 325
 326 /*
 327  * MAP Error counters/messages
 328  */
 329 #define foreach_map_error                               \
 330   /* Must be first. */                                  \
 331  _(NONE, "valid MAP packets")                           \
 332  _(BAD_PROTOCOL, "bad protocol")                        \
 333  _(SEC_CHECK, "security check failed")                  \
 334  _(ENCAP_SEC_CHECK, "encap security check failed")      \
 335  _(DECAP_SEC_CHECK, "decap security check failed")      \
 336  _(ICMP, "unable to translate ICMP")                    \
 337  _(ICMP_RELAY, "unable to relay ICMP")                  \
 338  _(UNKNOWN, "unknown")                                  \
 339  _(NO_BINDING, "no binding")                            \
 340  _(NO_DOMAIN, "no domain")                              \
 341  _(FRAGMENTED, "packet is a fragment")                  \
 342  _(FRAGMENT_MEMORY, "could not cache fragment")         \
 343  _(FRAGMENT_MALFORMED, "fragment has unexpected format")\
 344  _(FRAGMENT_DROPPED, "dropped cached fragment")         \
 345  _(MALFORMED, "malformed packet")                       \
 346  _(DF_SET, "can't fragment, DF set")
 347
 348 typedef enum {
 349 #define _(sym,str) MAP_ERROR_##sym,
 350    foreach_map_error
 351 #undef _
 352    MAP_N_ERROR,
 353  } map_error_t;
 354
 355 u64 map_error_counter_get(u32 node_index, map_error_t map_error);
 356
 357 typedef struct {
 358   u32 map_domain_index;
 359   u16 port;
 360 } map_trace_t;
 361
 362 extern map_main_t map_main;
 363
 364 extern vlib_node_registration_t ip4_map_node;
 365 extern vlib_node_registration_t ip6_map_node;
 366
 367 extern vlib_node_registration_t ip4_map_t_node;
 368 extern vlib_node_registration_t ip4_map_t_fragmented_node;
 369 extern vlib_node_registration_t ip4_map_t_tcp_udp_node;
 370 extern vlib_node_registration_t ip4_map_t_icmp_node;
 371
 372 extern vlib_node_registration_t ip6_map_t_node;
 373 extern vlib_node_registration_t ip6_map_t_fragmented_node;
 374 extern vlib_node_registration_t ip6_map_t_tcp_udp_node;
 375 extern vlib_node_registration_t ip6_map_t_icmp_node;
 376
 377 /*
 378  * map_get_pfx
 379  */
 380 static_always_inline u64
 381 map_get_pfx (map_domain_t *d, u32 addr, u16 port)
 382 {
 383   u16 psid = (port >> d->psid_shift) & d->psid_mask;
 384
 385   if (d->ea_bits_len == 0 && d->rules)
 386     return clib_net_to_host_u64(d->rules[psid].as_u64[0]);
 387
 388   u32 suffix = (addr >> d->suffix_shift) & d->suffix_mask;
 389   u64 ea = d->ea_bits_len == 0 ? 0 : (((u64) suffix << d->psid_length)) | psid;
 390
 391   return clib_net_to_host_u64(d->ip6_prefix.as_u64[0]) | ea << d->ea_shift;
 392 }
 393
 394 static_always_inline u64
 395 map_get_pfx_net (map_domain_t *d, u32 addr, u16 port)
 396 {
 397   return clib_host_to_net_u64(map_get_pfx(d, clib_net_to_host_u32(addr),
 398                                           clib_net_to_host_u16(port)));
 399 }
 400
 401 /*
 402  * map_get_sfx
 403  */
 404 static_always_inline u64
 405 map_get_sfx (map_domain_t *d, u32 addr, u16 port)
 406 {
 407   u16 psid = (port >> d->psid_shift) & d->psid_mask;
 408
 409   /* Shared 1:1 mode. */
 410   if (d->ea_bits_len == 0 && d->rules)
 411     return clib_net_to_host_u64(d->rules[psid].as_u64[1]);
 412   if (d->ip6_prefix_len == 128)
 413     return clib_net_to_host_u64(d->ip6_prefix.as_u64[1]);
 414
 415   if (d->flags & MAP_DOMAIN_RFC6052)
 416     return (clib_net_to_host_u64(d->ip6_prefix.as_u64[1]) | addr);
 417
 418   /* IPv4 prefix */
 419   if (d->flags & MAP_DOMAIN_PREFIX)
 420     return (u64) (addr & (0xFFFFFFFF << d->suffix_shift)) << 16;
 421
 422   /* Shared or full IPv4 address */
 423   return ((u64) addr << 16) | psid;
 424 }
 425
 426 static_always_inline u64
 427 map_get_sfx_net (map_domain_t *d, u32 addr, u16 port)
 428 {
 429   return clib_host_to_net_u64(map_get_sfx(d, clib_net_to_host_u32(addr),
 430                                           clib_net_to_host_u16(port)));
 431 }
 432
 433 static_always_inline u32
 434 map_get_ip4 (ip6_address_t *addr, map_domain_flags_e flags)
 435 {
 436   if (flags & MAP_DOMAIN_RFC6052)
 437     return clib_host_to_net_u32(clib_net_to_host_u64(addr->as_u64[1]));
 438   else
 439     return clib_host_to_net_u32(clib_net_to_host_u64(addr->as_u64[1]) >> 16);
 440 }
 441
 442 /*
 443  * Get the MAP domain from an IPv4 lookup adjacency.
 444  */
 445 static_always_inline map_domain_t *
 446 ip4_map_get_domain (u32 mdi)
 447 {
 448   map_main_t *mm = &map_main;
 449
 450   return pool_elt_at_index(mm->domains, mdi);
 451 }
 452
 453 /*
 454  * Get the MAP domain from an IPv6 lookup adjacency.
 455  * If the IPv6 address or prefix is not shared, no lookup is required.
 456  * The IPv4 address is used otherwise.
 457  */
 458 static_always_inline map_domain_t *
 459 ip6_map_get_domain (u32 mdi,
 460                     ip4_address_t *addr,
 461                     u32 *map_domain_index,
 462                     u8 *error)
 463 {
 464   map_main_t *mm = &map_main;
 465
 466 #ifdef TODO
 467   /*
 468    * Disable direct MAP domain lookup on decap, until the security check is updated to verify IPv4 SA.
 469    * (That's done implicitly when MAP domain is looked up in the IPv4 FIB)
 470    */
 471   //#ifdef MAP_NONSHARED_DOMAIN_ENABLED
 472   //#error "How can you be sure this domain is not shared?"
 473 #endif
 474
 475   *map_domain_index = mdi;
 476   return pool_elt_at_index(mm->domains, mdi);
 477
 478 #ifdef TODO
 479   u32 lbi = ip4_fib_forwarding_lookup(0, addr);
 480   const dpo_id_t *dpo = load_balance_get_bucket(lbi, 0);
 481   if (PREDICT_TRUE(dpo->dpoi_type == map_dpo_type ||
 482                    dpo->dpoi_type == map_t_dpo_type))
 483     {
 484       *map_domain_index = dpo->dpoi_index;
 485       return pool_elt_at_index(mm->domains, *map_domain_index);
 486     }
 487   *error = MAP_ERROR_NO_DOMAIN;
 488   return NULL;
 489 #endif
 490 }
 491
 492 map_ip4_reass_t *
 493 map_ip4_reass_get(u32 src, u32 dst, u16 fragment_id,
 494                   u8 protocol, u32 **pi_to_drop);
 495 void
 496 map_ip4_reass_free(map_ip4_reass_t *r, u32 **pi_to_drop);
 497
 498 #define map_ip4_reass_lock() while (clib_atomic_test_and_set (map_main.ip4_reass_lock)) {}
 499 #define map_ip4_reass_unlock() do {CLIB_MEMORY_BARRIER(); *map_main.ip4_reass_lock = 0;} while(0)
 500
 501 static_always_inline void
 502 map_ip4_reass_get_fragments(map_ip4_reass_t *r, u32 **pi)
 503 {
 504   int i;
 505   for (i=0; i<MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
 506     if(r->fragments[i] != ~0) {
 507       vec_add1(*pi, r->fragments[i]);
 508       r->fragments[i] = ~0;
 509       map_main.ip4_reass_buffered_counter--;
 510     }
 511 }
 512
 513 clib_error_t * map_plugin_api_hookup (vlib_main_t * vm);
 514
 515 int map_ip4_reass_add_fragment(map_ip4_reass_t *r, u32 pi);
 516
 517 map_ip6_reass_t *
 518 map_ip6_reass_get(ip6_address_t *src, ip6_address_t *dst, u32 fragment_id,
 519                   u8 protocol, u32 **pi_to_drop);
 520 void
 521 map_ip6_reass_free(map_ip6_reass_t *r, u32 **pi_to_drop);
 522
 523 #define map_ip6_reass_lock() while (clib_atomic_test_and_set (map_main.ip6_reass_lock)) {}
 524 #define map_ip6_reass_unlock() do {CLIB_MEMORY_BARRIER(); *map_main.ip6_reass_lock = 0;} while(0)
 525
 526 int
 527 map_ip6_reass_add_fragment(map_ip6_reass_t *r, u32 pi,
 528                            u16 data_offset, u16 next_data_offset,
 529                            u8 *data_start, u16 data_len);
 530
 531 void map_ip4_drop_pi(u32 pi);
 532
 533 int map_ip4_reass_conf_ht_ratio(f32 ht_ratio, u32 *trashed_reass, u32 *dropped_packets);
 534 #define MAP_IP4_REASS_CONF_HT_RATIO_MAX 100
 535 int map_ip4_reass_conf_pool_size(u16 pool_size, u32 *trashed_reass, u32 *dropped_packets);
 536 #define MAP_IP4_REASS_CONF_POOL_SIZE_MAX (0xfeff)
 537 int map_ip4_reass_conf_lifetime(u16 lifetime_ms);
 538 #define MAP_IP4_REASS_CONF_LIFETIME_MAX 0xffff
 539 int map_ip4_reass_conf_buffers(u32 buffers);
 540 #define MAP_IP4_REASS_CONF_BUFFERS_MAX (0xffffffff)
 541
 542 void map_ip6_drop_pi(u32 pi);
 543
 544
 545 int map_ip6_reass_conf_ht_ratio(f32 ht_ratio, u32 *trashed_reass, u32 *dropped_packets);
 546 #define MAP_IP6_REASS_CONF_HT_RATIO_MAX 100
 547 int map_ip6_reass_conf_pool_size(u16 pool_size, u32 *trashed_reass, u32 *dropped_packets);
 548 #define MAP_IP6_REASS_CONF_POOL_SIZE_MAX (0xfeff)
 549 int map_ip6_reass_conf_lifetime(u16 lifetime_ms);
 550 #define MAP_IP6_REASS_CONF_LIFETIME_MAX 0xffff
 551 int map_ip6_reass_conf_buffers(u32 buffers);
 552 #define MAP_IP6_REASS_CONF_BUFFERS_MAX (0xffffffff)
 553
 554 static_always_inline void
 555 ip4_map_t_embedded_address (map_domain_t *d,
 556                             ip6_address_t *ip6, const ip4_address_t *ip4)
 557 {
 558   ASSERT(d->ip6_src_len == 96 || d->ip6_src_len == 64); //No support for other lengths for now
 559   u8 offset = d->ip6_src_len == 64 ? 9 : 12;
 560   ip6->as_u64[0] = d->ip6_src.as_u64[0];
 561   ip6->as_u64[1] = d->ip6_src.as_u64[1];
 562   clib_memcpy_fast(&ip6->as_u8[offset], ip4, 4);
 563 }
 564
 565 static_always_inline u32
 566 ip6_map_t_embedded_address (map_domain_t *d, ip6_address_t *addr)
 567 {
 568   ASSERT(d->ip6_src_len == 64 || d->ip6_src_len == 96);
 569   u32 x;
 570   u8 offset = d->ip6_src_len == 64 ? 9 : 12;
 571   clib_memcpy(&x, &addr->as_u8[offset], 4);
 572   return x;
 573 }
 574
 575 static inline void
 576 map_domain_counter_lock (map_main_t *mm)
 577 {
 578   if (mm->counter_lock)
 579     while (clib_atomic_test_and_set (mm->counter_lock))
 580       /* zzzz */ ;
 581 }
 582 static inline void
 583 map_domain_counter_unlock (map_main_t *mm)
 584 {
 585   if (mm->counter_lock)
 586     clib_atomic_release (mm->counter_lock);
 587 }
 588
 589
 590 static_always_inline void
 591 map_send_all_to_node(vlib_main_t *vm, u32 *pi_vector,
 592                      vlib_node_runtime_t *node, vlib_error_t *error,
 593                      u32 next)
 594 {
 595   u32 n_left_from, *from, next_index, *to_next, n_left_to_next;
 596   //Deal with fragments that are ready
 597   from = pi_vector;
 598   n_left_from = vec_len(pi_vector);
 599   next_index = node->cached_next_index;
 600   while (n_left_from > 0) {
 601     vlib_get_next_frame(vm, node, next_index, to_next, n_left_to_next);
 602     while (n_left_from > 0 && n_left_to_next > 0) {
 603       u32 pi0 = to_next[0] = from[0];
 604       from += 1;
 605       n_left_from -= 1;
 606       to_next += 1;
 607       n_left_to_next -= 1;
 608       vlib_buffer_t *p0 = vlib_get_buffer(vm, pi0);
 609       p0->error = *error;
 610       vlib_validate_buffer_enqueue_x1(vm, node, next_index, to_next, n_left_to_next, pi0, next);
 611     }
 612     vlib_put_next_frame(vm, node, next_index, n_left_to_next);
 613   }
 614 }
 615
 616 /*
 617  * fd.io coding-style-patch-verification: ON
 618  *
 619  * Local Variables:
 620  * eval: (c-set-style "gnu")
 621  * End:
 622  */