4 * Copyright (c) 2015 Cisco and/or its affiliates.
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at:
9 * http://www.apache.org/licenses/LICENSE-2.0
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
21 #include <vppinfra/xxhash.h>
24 crc_u32 (u32 data, u32 value)
26 u64 tmp = ((u64) data << 32) | (u64) value;
27 return (u32) clib_xxhash (tmp);
32 * This code supports the following MAP modes:
34 * Algorithmic Shared IPv4 address (ea_bits_len > 0):
35 * ea_bits_len + ip4_prefix > 32
36 * psid_length > 0, ip6_prefix < 64, ip4_prefix <= 32
37 * Algorithmic Full IPv4 address (ea_bits_len > 0):
38 * ea_bits_len + ip4_prefix = 32
39 * psid_length = 0, ip6_prefix < 64, ip4_prefix <= 32
40 * Algorithmic IPv4 prefix (ea_bits_len > 0):
41 * ea_bits_len + ip4_prefix < 32
42 * psid_length = 0, ip6_prefix < 64, ip4_prefix <= 32
44 * Independent Shared IPv4 address (ea_bits_len = 0):
47 * Rule IPv6 address = 128, Rule PSID Set
48 * Independent Full IPv4 address (ea_bits_len = 0):
50 * psid_length = 0, ip6_prefix = 128
51 * Independent IPv4 prefix (ea_bits_len = 0):
53 * psid_length = 0, ip6_prefix = 128
58 * This code supports MAP-T:
60 * With DMR prefix length equal to 96.
66 ip4_get_port (ip4_header_t * ip, map_dir_e dir, u16 buffer_len)
68 //TODO: use buffer length
69 if (ip->ip_version_and_header_length != 0x45 ||
70 ip4_get_fragment_offset (ip))
73 if (PREDICT_TRUE ((ip->protocol == IP_PROTOCOL_TCP) ||
74 (ip->protocol == IP_PROTOCOL_UDP)))
76 udp_header_t *udp = (void *) (ip + 1);
77 return (dir == MAP_SENDER) ? udp->src_port : udp->dst_port;
79 else if (ip->protocol == IP_PROTOCOL_ICMP)
81 icmp46_header_t *icmp = (void *) (ip + 1);
82 if (icmp->type == ICMP4_echo_request || icmp->type == ICMP4_echo_reply)
84 return *((u16 *) (icmp + 1));
86 else if (clib_net_to_host_u16 (ip->length) >= 64)
88 ip = (ip4_header_t *) (icmp + 2);
89 if (PREDICT_TRUE ((ip->protocol == IP_PROTOCOL_TCP) ||
90 (ip->protocol == IP_PROTOCOL_UDP)))
92 udp_header_t *udp = (void *) (ip + 1);
93 return (dir == MAP_SENDER) ? udp->dst_port : udp->src_port;
95 else if (ip->protocol == IP_PROTOCOL_ICMP)
97 icmp46_header_t *icmp = (void *) (ip + 1);
98 if (icmp->type == ICMP4_echo_request ||
99 icmp->type == ICMP4_echo_reply)
101 return *((u16 *) (icmp + 1));
110 ip6_get_port (ip6_header_t * ip6, map_dir_e dir, u16 buffer_len)
117 if (ip6_parse (ip6, buffer_len, &l4_protocol, &l4_offset, &frag_offset))
120 //TODO: Use buffer length
123 ip6_frag_hdr_offset (((ip6_frag_hdr_t *)
124 u8_ptr_add (ip6, frag_offset))))
125 return -1; //Can't deal with non-first fragment for now
127 l4 = u8_ptr_add (ip6, l4_offset);
128 if (l4_protocol == IP_PROTOCOL_TCP || l4_protocol == IP_PROTOCOL_UDP)
131 MAP_SENDER) ? ((udp_header_t *) (l4))->
132 src_port : ((udp_header_t *) (l4))->dst_port;
134 else if (l4_protocol == IP_PROTOCOL_ICMP6)
136 icmp46_header_t *icmp = (icmp46_header_t *) (l4);
137 if (icmp->type == ICMP6_echo_request)
139 return (dir == MAP_SENDER) ? ((u16 *) (icmp))[2] : -1;
141 else if (icmp->type == ICMP6_echo_reply)
143 return (dir == MAP_SENDER) ? -1 : ((u16 *) (icmp))[2];
151 map_create_domain (ip4_address_t * ip4_prefix,
153 ip6_address_t * ip6_prefix,
155 ip6_address_t * ip6_src,
159 u8 psid_length, u32 * map_domain_index, u16 mtu, u8 flags)
161 map_main_t *mm = &map_main;
162 ip4_main_t *im4 = &ip4_main;
163 ip6_main_t *im6 = &ip6_main;
166 ip4_add_del_route_args_t args4;
167 ip6_add_del_route_args_t args6;
171 /* EA bits must be within the first 64 bits */
172 if (ea_bits_len > 0 && (ip6_prefix_len + ea_bits_len) > 64)
175 /* Sanity check on the src prefix length */
176 if (flags & MAP_DOMAIN_TRANSLATION)
178 if (ip6_src_len != 96)
180 clib_warning ("MAP-T only supports ip6_src_len = 96 for now.");
186 if (ip6_src_len != 128)
189 ("MAP-E requires a BR address, not a prefix (ip6_src_len should be 128).");
194 /* Get domain index */
195 pool_get_aligned (mm->domains, d, CLIB_CACHE_LINE_BYTES);
196 memset (d, 0, sizeof (*d));
197 *map_domain_index = d - mm->domains;
199 /* Init domain struct */
200 d->ip4_prefix.as_u32 = ip4_prefix->as_u32;
201 d->ip4_prefix_len = ip4_prefix_len;
202 d->ip6_prefix = *ip6_prefix;
203 d->ip6_prefix_len = ip6_prefix_len;
204 d->ip6_src = *ip6_src;
205 d->ip6_src_len = ip6_src_len;
206 d->ea_bits_len = ea_bits_len;
207 d->psid_offset = psid_offset;
208 d->psid_length = psid_length;
212 /* How many, and which bits to grab from the IPv4 DA */
213 if (ip4_prefix_len + ea_bits_len < 32)
215 d->flags |= MAP_DOMAIN_PREFIX;
216 suffix_len = d->suffix_shift = 32 - ip4_prefix_len - ea_bits_len;
221 suffix_len = 32 - ip4_prefix_len;
223 d->suffix_mask = (1 << suffix_len) - 1;
225 d->psid_shift = 16 - psid_length - psid_offset;
226 d->psid_mask = (1 << d->psid_length) - 1;
227 d->ea_shift = 64 - ip6_prefix_len - suffix_len - d->psid_length;
229 /* Init IP adjacency */
230 memset (&adj, 0, sizeof (adj));
231 adj.explicit_fib_index = ~0;
232 adj.lookup_next_index =
234 flags & MAP_DOMAIN_TRANSLATION) ? IP_LOOKUP_NEXT_MAP_T :
236 p = (uword *) & adj.rewrite_data[0];
237 *p = (uword) (*map_domain_index);
239 if (ip4_get_route (im4, 0, 0, (u8 *) ip4_prefix, ip4_prefix_len))
241 clib_warning ("IPv4 route already defined: %U/%d", format_ip4_address,
242 ip4_prefix, ip4_prefix_len);
243 pool_put (mm->domains, d);
247 /* Create ip4 adjacency */
248 memset (&args4, 0, sizeof (args4));
249 args4.table_index_or_table_id = 0;
250 args4.flags = IP4_ROUTE_FLAG_ADD;
251 args4.dst_address.as_u32 = ip4_prefix->as_u32;
252 args4.dst_address_length = ip4_prefix_len;
254 args4.adj_index = ~0;
255 args4.add_adj = &adj;
257 ip4_add_del_route (im4, &args4);
259 /* Multiple MAP domains may share same source IPv6 TEP */
260 u32 ai = ip6_get_route (im6, 0, 0, ip6_src, ip6_src_len);
263 ip_lookup_main_t *lm6 = &ip6_main.lookup_main;
264 ip_adjacency_t *adj6 = ip_get_adjacency (lm6, ai);
265 if (adj6->lookup_next_index != IP_LOOKUP_NEXT_MAP &&
266 adj6->lookup_next_index != IP_LOOKUP_NEXT_MAP_T)
268 clib_warning ("BR source address already assigned: %U",
269 format_ip6_address, ip6_src);
270 pool_put (mm->domains, d);
274 p = (uword *) & adj6->rewrite_data[0];
277 /* Add refcount, so we don't accidentially delete the route underneath someone */
282 /* Create ip6 adjacency. */
283 memset (&args6, 0, sizeof (args6));
284 args6.table_index_or_table_id = 0;
285 args6.flags = IP6_ROUTE_FLAG_ADD;
286 args6.dst_address.as_u64[0] = ip6_src->as_u64[0];
287 args6.dst_address.as_u64[1] = ip6_src->as_u64[1];
288 args6.dst_address_length = ip6_src_len;
289 args6.adj_index = ~0;
290 args6.add_adj = &adj;
292 ip6_add_del_route (im6, &args6);
295 /* Validate packet/byte counters */
296 map_domain_counter_lock (mm);
298 for (i = 0; i < vec_len (mm->simple_domain_counters); i++)
300 vlib_validate_simple_counter (&mm->simple_domain_counters[i],
302 vlib_zero_simple_counter (&mm->simple_domain_counters[i],
305 for (i = 0; i < vec_len (mm->domain_counters); i++)
307 vlib_validate_combined_counter (&mm->domain_counters[i],
309 vlib_zero_combined_counter (&mm->domain_counters[i], *map_domain_index);
311 map_domain_counter_unlock (mm);
320 map_delete_domain (u32 map_domain_index)
322 map_main_t *mm = &map_main;
323 ip4_main_t *im4 = &ip4_main;
324 ip6_main_t *im6 = &ip6_main;
327 ip4_add_del_route_args_t args4;
328 ip6_add_del_route_args_t args6;
330 if (pool_is_free_index (mm->domains, map_domain_index))
332 clib_warning ("MAP domain delete: domain does not exist: %d",
337 d = pool_elt_at_index (mm->domains, map_domain_index);
339 memset (&adj, 0, sizeof (adj));
340 adj.explicit_fib_index = ~0;
341 adj.lookup_next_index =
343 flags & MAP_DOMAIN_TRANSLATION) ? IP_LOOKUP_NEXT_MAP_T :
346 /* Delete ip4 adjacency */
347 memset (&args4, 0, sizeof (args4));
348 args4.table_index_or_table_id = 0;
349 args4.flags = IP4_ROUTE_FLAG_DEL;
350 args4.dst_address.as_u32 = d->ip4_prefix.as_u32;
351 args4.dst_address_length = d->ip4_prefix_len;
353 args4.add_adj = &adj;
355 ip4_add_del_route (im4, &args4);
357 /* Delete ip6 adjacency */
358 u32 ai = ip6_get_route (im6, 0, 0, &d->ip6_src, d->ip6_src_len);
361 ip_lookup_main_t *lm6 = &ip6_main.lookup_main;
362 ip_adjacency_t *adj6 = ip_get_adjacency (lm6, ai);
364 uword *p = (uword *) & adj6->rewrite_data[0];
365 /* Delete route when no other domains use this source */
368 memset (&args6, 0, sizeof (args6));
369 args6.table_index_or_table_id = 0;
370 args6.flags = IP6_ROUTE_FLAG_DEL;
371 args6.dst_address.as_u64[0] = d->ip6_src.as_u64[0];
372 args6.dst_address.as_u64[1] = d->ip6_src.as_u64[1];
373 args6.dst_address_length = d->ip6_src_len;
375 args6.add_adj = &adj;
377 ip6_add_del_route (im6, &args6);
383 clib_mem_free (d->rules);
385 pool_put (mm->domains, d);
391 map_add_del_psid (u32 map_domain_index, u16 psid, ip6_address_t * tep,
395 map_main_t *mm = &map_main;
397 if (pool_is_free_index (mm->domains, map_domain_index))
399 clib_warning ("MAP rule: domain does not exist: %d", map_domain_index);
402 d = pool_elt_at_index (mm->domains, map_domain_index);
404 /* Rules are only used in 1:1 independent case */
405 if (d->ea_bits_len > 0)
410 u32 l = (0x1 << d->psid_length) * sizeof (ip6_address_t);
411 d->rules = clib_mem_alloc_aligned (l, CLIB_CACHE_LINE_BYTES);
414 memset (d->rules, 0, l);
417 if (psid >= (0x1 << d->psid_length))
419 clib_warning ("MAP rule: PSID outside bounds: %d [%d]", psid,
420 0x1 << d->psid_length);
426 d->rules[psid] = *tep;
430 memset (&d->rules[psid], 0, sizeof (ip6_address_t));
435 #ifdef MAP_SKIP_IP6_LOOKUP
437 map_pre_resolve (ip4_address_t * ip4, ip6_address_t * ip6)
439 map_main_t *mm = &map_main;
440 ip4_main_t *im4 = &ip4_main;
441 ip6_main_t *im6 = &ip6_main;
443 if (ip6->as_u64[0] != 0 || ip6->as_u64[1] != 0)
445 mm->adj6_index = ip6_fib_lookup_with_table (im6, 0, ip6);
446 clib_warning ("FIB lookup results in: %u", mm->adj6_index);
448 if (ip4->as_u32 != 0)
450 mm->adj4_index = ip4_fib_lookup_with_table (im4, 0, ip4, 0);
451 clib_warning ("FIB lookup results in: %u", mm->adj4_index);
456 static clib_error_t *
457 map_security_check_command_fn (vlib_main_t * vm,
458 unformat_input_t * input,
459 vlib_cli_command_t * cmd)
461 unformat_input_t _line_input, *line_input = &_line_input;
462 map_main_t *mm = &map_main;
463 /* Get a line of input. */
464 if (!unformat_user (input, unformat_line_input, line_input))
467 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
469 if (unformat (line_input, "off"))
470 mm->sec_check = false;
471 else if (unformat (line_input, "on"))
472 mm->sec_check = true;
474 return clib_error_return (0, "unknown input `%U'",
475 format_unformat_error, input);
477 unformat_free (line_input);
481 static clib_error_t *
482 map_security_check_frag_command_fn (vlib_main_t * vm,
483 unformat_input_t * input,
484 vlib_cli_command_t * cmd)
486 unformat_input_t _line_input, *line_input = &_line_input;
487 map_main_t *mm = &map_main;
488 /* Get a line of input. */
489 if (!unformat_user (input, unformat_line_input, line_input))
492 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
494 if (unformat (line_input, "off"))
495 mm->sec_check_frag = false;
496 else if (unformat (line_input, "on"))
497 mm->sec_check_frag = true;
499 return clib_error_return (0, "unknown input `%U'",
500 format_unformat_error, input);
502 unformat_free (line_input);
506 static clib_error_t *
507 map_add_domain_command_fn (vlib_main_t * vm,
508 unformat_input_t * input, vlib_cli_command_t * cmd)
510 unformat_input_t _line_input, *line_input = &_line_input;
511 ip4_address_t ip4_prefix;
512 ip6_address_t ip6_prefix;
513 ip6_address_t ip6_src;
514 u32 ip6_prefix_len = 0, ip4_prefix_len = 0, map_domain_index, ip6_src_len;
516 /* Optional arguments */
517 u32 ea_bits_len = 0, psid_offset = 0, psid_length = 0;
522 /* Get a line of input. */
523 if (!unformat_user (input, unformat_line_input, line_input))
526 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
529 (line_input, "ip4-pfx %U/%d", unformat_ip4_address, &ip4_prefix,
534 (line_input, "ip6-pfx %U/%d", unformat_ip6_address, &ip6_prefix,
539 (line_input, "ip6-src %U/%d", unformat_ip6_address, &ip6_src,
544 (line_input, "ip6-src %U", unformat_ip6_address, &ip6_src))
546 else if (unformat (line_input, "ea-bits-len %d", &ea_bits_len))
548 else if (unformat (line_input, "psid-offset %d", &psid_offset))
550 else if (unformat (line_input, "psid-len %d", &psid_length))
552 else if (unformat (line_input, "mtu %d", &mtu))
554 else if (unformat (line_input, "map-t"))
555 flags |= MAP_DOMAIN_TRANSLATION;
557 return clib_error_return (0, "unknown input `%U'",
558 format_unformat_error, input);
560 unformat_free (line_input);
563 return clib_error_return (0, "mandatory argument(s) missing");
565 map_create_domain (&ip4_prefix, ip4_prefix_len,
566 &ip6_prefix, ip6_prefix_len, &ip6_src, ip6_src_len,
567 ea_bits_len, psid_offset, psid_length, &map_domain_index,
573 static clib_error_t *
574 map_del_domain_command_fn (vlib_main_t * vm,
575 unformat_input_t * input, vlib_cli_command_t * cmd)
577 unformat_input_t _line_input, *line_input = &_line_input;
579 u32 map_domain_index;
581 /* Get a line of input. */
582 if (!unformat_user (input, unformat_line_input, line_input))
585 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
587 if (unformat (line_input, "index %d", &map_domain_index))
590 return clib_error_return (0, "unknown input `%U'",
591 format_unformat_error, input);
593 unformat_free (line_input);
596 return clib_error_return (0, "mandatory argument(s) missing");
598 map_delete_domain (map_domain_index);
603 static clib_error_t *
604 map_add_rule_command_fn (vlib_main_t * vm,
605 unformat_input_t * input, vlib_cli_command_t * cmd)
607 unformat_input_t _line_input, *line_input = &_line_input;
610 u32 psid = 0, map_domain_index;
612 /* Get a line of input. */
613 if (!unformat_user (input, unformat_line_input, line_input))
616 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
618 if (unformat (line_input, "index %d", &map_domain_index))
620 else if (unformat (line_input, "psid %d", &psid))
623 if (unformat (line_input, "ip6-dst %U", unformat_ip6_address, &tep))
626 return clib_error_return (0, "unknown input `%U'",
627 format_unformat_error, input);
629 unformat_free (line_input);
632 return clib_error_return (0, "mandatory argument(s) missing");
634 if (map_add_del_psid (map_domain_index, psid, &tep, 1) != 0)
636 return clib_error_return (0, "Failing to add Mapping Rule");
641 #if MAP_SKIP_IP6_LOOKUP
642 static clib_error_t *
643 map_pre_resolve_command_fn (vlib_main_t * vm,
644 unformat_input_t * input,
645 vlib_cli_command_t * cmd)
647 unformat_input_t _line_input, *line_input = &_line_input;
650 map_main_t *mm = &map_main;
652 memset (&ip4nh, 0, sizeof (ip4nh));
653 memset (&ip6nh, 0, sizeof (ip6nh));
655 /* Get a line of input. */
656 if (!unformat_user (input, unformat_line_input, line_input))
659 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
661 if (unformat (line_input, "ip4-nh %U", unformat_ip4_address, &ip4nh))
662 mm->preresolve_ip4 = ip4nh;
664 if (unformat (line_input, "ip6-nh %U", unformat_ip6_address, &ip6nh))
665 mm->preresolve_ip6 = ip6nh;
667 return clib_error_return (0, "unknown input `%U'",
668 format_unformat_error, input);
670 unformat_free (line_input);
672 map_pre_resolve (&ip4nh, &ip6nh);
678 static clib_error_t *
679 map_icmp_relay_source_address_command_fn (vlib_main_t * vm,
680 unformat_input_t * input,
681 vlib_cli_command_t * cmd)
683 unformat_input_t _line_input, *line_input = &_line_input;
684 ip4_address_t icmp_src_address;
685 map_main_t *mm = &map_main;
687 mm->icmp4_src_address.as_u32 = 0;
689 /* Get a line of input. */
690 if (!unformat_user (input, unformat_line_input, line_input))
693 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
696 (line_input, "%U", unformat_ip4_address, &icmp_src_address))
697 mm->icmp4_src_address = icmp_src_address;
699 return clib_error_return (0, "unknown input `%U'",
700 format_unformat_error, input);
702 unformat_free (line_input);
707 static clib_error_t *
708 map_icmp_unreachables_command_fn (vlib_main_t * vm,
709 unformat_input_t * input,
710 vlib_cli_command_t * cmd)
712 unformat_input_t _line_input, *line_input = &_line_input;
713 map_main_t *mm = &map_main;
716 /* Get a line of input. */
717 if (!unformat_user (input, unformat_line_input, line_input))
720 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
723 if (unformat (line_input, "on"))
724 mm->icmp6_enabled = true;
725 else if (unformat (line_input, "off"))
726 mm->icmp6_enabled = false;
728 return clib_error_return (0, "unknown input `%U'",
729 format_unformat_error, input);
731 unformat_free (line_input);
735 return clib_error_return (0, "mandatory argument(s) missing");
740 static clib_error_t *
741 map_fragment_command_fn (vlib_main_t * vm,
742 unformat_input_t * input, vlib_cli_command_t * cmd)
744 unformat_input_t _line_input, *line_input = &_line_input;
745 map_main_t *mm = &map_main;
747 /* Get a line of input. */
748 if (!unformat_user (input, unformat_line_input, line_input))
751 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
753 if (unformat (line_input, "inner"))
754 mm->frag_inner = true;
755 else if (unformat (line_input, "outer"))
756 mm->frag_inner = false;
758 return clib_error_return (0, "unknown input `%U'",
759 format_unformat_error, input);
761 unformat_free (line_input);
766 static clib_error_t *
767 map_fragment_df_command_fn (vlib_main_t * vm,
768 unformat_input_t * input,
769 vlib_cli_command_t * cmd)
771 unformat_input_t _line_input, *line_input = &_line_input;
772 map_main_t *mm = &map_main;
774 /* Get a line of input. */
775 if (!unformat_user (input, unformat_line_input, line_input))
778 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
780 if (unformat (line_input, "on"))
781 mm->frag_ignore_df = true;
782 else if (unformat (line_input, "off"))
783 mm->frag_ignore_df = false;
785 return clib_error_return (0, "unknown input `%U'",
786 format_unformat_error, input);
788 unformat_free (line_input);
793 static clib_error_t *
794 map_traffic_class_command_fn (vlib_main_t * vm,
795 unformat_input_t * input,
796 vlib_cli_command_t * cmd)
798 unformat_input_t _line_input, *line_input = &_line_input;
799 map_main_t *mm = &map_main;
804 /* Get a line of input. */
805 if (!unformat_user (input, unformat_line_input, line_input))
808 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
810 if (unformat (line_input, "copy"))
812 else if (unformat (line_input, "%x", &tc))
815 return clib_error_return (0, "unknown input `%U'",
816 format_unformat_error, input);
818 unformat_free (line_input);
824 format_map_domain (u8 * s, va_list * args)
826 map_domain_t *d = va_arg (*args, map_domain_t *);
827 bool counters = va_arg (*args, int);
828 map_main_t *mm = &map_main;
829 ip6_address_t ip6_prefix;
832 memset (&ip6_prefix, 0, sizeof (ip6_prefix));
834 ip6_prefix = d->ip6_prefix;
837 "[%d] ip4-pfx %U/%d ip6-pfx %U/%d ip6-src %U/%d ea_bits_len %d psid-offset %d psid-len %d mtu %d %s",
839 format_ip4_address, &d->ip4_prefix, d->ip4_prefix_len,
840 format_ip6_address, &ip6_prefix, d->ip6_prefix_len,
841 format_ip6_address, &d->ip6_src, d->ip6_src_len,
842 d->ea_bits_len, d->psid_offset, d->psid_length, d->mtu,
843 (d->flags & MAP_DOMAIN_TRANSLATION) ? "map-t" : "");
847 map_domain_counter_lock (mm);
849 vlib_get_combined_counter (&mm->domain_counters[MAP_DOMAIN_COUNTER_TX],
850 d - mm->domains, &v);
851 s = format (s, " TX: %lld/%lld", v.packets, v.bytes);
852 vlib_get_combined_counter (&mm->domain_counters[MAP_DOMAIN_COUNTER_RX],
853 d - mm->domains, &v);
854 s = format (s, " RX: %lld/%lld", v.packets, v.bytes);
855 map_domain_counter_unlock (mm);
857 s = format (s, "\n");
863 for (i = 0; i < (0x1 << d->psid_length); i++)
866 if (dst.as_u64[0] == 0 && dst.as_u64[1] == 0)
869 " rule psid: %d ip6-dst %U\n", i, format_ip6_address,
877 format_map_ip4_reass (u8 * s, va_list * args)
879 map_main_t *mm = &map_main;
880 map_ip4_reass_t *r = va_arg (*args, map_ip4_reass_t *);
881 map_ip4_reass_key_t *k = &r->key;
882 f64 now = vlib_time_now (mm->vlib_main);
883 f64 lifetime = (((f64) mm->ip4_reass_conf_lifetime_ms) / 1000);
884 f64 dt = (r->ts + lifetime > now) ? (r->ts + lifetime - now) : -1;
886 "ip4-reass src=%U dst=%U protocol=%d identifier=%d port=%d lifetime=%.3lf\n",
887 format_ip4_address, &k->src.as_u8, format_ip4_address,
888 &k->dst.as_u8, k->protocol,
889 clib_net_to_host_u16 (k->fragment_id),
890 (r->port >= 0) ? clib_net_to_host_u16 (r->port) : -1, dt);
895 format_map_ip6_reass (u8 * s, va_list * args)
897 map_main_t *mm = &map_main;
898 map_ip6_reass_t *r = va_arg (*args, map_ip6_reass_t *);
899 map_ip6_reass_key_t *k = &r->key;
900 f64 now = vlib_time_now (mm->vlib_main);
901 f64 lifetime = (((f64) mm->ip6_reass_conf_lifetime_ms) / 1000);
902 f64 dt = (r->ts + lifetime > now) ? (r->ts + lifetime - now) : -1;
904 "ip6-reass src=%U dst=%U protocol=%d identifier=%d lifetime=%.3lf\n",
905 format_ip6_address, &k->src.as_u8, format_ip6_address,
906 &k->dst.as_u8, k->protocol,
907 clib_net_to_host_u32 (k->fragment_id), dt);
911 static clib_error_t *
912 show_map_domain_command_fn (vlib_main_t * vm, unformat_input_t * input,
913 vlib_cli_command_t * cmd)
915 unformat_input_t _line_input, *line_input = &_line_input;
916 map_main_t *mm = &map_main;
918 bool counters = false;
919 u32 map_domain_index = ~0;
921 /* Get a line of input. */
922 if (!unformat_user (input, unformat_line_input, line_input))
925 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
927 if (unformat (line_input, "counters"))
929 else if (unformat (line_input, "index %d", &map_domain_index))
932 return clib_error_return (0, "unknown input `%U'",
933 format_unformat_error, input);
935 unformat_free (line_input);
937 if (pool_elts (mm->domains) == 0)
938 vlib_cli_output (vm, "No MAP domains are configured...");
940 if (map_domain_index == ~0)
943 pool_foreach(d, mm->domains, ({vlib_cli_output(vm, "%U", format_map_domain, d, counters);}));
948 if (pool_is_free_index (mm->domains, map_domain_index))
950 return clib_error_return (0, "MAP domain does not exists %d",
954 d = pool_elt_at_index (mm->domains, map_domain_index);
955 vlib_cli_output (vm, "%U", format_map_domain, d, counters);
961 static clib_error_t *
962 show_map_fragments_command_fn (vlib_main_t * vm, unformat_input_t * input,
963 vlib_cli_command_t * cmd)
965 map_main_t *mm = &map_main;
970 pool_foreach(f4, mm->ip4_reass_pool, ({vlib_cli_output (vm, "%U", format_map_ip4_reass, f4);}));
973 pool_foreach(f6, mm->ip6_reass_pool, ({vlib_cli_output (vm, "%U", format_map_ip6_reass, f6);}));
979 map_error_counter_get (u32 node_index, map_error_t map_error)
981 vlib_main_t *vm = vlib_get_main ();
982 vlib_node_runtime_t *error_node = vlib_node_get_runtime (vm, node_index);
983 vlib_error_main_t *em = &vm->error_main;
984 vlib_error_t e = error_node->errors[map_error];
985 vlib_node_t *n = vlib_get_node (vm, node_index);
988 ci = vlib_error_get_code (e);
989 ASSERT (ci < n->n_errors);
990 ci += n->error_heap_index;
992 return (em->counters[ci]);
995 static clib_error_t *
996 show_map_stats_command_fn (vlib_main_t * vm, unformat_input_t * input,
997 vlib_cli_command_t * cmd)
999 map_main_t *mm = &map_main;
1001 int domains = 0, rules = 0, domaincount = 0, rulecount = 0;
1002 if (pool_elts (mm->domains) == 0)
1003 vlib_cli_output (vm, "No MAP domains are configured...");
1006 pool_foreach(d, mm->domains, ({
1008 rulecount+= 0x1 << d->psid_length;
1009 rules += sizeof(ip6_address_t) * 0x1 << d->psid_length;
1011 domains += sizeof(*d);
1016 vlib_cli_output (vm, "MAP domains structure: %d\n", sizeof (map_domain_t));
1017 vlib_cli_output (vm, "MAP domains: %d (%d bytes)\n", domaincount, domains);
1018 vlib_cli_output (vm, "MAP rules: %d (%d bytes)\n", rulecount, rules);
1019 vlib_cli_output (vm, "Total: %d bytes)\n", rules + domains);
1021 #if MAP_SKIP_IP6_LOOKUP
1022 vlib_cli_output (vm,
1023 "MAP pre-resolve: IP6 next-hop: %U (%u), IP4 next-hop: %U (%u)\n",
1024 format_ip6_address, &mm->preresolve_ip6, mm->adj6_index,
1025 format_ip4_address, &mm->preresolve_ip4, mm->adj4_index);
1029 vlib_cli_output (vm, "MAP traffic-class: copy");
1031 vlib_cli_output (vm, "MAP traffic-class: %x", mm->tc);
1033 vlib_cli_output (vm,
1034 "MAP IPv6 inbound security check: %s, fragmented packet security check: %s",
1035 mm->sec_check ? "enabled" : "disabled",
1036 mm->sec_check_frag ? "enabled" : "disabled");
1038 vlib_cli_output (vm, "ICMP-relay IPv4 source address: %U\n",
1039 format_ip4_address, &mm->icmp4_src_address);
1040 vlib_cli_output (vm, "ICMP6 unreachables sent for unmatched packets: %s\n",
1041 mm->icmp6_enabled ? "enabled" : "disabled");
1042 vlib_cli_output (vm, "Inner fragmentation: %s\n",
1043 mm->frag_inner ? "enabled" : "disabled");
1044 vlib_cli_output (vm, "Fragment packets regardless of DF flag: %s\n",
1045 mm->frag_ignore_df ? "enabled" : "disabled");
1050 vlib_combined_counter_main_t *cm = mm->domain_counters;
1051 u64 total_pkts[MAP_N_DOMAIN_COUNTER];
1052 u64 total_bytes[MAP_N_DOMAIN_COUNTER];
1056 memset (total_pkts, 0, sizeof (total_pkts));
1057 memset (total_bytes, 0, sizeof (total_bytes));
1059 map_domain_counter_lock (mm);
1060 vec_foreach (cm, mm->domain_counters)
1062 which = cm - mm->domain_counters;
1064 for (i = 0; i < vec_len (cm->maxi); i++)
1066 vlib_get_combined_counter (cm, i, &v);
1067 total_pkts[which] += v.packets;
1068 total_bytes[which] += v.bytes;
1071 map_domain_counter_unlock (mm);
1073 vlib_cli_output (vm, "Encapsulated packets: %lld bytes: %lld\n",
1074 total_pkts[MAP_DOMAIN_COUNTER_TX],
1075 total_bytes[MAP_DOMAIN_COUNTER_TX]);
1076 vlib_cli_output (vm, "Decapsulated packets: %lld bytes: %lld\n",
1077 total_pkts[MAP_DOMAIN_COUNTER_RX],
1078 total_bytes[MAP_DOMAIN_COUNTER_RX]);
1080 vlib_cli_output (vm, "ICMP relayed packets: %d\n",
1081 vlib_get_simple_counter (&mm->icmp_relayed, 0));
1086 static clib_error_t *
1087 map_params_reass_command_fn (vlib_main_t * vm, unformat_input_t * input,
1088 vlib_cli_command_t * cmd)
1090 unformat_input_t _line_input, *line_input = &_line_input;
1092 f64 ht_ratio = (MAP_IP4_REASS_CONF_HT_RATIO_MAX + 1);
1094 u64 buffers = ~(0ull);
1095 u8 ip4 = 0, ip6 = 0;
1097 if (!unformat_user (input, unformat_line_input, line_input))
1100 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
1102 if (unformat (line_input, "lifetime %u", &lifetime))
1104 else if (unformat (line_input, "ht-ratio %lf", &ht_ratio))
1106 else if (unformat (line_input, "pool-size %u", &pool_size))
1108 else if (unformat (line_input, "buffers %llu", &buffers))
1110 else if (unformat (line_input, "ip4"))
1112 else if (unformat (line_input, "ip6"))
1116 unformat_free (line_input);
1117 return clib_error_return (0, "invalid input");
1120 unformat_free (line_input);
1123 return clib_error_return (0, "must specify ip4 and/or ip6");
1127 if (pool_size != ~0 && pool_size > MAP_IP4_REASS_CONF_POOL_SIZE_MAX)
1128 return clib_error_return (0, "invalid ip4-reass pool-size ( > %d)",
1129 MAP_IP4_REASS_CONF_POOL_SIZE_MAX);
1130 if (ht_ratio != (MAP_IP4_REASS_CONF_HT_RATIO_MAX + 1)
1131 && ht_ratio > MAP_IP4_REASS_CONF_HT_RATIO_MAX)
1132 return clib_error_return (0, "invalid ip4-reass ht-ratio ( > %d)",
1133 MAP_IP4_REASS_CONF_HT_RATIO_MAX);
1134 if (lifetime != ~0 && lifetime > MAP_IP4_REASS_CONF_LIFETIME_MAX)
1135 return clib_error_return (0, "invalid ip4-reass lifetime ( > %d)",
1136 MAP_IP4_REASS_CONF_LIFETIME_MAX);
1137 if (buffers != ~(0ull) && buffers > MAP_IP4_REASS_CONF_BUFFERS_MAX)
1138 return clib_error_return (0, "invalid ip4-reass buffers ( > %ld)",
1139 MAP_IP4_REASS_CONF_BUFFERS_MAX);
1144 if (pool_size != ~0 && pool_size > MAP_IP6_REASS_CONF_POOL_SIZE_MAX)
1145 return clib_error_return (0, "invalid ip6-reass pool-size ( > %d)",
1146 MAP_IP6_REASS_CONF_POOL_SIZE_MAX);
1147 if (ht_ratio != (MAP_IP4_REASS_CONF_HT_RATIO_MAX + 1)
1148 && ht_ratio > MAP_IP6_REASS_CONF_HT_RATIO_MAX)
1149 return clib_error_return (0, "invalid ip6-reass ht-log2len ( > %d)",
1150 MAP_IP6_REASS_CONF_HT_RATIO_MAX);
1151 if (lifetime != ~0 && lifetime > MAP_IP6_REASS_CONF_LIFETIME_MAX)
1152 return clib_error_return (0, "invalid ip6-reass lifetime ( > %d)",
1153 MAP_IP6_REASS_CONF_LIFETIME_MAX);
1154 if (buffers != ~(0ull) && buffers > MAP_IP6_REASS_CONF_BUFFERS_MAX)
1155 return clib_error_return (0, "invalid ip6-reass buffers ( > %ld)",
1156 MAP_IP6_REASS_CONF_BUFFERS_MAX);
1161 u32 reass = 0, packets = 0;
1162 if (pool_size != ~0)
1164 if (map_ip4_reass_conf_pool_size (pool_size, &reass, &packets))
1166 vlib_cli_output (vm, "Could not set ip4-reass pool-size");
1170 vlib_cli_output (vm,
1171 "Setting ip4-reass pool-size (destroyed-reassembly=%u , dropped-fragments=%u)",
1175 if (ht_ratio != (MAP_IP4_REASS_CONF_HT_RATIO_MAX + 1))
1177 if (map_ip4_reass_conf_ht_ratio (ht_ratio, &reass, &packets))
1179 vlib_cli_output (vm, "Could not set ip4-reass ht-log2len");
1183 vlib_cli_output (vm,
1184 "Setting ip4-reass ht-log2len (destroyed-reassembly=%u , dropped-fragments=%u)",
1190 if (map_ip4_reass_conf_lifetime (lifetime))
1191 vlib_cli_output (vm, "Could not set ip4-reass lifetime");
1193 vlib_cli_output (vm, "Setting ip4-reass lifetime");
1195 if (buffers != ~(0ull))
1197 if (map_ip4_reass_conf_buffers (buffers))
1198 vlib_cli_output (vm, "Could not set ip4-reass buffers");
1200 vlib_cli_output (vm, "Setting ip4-reass buffers");
1203 if (map_main.ip4_reass_conf_buffers >
1204 map_main.ip4_reass_conf_pool_size *
1205 MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY)
1207 vlib_cli_output (vm,
1208 "Note: 'ip4-reass buffers' > pool-size * max-fragments-per-reassembly.");
1214 u32 reass = 0, packets = 0;
1215 if (pool_size != ~0)
1217 if (map_ip6_reass_conf_pool_size (pool_size, &reass, &packets))
1219 vlib_cli_output (vm, "Could not set ip6-reass pool-size");
1223 vlib_cli_output (vm,
1224 "Setting ip6-reass pool-size (destroyed-reassembly=%u , dropped-fragments=%u)",
1228 if (ht_ratio != (MAP_IP4_REASS_CONF_HT_RATIO_MAX + 1))
1230 if (map_ip6_reass_conf_ht_ratio (ht_ratio, &reass, &packets))
1232 vlib_cli_output (vm, "Could not set ip6-reass ht-log2len");
1236 vlib_cli_output (vm,
1237 "Setting ip6-reass ht-log2len (destroyed-reassembly=%u , dropped-fragments=%u)",
1243 if (map_ip6_reass_conf_lifetime (lifetime))
1244 vlib_cli_output (vm, "Could not set ip6-reass lifetime");
1246 vlib_cli_output (vm, "Setting ip6-reass lifetime");
1248 if (buffers != ~(0ull))
1250 if (map_ip6_reass_conf_buffers (buffers))
1251 vlib_cli_output (vm, "Could not set ip6-reass buffers");
1253 vlib_cli_output (vm, "Setting ip6-reass buffers");
1256 if (map_main.ip6_reass_conf_buffers >
1257 map_main.ip6_reass_conf_pool_size *
1258 MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY)
1260 vlib_cli_output (vm,
1261 "Note: 'ip6-reass buffers' > pool-size * max-fragments-per-reassembly.");
1270 * packet trace format function
1273 format_map_trace (u8 * s, va_list * args)
1275 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
1276 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1277 map_trace_t *t = va_arg (*args, map_trace_t *);
1278 u32 map_domain_index = t->map_domain_index;
1282 format (s, "MAP domain index: %d L4 port: %u", map_domain_index,
1283 clib_net_to_host_u16 (port));
1288 static_always_inline map_ip4_reass_t *
1289 map_ip4_reass_lookup (map_ip4_reass_key_t * k, u32 bucket, f64 now)
1291 map_main_t *mm = &map_main;
1292 u32 ri = mm->ip4_reass_hash_table[bucket];
1293 while (ri != MAP_REASS_INDEX_NONE)
1295 map_ip4_reass_t *r = pool_elt_at_index (mm->ip4_reass_pool, ri);
1296 if (r->key.as_u64[0] == k->as_u64[0] &&
1297 r->key.as_u64[1] == k->as_u64[1] &&
1298 now < r->ts + (((f64) mm->ip4_reass_conf_lifetime_ms) / 1000))
1302 ri = r->bucket_next;
1307 #define map_ip4_reass_pool_index(r) (r - map_main.ip4_reass_pool)
1310 map_ip4_reass_free (map_ip4_reass_t * r, u32 ** pi_to_drop)
1312 map_main_t *mm = &map_main;
1313 map_ip4_reass_get_fragments (r, pi_to_drop);
1315 // Unlink in hash bucket
1316 map_ip4_reass_t *r2 = NULL;
1317 u32 r2i = mm->ip4_reass_hash_table[r->bucket];
1318 while (r2i != map_ip4_reass_pool_index (r))
1320 ASSERT (r2i != MAP_REASS_INDEX_NONE);
1321 r2 = pool_elt_at_index (mm->ip4_reass_pool, r2i);
1322 r2i = r2->bucket_next;
1326 r2->bucket_next = r->bucket_next;
1330 mm->ip4_reass_hash_table[r->bucket] = r->bucket_next;
1334 if (r->fifo_next == map_ip4_reass_pool_index (r))
1336 mm->ip4_reass_fifo_last = MAP_REASS_INDEX_NONE;
1340 if (mm->ip4_reass_fifo_last == map_ip4_reass_pool_index (r))
1341 mm->ip4_reass_fifo_last = r->fifo_prev;
1342 pool_elt_at_index (mm->ip4_reass_pool, r->fifo_prev)->fifo_next =
1344 pool_elt_at_index (mm->ip4_reass_pool, r->fifo_next)->fifo_prev =
1348 pool_put (mm->ip4_reass_pool, r);
1349 mm->ip4_reass_allocated--;
1353 map_ip4_reass_get (u32 src, u32 dst, u16 fragment_id,
1354 u8 protocol, u32 ** pi_to_drop)
1357 map_main_t *mm = &map_main;
1358 map_ip4_reass_key_t k = {.src.data_u32 = src,
1359 .dst.data_u32 = dst,
1360 .fragment_id = fragment_id,
1361 .protocol = protocol
1365 h = crc_u32 (k.as_u32[0], h);
1366 h = crc_u32 (k.as_u32[1], h);
1367 h = crc_u32 (k.as_u32[2], h);
1368 h = crc_u32 (k.as_u32[3], h);
1369 h = h >> (32 - mm->ip4_reass_ht_log2len);
1371 f64 now = vlib_time_now (mm->vlib_main);
1373 //Cache garbage collection
1374 while (mm->ip4_reass_fifo_last != MAP_REASS_INDEX_NONE)
1376 map_ip4_reass_t *last =
1377 pool_elt_at_index (mm->ip4_reass_pool, mm->ip4_reass_fifo_last);
1378 if (last->ts + (((f64) mm->ip4_reass_conf_lifetime_ms) / 1000) < now)
1379 map_ip4_reass_free (last, pi_to_drop);
1384 if ((r = map_ip4_reass_lookup (&k, h, now)))
1387 if (mm->ip4_reass_allocated >= mm->ip4_reass_conf_pool_size)
1390 pool_get (mm->ip4_reass_pool, r);
1391 mm->ip4_reass_allocated++;
1393 for (i = 0; i < MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1394 r->fragments[i] = ~0;
1396 u32 ri = map_ip4_reass_pool_index (r);
1398 //Link in new bucket
1400 r->bucket_next = mm->ip4_reass_hash_table[h];
1401 mm->ip4_reass_hash_table[h] = ri;
1404 if (mm->ip4_reass_fifo_last != MAP_REASS_INDEX_NONE)
1407 pool_elt_at_index (mm->ip4_reass_pool,
1408 mm->ip4_reass_fifo_last)->fifo_next;
1409 r->fifo_prev = mm->ip4_reass_fifo_last;
1410 pool_elt_at_index (mm->ip4_reass_pool, r->fifo_prev)->fifo_next = ri;
1411 pool_elt_at_index (mm->ip4_reass_pool, r->fifo_next)->fifo_prev = ri;
1415 r->fifo_next = r->fifo_prev = ri;
1416 mm->ip4_reass_fifo_last = ri;
1423 #ifdef MAP_IP4_REASS_COUNT_BYTES
1424 r->expected_total = 0xffff;
1432 map_ip4_reass_add_fragment (map_ip4_reass_t * r, u32 pi)
1434 if (map_main.ip4_reass_buffered_counter >= map_main.ip4_reass_conf_buffers)
1438 for (i = 0; i < MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1439 if (r->fragments[i] == ~0)
1441 r->fragments[i] = pi;
1442 map_main.ip4_reass_buffered_counter++;
1448 static_always_inline map_ip6_reass_t *
1449 map_ip6_reass_lookup (map_ip6_reass_key_t * k, u32 bucket, f64 now)
1451 map_main_t *mm = &map_main;
1452 u32 ri = mm->ip6_reass_hash_table[bucket];
1453 while (ri != MAP_REASS_INDEX_NONE)
1455 map_ip6_reass_t *r = pool_elt_at_index (mm->ip6_reass_pool, ri);
1456 if (now < r->ts + (((f64) mm->ip6_reass_conf_lifetime_ms) / 1000) &&
1457 r->key.as_u64[0] == k->as_u64[0] &&
1458 r->key.as_u64[1] == k->as_u64[1] &&
1459 r->key.as_u64[2] == k->as_u64[2] &&
1460 r->key.as_u64[3] == k->as_u64[3] &&
1461 r->key.as_u64[4] == k->as_u64[4])
1463 ri = r->bucket_next;
1468 #define map_ip6_reass_pool_index(r) (r - map_main.ip6_reass_pool)
1471 map_ip6_reass_free (map_ip6_reass_t * r, u32 ** pi_to_drop)
1473 map_main_t *mm = &map_main;
1475 for (i = 0; i < MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1476 if (r->fragments[i].pi != ~0)
1478 vec_add1 (*pi_to_drop, r->fragments[i].pi);
1479 r->fragments[i].pi = ~0;
1480 map_main.ip6_reass_buffered_counter--;
1483 // Unlink in hash bucket
1484 map_ip6_reass_t *r2 = NULL;
1485 u32 r2i = mm->ip6_reass_hash_table[r->bucket];
1486 while (r2i != map_ip6_reass_pool_index (r))
1488 ASSERT (r2i != MAP_REASS_INDEX_NONE);
1489 r2 = pool_elt_at_index (mm->ip6_reass_pool, r2i);
1490 r2i = r2->bucket_next;
1494 r2->bucket_next = r->bucket_next;
1498 mm->ip6_reass_hash_table[r->bucket] = r->bucket_next;
1502 if (r->fifo_next == map_ip6_reass_pool_index (r))
1504 //Single element in the list, list is now empty
1505 mm->ip6_reass_fifo_last = MAP_REASS_INDEX_NONE;
1509 if (mm->ip6_reass_fifo_last == map_ip6_reass_pool_index (r)) //First element
1510 mm->ip6_reass_fifo_last = r->fifo_prev;
1511 pool_elt_at_index (mm->ip6_reass_pool, r->fifo_prev)->fifo_next =
1513 pool_elt_at_index (mm->ip6_reass_pool, r->fifo_next)->fifo_prev =
1517 // Free from pool if necessary
1518 pool_put (mm->ip6_reass_pool, r);
1519 mm->ip6_reass_allocated--;
1523 map_ip6_reass_get (ip6_address_t * src, ip6_address_t * dst, u32 fragment_id,
1524 u8 protocol, u32 ** pi_to_drop)
1527 map_main_t *mm = &map_main;
1528 map_ip6_reass_key_t k = {
1531 .fragment_id = fragment_id,
1532 .protocol = protocol
1537 for (i = 0; i < 10; i++)
1538 h = crc_u32 (k.as_u32[i], h);
1539 h = h >> (32 - mm->ip6_reass_ht_log2len);
1541 f64 now = vlib_time_now (mm->vlib_main);
1543 //Cache garbage collection
1544 while (mm->ip6_reass_fifo_last != MAP_REASS_INDEX_NONE)
1546 map_ip6_reass_t *last =
1547 pool_elt_at_index (mm->ip6_reass_pool, mm->ip6_reass_fifo_last);
1548 if (last->ts + (((f64) mm->ip6_reass_conf_lifetime_ms) / 1000) < now)
1549 map_ip6_reass_free (last, pi_to_drop);
1554 if ((r = map_ip6_reass_lookup (&k, h, now)))
1557 if (mm->ip6_reass_allocated >= mm->ip6_reass_conf_pool_size)
1560 pool_get (mm->ip6_reass_pool, r);
1561 mm->ip6_reass_allocated++;
1562 for (i = 0; i < MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1564 r->fragments[i].pi = ~0;
1565 r->fragments[i].next_data_len = 0;
1566 r->fragments[i].next_data_offset = 0;
1569 u32 ri = map_ip6_reass_pool_index (r);
1571 //Link in new bucket
1573 r->bucket_next = mm->ip6_reass_hash_table[h];
1574 mm->ip6_reass_hash_table[h] = ri;
1577 if (mm->ip6_reass_fifo_last != MAP_REASS_INDEX_NONE)
1580 pool_elt_at_index (mm->ip6_reass_pool,
1581 mm->ip6_reass_fifo_last)->fifo_next;
1582 r->fifo_prev = mm->ip6_reass_fifo_last;
1583 pool_elt_at_index (mm->ip6_reass_pool, r->fifo_prev)->fifo_next = ri;
1584 pool_elt_at_index (mm->ip6_reass_pool, r->fifo_next)->fifo_prev = ri;
1588 r->fifo_next = r->fifo_prev = ri;
1589 mm->ip6_reass_fifo_last = ri;
1595 r->ip4_header.ip_version_and_header_length = 0;
1596 #ifdef MAP_IP6_REASS_COUNT_BYTES
1597 r->expected_total = 0xffff;
1604 map_ip6_reass_add_fragment (map_ip6_reass_t * r, u32 pi,
1605 u16 data_offset, u16 next_data_offset,
1606 u8 * data_start, u16 data_len)
1608 map_ip6_fragment_t *f = NULL, *prev_f = NULL;
1609 u16 copied_len = (data_len > 20) ? 20 : data_len;
1611 if (map_main.ip6_reass_buffered_counter >= map_main.ip6_reass_conf_buffers)
1614 //Lookup for fragments for the current buffer
1615 //and the one before that
1617 for (i = 0; i < MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1619 if (data_offset && r->fragments[i].next_data_offset == data_offset)
1621 prev_f = &r->fragments[i]; // This is buffer for previous packet
1623 else if (r->fragments[i].next_data_offset == next_data_offset)
1625 f = &r->fragments[i]; // This is a buffer for the current packet
1627 else if (r->fragments[i].next_data_offset == 0)
1630 f = &r->fragments[i];
1631 else if (prev_f == NULL)
1632 prev_f = &r->fragments[i];
1636 if (!f || f->pi != ~0)
1644 clib_memcpy (prev_f->next_data, data_start, copied_len);
1645 prev_f->next_data_len = copied_len;
1646 prev_f->next_data_offset = data_offset;
1650 if (((ip4_header_t *) data_start)->ip_version_and_header_length != 0x45)
1653 if (r->ip4_header.ip_version_and_header_length == 0)
1654 clib_memcpy (&r->ip4_header, data_start, sizeof (ip4_header_t));
1659 f->next_data_offset = next_data_offset;
1661 map_main.ip6_reass_buffered_counter++;
1667 map_ip4_reass_reinit (u32 * trashed_reass, u32 * dropped_packets)
1669 map_main_t *mm = &map_main;
1672 if (dropped_packets)
1673 *dropped_packets = mm->ip4_reass_buffered_counter;
1675 *trashed_reass = mm->ip4_reass_allocated;
1676 if (mm->ip4_reass_fifo_last != MAP_REASS_INDEX_NONE)
1678 u16 ri = mm->ip4_reass_fifo_last;
1681 map_ip4_reass_t *r = pool_elt_at_index (mm->ip4_reass_pool, ri);
1682 for (i = 0; i < MAP_IP4_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1683 if (r->fragments[i] != ~0)
1684 map_ip4_drop_pi (r->fragments[i]);
1687 pool_put (mm->ip4_reass_pool, r);
1689 while (ri != mm->ip4_reass_fifo_last);
1692 vec_free (mm->ip4_reass_hash_table);
1693 vec_resize (mm->ip4_reass_hash_table, 1 << mm->ip4_reass_ht_log2len);
1694 for (i = 0; i < (1 << mm->ip4_reass_ht_log2len); i++)
1695 mm->ip4_reass_hash_table[i] = MAP_REASS_INDEX_NONE;
1696 pool_free (mm->ip4_reass_pool);
1697 pool_alloc (mm->ip4_reass_pool, mm->ip4_reass_conf_pool_size);
1699 mm->ip4_reass_allocated = 0;
1700 mm->ip4_reass_fifo_last = MAP_REASS_INDEX_NONE;
1701 mm->ip4_reass_buffered_counter = 0;
1705 map_get_ht_log2len (f32 ht_ratio, u16 pool_size)
1707 u32 desired_size = (u32) (pool_size * ht_ratio);
1709 for (i = 1; i < 31; i++)
1710 if ((1 << i) >= desired_size)
1716 map_ip4_reass_conf_ht_ratio (f32 ht_ratio, u32 * trashed_reass,
1717 u32 * dropped_packets)
1719 map_main_t *mm = &map_main;
1720 if (ht_ratio > MAP_IP4_REASS_CONF_HT_RATIO_MAX)
1723 map_ip4_reass_lock ();
1724 mm->ip4_reass_conf_ht_ratio = ht_ratio;
1725 mm->ip4_reass_ht_log2len =
1726 map_get_ht_log2len (ht_ratio, mm->ip4_reass_conf_pool_size);
1727 map_ip4_reass_reinit (trashed_reass, dropped_packets);
1728 map_ip4_reass_unlock ();
1733 map_ip4_reass_conf_pool_size (u16 pool_size, u32 * trashed_reass,
1734 u32 * dropped_packets)
1736 map_main_t *mm = &map_main;
1737 if (pool_size > MAP_IP4_REASS_CONF_POOL_SIZE_MAX)
1740 map_ip4_reass_lock ();
1741 mm->ip4_reass_conf_pool_size = pool_size;
1742 map_ip4_reass_reinit (trashed_reass, dropped_packets);
1743 map_ip4_reass_unlock ();
1748 map_ip4_reass_conf_lifetime (u16 lifetime_ms)
1750 map_main.ip4_reass_conf_lifetime_ms = lifetime_ms;
1755 map_ip4_reass_conf_buffers (u32 buffers)
1757 map_main.ip4_reass_conf_buffers = buffers;
1762 map_ip6_reass_reinit (u32 * trashed_reass, u32 * dropped_packets)
1764 map_main_t *mm = &map_main;
1765 if (dropped_packets)
1766 *dropped_packets = mm->ip6_reass_buffered_counter;
1768 *trashed_reass = mm->ip6_reass_allocated;
1770 if (mm->ip6_reass_fifo_last != MAP_REASS_INDEX_NONE)
1772 u16 ri = mm->ip6_reass_fifo_last;
1775 map_ip6_reass_t *r = pool_elt_at_index (mm->ip6_reass_pool, ri);
1776 for (i = 0; i < MAP_IP6_REASS_MAX_FRAGMENTS_PER_REASSEMBLY; i++)
1777 if (r->fragments[i].pi != ~0)
1778 map_ip6_drop_pi (r->fragments[i].pi);
1781 pool_put (mm->ip6_reass_pool, r);
1783 while (ri != mm->ip6_reass_fifo_last);
1784 mm->ip6_reass_fifo_last = MAP_REASS_INDEX_NONE;
1787 vec_free (mm->ip6_reass_hash_table);
1788 vec_resize (mm->ip6_reass_hash_table, 1 << mm->ip6_reass_ht_log2len);
1789 for (i = 0; i < (1 << mm->ip6_reass_ht_log2len); i++)
1790 mm->ip6_reass_hash_table[i] = MAP_REASS_INDEX_NONE;
1791 pool_free (mm->ip6_reass_pool);
1792 pool_alloc (mm->ip6_reass_pool, mm->ip4_reass_conf_pool_size);
1794 mm->ip6_reass_allocated = 0;
1795 mm->ip6_reass_buffered_counter = 0;
1799 map_ip6_reass_conf_ht_ratio (f32 ht_ratio, u32 * trashed_reass,
1800 u32 * dropped_packets)
1802 map_main_t *mm = &map_main;
1803 if (ht_ratio > MAP_IP6_REASS_CONF_HT_RATIO_MAX)
1806 map_ip6_reass_lock ();
1807 mm->ip6_reass_conf_ht_ratio = ht_ratio;
1808 mm->ip6_reass_ht_log2len =
1809 map_get_ht_log2len (ht_ratio, mm->ip6_reass_conf_pool_size);
1810 map_ip6_reass_reinit (trashed_reass, dropped_packets);
1811 map_ip6_reass_unlock ();
1816 map_ip6_reass_conf_pool_size (u16 pool_size, u32 * trashed_reass,
1817 u32 * dropped_packets)
1819 map_main_t *mm = &map_main;
1820 if (pool_size > MAP_IP6_REASS_CONF_POOL_SIZE_MAX)
1823 map_ip6_reass_lock ();
1824 mm->ip6_reass_conf_pool_size = pool_size;
1825 map_ip6_reass_reinit (trashed_reass, dropped_packets);
1826 map_ip6_reass_unlock ();
1831 map_ip6_reass_conf_lifetime (u16 lifetime_ms)
1833 map_main.ip6_reass_conf_lifetime_ms = lifetime_ms;
1838 map_ip6_reass_conf_buffers (u32 buffers)
1840 map_main.ip6_reass_conf_buffers = buffers;
1845 VLIB_CLI_COMMAND(map_ip4_reass_lifetime_command, static) = {
1846 .path = "map params reassembly",
1847 .short_help = "[ip4 | ip6] [lifetime <lifetime-ms>] [pool-size <pool-size>] [buffers <buffers>] [ht-ratio <ht-ratio>]",
1848 .function = map_params_reass_command_fn,
1853 VLIB_CLI_COMMAND(map_traffic_class_command, static) = {
1854 .path = "map params traffic-class",
1856 "traffic-class {0x0-0xff | copy}",
1857 .function = map_traffic_class_command_fn,
1862 VLIB_CLI_COMMAND(map_pre_resolve_command, static) = {
1863 .path = "map params pre-resolve",
1865 "pre-resolve {ip4-nh <address>} | {ip6-nh <address>}",
1866 .function = map_pre_resolve_command_fn,
1871 VLIB_CLI_COMMAND(map_security_check_command, static) = {
1872 .path = "map params security-check",
1874 "security-check on|off",
1875 .function = map_security_check_command_fn,
1880 VLIB_CLI_COMMAND(map_icmp_relay_source_address_command, static) = {
1881 .path = "map params icmp source-address",
1882 .short_help = "source-address <ip4-address>",
1883 .function = map_icmp_relay_source_address_command_fn,
1888 VLIB_CLI_COMMAND(map_icmp_unreachables_command, static) = {
1889 .path = "map params icmp6 unreachables",
1890 .short_help = "unreachables {on|off}",
1891 .function = map_icmp_unreachables_command_fn,
1896 VLIB_CLI_COMMAND(map_fragment_command, static) = {
1897 .path = "map params fragment",
1898 .short_help = "[inner|outer] [ignore-df [on|off]]",
1899 .function = map_fragment_command_fn,
1904 VLIB_CLI_COMMAND(map_fragment_df_command, static) = {
1905 .path = "map params fragment ignore-df",
1906 .short_help = "on|off",
1907 .function = map_fragment_df_command_fn,
1912 VLIB_CLI_COMMAND(map_security_check_frag_command, static) = {
1913 .path = "map params security-check fragments",
1916 .function = map_security_check_frag_command_fn,
1921 VLIB_CLI_COMMAND(map_add_domain_command, static) = {
1922 .path = "map add domain",
1924 "map add domain ip4-pfx <ip4-pfx> ip6-pfx <ip6-pfx> ip6-src <ip6-pfx> "
1925 "ea-bits-len <n> psid-offset <n> psid-len <n> [map-t] [mtu <mtu>]",
1926 .function = map_add_domain_command_fn,
1931 VLIB_CLI_COMMAND(map_add_rule_command, static) = {
1932 .path = "map add rule",
1934 "map add rule index <domain> psid <psid> ip6-dst <ip6-addr>",
1935 .function = map_add_rule_command_fn,
1940 VLIB_CLI_COMMAND(map_del_command, static) = {
1941 .path = "map del domain",
1943 "map del domain index <domain>",
1944 .function = map_del_domain_command_fn,
1949 VLIB_CLI_COMMAND(show_map_domain_command, static) = {
1950 .path = "show map domain",
1951 .function = show_map_domain_command_fn,
1956 VLIB_CLI_COMMAND(show_map_stats_command, static) = {
1957 .path = "show map stats",
1958 .function = show_map_stats_command_fn,
1963 VLIB_CLI_COMMAND(show_map_fragments_command, static) = {
1964 .path = "show map fragments",
1965 .function = show_map_fragments_command_fn,
1973 map_init (vlib_main_t * vm)
1975 map_main_t *mm = &map_main;
1976 mm->vnet_main = vnet_get_main ();
1979 #ifdef MAP_SKIP_IP6_LOOKUP
1980 memset (&mm->preresolve_ip4, 0, sizeof (mm->preresolve_ip4));
1981 memset (&mm->preresolve_ip6, 0, sizeof (mm->preresolve_ip6));
1990 /* Inbound security check */
1991 mm->sec_check = true;
1992 mm->sec_check_frag = false;
1994 /* ICMP6 Type 1, Code 5 for security check failure */
1995 mm->icmp6_enabled = false;
1997 /* Inner or outer fragmentation */
1998 mm->frag_inner = false;
1999 mm->frag_ignore_df = false;
2001 vec_validate (mm->domain_counters, MAP_N_DOMAIN_COUNTER - 1);
2002 mm->domain_counters[MAP_DOMAIN_COUNTER_RX].name = "rx";
2003 mm->domain_counters[MAP_DOMAIN_COUNTER_TX].name = "tx";
2005 vlib_validate_simple_counter (&mm->icmp_relayed, 0);
2006 vlib_zero_simple_counter (&mm->icmp_relayed, 0);
2008 /* IP4 virtual reassembly */
2009 mm->ip4_reass_hash_table = 0;
2010 mm->ip4_reass_pool = 0;
2011 mm->ip4_reass_lock =
2012 clib_mem_alloc_aligned (CLIB_CACHE_LINE_BYTES, CLIB_CACHE_LINE_BYTES);
2013 mm->ip4_reass_conf_ht_ratio = MAP_IP4_REASS_HT_RATIO_DEFAULT;
2014 mm->ip4_reass_conf_lifetime_ms = MAP_IP4_REASS_LIFETIME_DEFAULT;
2015 mm->ip4_reass_conf_pool_size = MAP_IP4_REASS_POOL_SIZE_DEFAULT;
2016 mm->ip4_reass_conf_buffers = MAP_IP4_REASS_BUFFERS_DEFAULT;
2017 mm->ip4_reass_ht_log2len =
2018 map_get_ht_log2len (mm->ip4_reass_conf_ht_ratio,
2019 mm->ip4_reass_conf_pool_size);
2020 mm->ip4_reass_fifo_last = MAP_REASS_INDEX_NONE;
2021 map_ip4_reass_reinit (NULL, NULL);
2023 /* IP6 virtual reassembly */
2024 mm->ip6_reass_hash_table = 0;
2025 mm->ip6_reass_pool = 0;
2026 mm->ip6_reass_lock =
2027 clib_mem_alloc_aligned (CLIB_CACHE_LINE_BYTES, CLIB_CACHE_LINE_BYTES);
2028 mm->ip6_reass_conf_ht_ratio = MAP_IP6_REASS_HT_RATIO_DEFAULT;
2029 mm->ip6_reass_conf_lifetime_ms = MAP_IP6_REASS_LIFETIME_DEFAULT;
2030 mm->ip6_reass_conf_pool_size = MAP_IP6_REASS_POOL_SIZE_DEFAULT;
2031 mm->ip6_reass_conf_buffers = MAP_IP6_REASS_BUFFERS_DEFAULT;
2032 mm->ip6_reass_ht_log2len =
2033 map_get_ht_log2len (mm->ip6_reass_conf_ht_ratio,
2034 mm->ip6_reass_conf_pool_size);
2035 mm->ip6_reass_fifo_last = MAP_REASS_INDEX_NONE;
2036 map_ip6_reass_reinit (NULL, NULL);
2041 VLIB_INIT_FUNCTION (map_init);
2044 * fd.io coding-style-patch-verification: ON
2047 * eval: (c-set-style "gnu")