2 * Copyright (c) 2017 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:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
18 #include <vnet/plugin/plugin.h>
19 #include <vpp/app/version.h>
20 #include <vnet/ip/format.h>
21 #include <vnet/ip/punt.h>
22 #include <vnet/ethernet/packet.h>
25 static vlib_node_registration_t stn_ip4_punt;
26 static vlib_node_registration_t stn_ip6_punt;
28 static u8 stn_hw_addr_local[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x01};
29 static u8 stn_hw_addr_dst[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x02};
31 static ethernet_header_t stn_ip4_ethernet_header = {};
32 static ethernet_header_t stn_ip6_ethernet_header = {};
35 clib_bihash_kv_16_8_t kv;
36 } stn_ip46_punt_trace_t;
39 format_stn_rule (u8 * s, va_list * args)
41 stn_rule_t *r = va_arg (*args, stn_rule_t *);
42 stn_main_t *stn = &stn_main;
43 u32 indent = format_get_indent (s);
44 u32 node_index = ip46_address_is_ip4(&r->address)?stn_ip4_punt.index:stn_ip6_punt.index;
45 vlib_node_t *next_node = vlib_get_next_node(vlib_get_main(), node_index, r->next_node_index);
46 s = format (s, "rule_index: %d\n", r - stn->rules);
47 s = format (s, "%Uaddress: %U\n", format_white_space, indent,
48 format_ip46_address, &r->address, IP46_TYPE_ANY);
49 s = format (s, "%Uiface: %U (%d)\n", format_white_space, indent,
50 format_vnet_sw_if_index_name, vnet_get_main(), r->sw_if_index,
52 s = format (s, "%Unext_node: %s (%d)", format_white_space, indent,
53 next_node->name, next_node->index);
57 static_always_inline u8 *
58 format_stn_ip46_punt_trace (u8 * s, va_list * args, u8 is_ipv4)
60 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
61 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
62 stn_ip46_punt_trace_t *t = va_arg (*args, stn_ip46_punt_trace_t *);
63 u32 indent = format_get_indent (s);
65 s = format (s, "dst_address: %U\n", format_ip46_address,
66 (ip46_address_t *)t->kv.key, IP46_TYPE_ANY);
68 if (t->kv.value == ~(0L))
70 s = format (s, "%Urule: none", format_white_space, indent);
74 s = format (s, "%Urule:\n%U%U", format_white_space, indent,
75 format_white_space, indent + 2,
76 format_stn_rule, &stn_main.rules[t->kv.value]);
87 static_always_inline uword
88 stn_ip46_punt_fn (vlib_main_t * vm,
89 vlib_node_runtime_t * node,
93 u32 n_left_from, *from, next_index, *to_next, n_left_to_next;
94 stn_main_t *stn = &stn_main;
96 from = vlib_frame_vector_args (frame);
97 n_left_from = frame->n_vectors;
98 next_index = node->cached_next_index;
100 while (n_left_from > 0)
102 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
105 while (n_left_from > 0 && n_left_to_next > 0)
109 clib_bihash_kv_16_8_t kv;
110 u32 next0 = STN_IP_PUNT_DROP;
112 pi0 = to_next[0] = from[0];
118 p0 = vlib_get_buffer (vm, pi0);
122 ip4_header_t *hdr = (ip4_header_t *) vlib_buffer_get_current(p0);
123 ip46_address_set_ip4((ip46_address_t *)kv.key, &hdr->dst_address);
127 ip6_header_t *hdr = (ip6_header_t *) vlib_buffer_get_current(p0);
128 kv.key[0] = hdr->dst_address.as_u64[0];
129 kv.key[1] = hdr->dst_address.as_u64[1];
133 clib_bihash_search_inline_16_8 (&stn->rule_by_address_table, &kv);
134 if (kv.value != ~(0L))
136 ethernet_header_t *eth;
137 stn_rule_t *r = &stn->rules[kv.value];
138 vnet_buffer(p0)->sw_if_index[VLIB_TX] = r->sw_if_index;
139 next0 = r->next_node_index;
140 vlib_buffer_advance(p0, -sizeof(*eth));
141 eth = (ethernet_header_t *) vlib_buffer_get_current(p0);
143 clib_memcpy_fast(eth, &stn_ip4_ethernet_header, sizeof(*eth));
145 clib_memcpy_fast(eth, &stn_ip6_ethernet_header, sizeof(*eth));
149 vnet_feature_next (&next0, p0);
152 if (PREDICT_FALSE (p0->flags & VLIB_BUFFER_IS_TRACED))
154 stn_ip46_punt_trace_t *tr =
155 vlib_add_trace (vm, node, p0, sizeof (*tr));
159 vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
160 n_left_to_next, pi0, next0);
162 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
165 return frame->n_vectors;
169 #define foreach_stn_ip_punt_error \
173 #define _(sym,str) STN_IP_punt_ERROR_##sym,
174 foreach_stn_ip_punt_error
179 static char *stn_ip_punt_error_strings[] = {
180 #define _(sym,string) string,
181 foreach_stn_ip_punt_error
186 format_stn_ip6_punt_trace (u8 * s, va_list * args)
188 return format_stn_ip46_punt_trace (s, args, 0);
192 stn_ip6_punt_fn (vlib_main_t * vm,
193 vlib_node_runtime_t * node, vlib_frame_t * frame)
195 return stn_ip46_punt_fn(vm, node, frame, 0);
199 VLIB_REGISTER_NODE (stn_ip6_punt, static) =
201 .function = stn_ip6_punt_fn,
202 .name = "stn-ip6-punt",
203 .vector_size = sizeof (u32),
204 .format_trace = format_stn_ip6_punt_trace,
205 .n_errors = STN_IP_PUNT_N_ERROR,
206 .error_strings = stn_ip_punt_error_strings,
207 .n_next_nodes = STN_IP_PUNT_N_NEXT,
210 [STN_IP_PUNT_DROP] = "error-drop"
213 VNET_FEATURE_INIT (stn_ip6_punt_feat_node, static) = {
214 .arc_name = "ip6-punt",
215 .node_name = "stn-ip6-punt",
216 .runs_before = VNET_FEATURES("ip6-punt-redirect"),
221 format_stn_ip4_punt_trace (u8 * s, va_list * args)
223 return format_stn_ip46_punt_trace (s, args, 1);
227 stn_ip4_punt_fn (vlib_main_t * vm,
228 vlib_node_runtime_t * node, vlib_frame_t * frame)
230 return stn_ip46_punt_fn(vm, node, frame, 1);
234 VLIB_REGISTER_NODE (stn_ip4_punt, static) =
236 .function = stn_ip4_punt_fn,
237 .name = "stn-ip4-punt",
238 .vector_size = sizeof (u32),
239 .format_trace = format_stn_ip4_punt_trace,
240 .n_errors = STN_IP_PUNT_N_ERROR,
241 .error_strings = stn_ip_punt_error_strings,
242 .n_next_nodes = STN_IP_PUNT_N_NEXT,
245 [STN_IP_PUNT_DROP] = "error-drop",
248 VNET_FEATURE_INIT (stn_ip4_punt_feat_node, static) = {
249 .arc_name = "ip4-punt",
250 .node_name = "stn-ip4-punt",
251 .runs_before = VNET_FEATURES("ip4-punt-redirect"),
256 stn_init (vlib_main_t * vm)
258 stn_main_t *stn = &stn_main;
260 clib_bihash_init_16_8(&stn->rule_by_address_table, "stn addresses",
263 clib_memcpy_fast(stn_ip4_ethernet_header.dst_address, stn_hw_addr_dst, 6);
264 clib_memcpy_fast(stn_ip4_ethernet_header.src_address, stn_hw_addr_local, 6);
265 stn_ip4_ethernet_header.type = clib_host_to_net_u16(ETHERNET_TYPE_IP4);
267 clib_memcpy_fast(stn_ip6_ethernet_header.dst_address, stn_hw_addr_dst, 6);
268 clib_memcpy_fast(stn_ip6_ethernet_header.src_address, stn_hw_addr_local, 6);
269 stn_ip6_ethernet_header.type = clib_host_to_net_u16(ETHERNET_TYPE_IP6);
271 return stn_api_init (vm, stn);
276 VLIB_INIT_FUNCTION (stn_init);
279 VLIB_PLUGIN_REGISTER () = {
280 .version = VPP_BUILD_VER,
281 .description = "VPP Steals the NIC (STN) for Container Integration",
285 int stn_rule_add_del (stn_rule_add_del_args_t *args)
287 vnet_main_t *vnm = vnet_get_main();
288 vlib_main_t *vm = vlib_get_main();
289 stn_main_t *stn = &stn_main;
291 stn_rule_t *r = NULL;
292 clib_bihash_kv_16_8_t kv;
293 kv.key[0] = args->address.as_u64[0];
294 kv.key[1] = args->address.as_u64[1];
296 if (clib_bihash_search_inline_16_8 (&stn->rule_by_address_table, &kv) == 0)
298 r = &stn->rules[kv.value];
302 pool_get(stn->rules, r);
303 kv.value = r - stn->rules;
304 clib_bihash_add_del_16_8(&stn->rule_by_address_table, &kv, 1);
305 r->address = args->address;
308 if (stn->n_rules == 1)
310 vnet_feature_enable_disable("ip6-punt", "stn-ip6-punt",
312 vnet_feature_enable_disable("ip4-punt", "stn-ip4-punt",
320 .protocol = IP_PROTOCOL_UDP,
323 .type = PUNT_TYPE_L4,
325 vnet_punt_add_del (vm, &pr, 1 /* is_add */);
326 pr.punt.l4.af = AF_IP6;
327 vnet_punt_add_del (vm, &pr, 1 /* is_add */);
328 pr.punt.l4.protocol = IP_PROTOCOL_TCP;
329 vnet_punt_add_del (vm, &pr, 1 /* is_add */);
330 pr.punt.l4.af = AF_IP4;
331 vnet_punt_add_del (vm, &pr, 1 /* is_add */);
337 /* Getting output node and adding it as next */
338 u32 output_node_index =
339 vnet_tx_node_index_for_sw_interface(vnm, args->sw_if_index);
340 u32 node_index = ip46_address_is_ip4(&args->address)?
341 stn_ip4_punt.index : stn_ip6_punt.index;
343 r->sw_if_index = args->sw_if_index;
345 vlib_node_add_next(vm, node_index, output_node_index);
347 /* enabling forwarding on the output node (might not be done since
348 * it is unnumbered) */
349 ip4_sw_interface_enable_disable(args->sw_if_index, 1);
350 ip6_sw_interface_enable_disable(args->sw_if_index, 1);
354 clib_bihash_add_del_16_8(&stn->rule_by_address_table, &kv, 0);
355 pool_put(stn->rules, r);
358 if (stn->n_rules == 0)
360 vnet_feature_enable_disable("ip6-punt", "stn-ip6-punt",
362 vnet_feature_enable_disable("ip4-punt", "stn-ip4-punt",
368 return VNET_API_ERROR_NO_SUCH_ENTRY;
374 static clib_error_t *
375 show_stn_rules_fn (vlib_main_t * vm,
376 unformat_input_t * input, vlib_cli_command_t * cmd)
378 stn_main_t *stn = &stn_main;
381 pool_foreach(rule, stn->rules, {
382 s = format (s, "- %U\n", format_stn_rule, rule);
385 vlib_cli_output(vm, "%v", s);
391 VLIB_CLI_COMMAND (show_stn_rules_command, static) =
393 .path = "show stn rules",
395 .function = show_stn_rules_fn,
398 static clib_error_t *
399 stn_rule_fn (vlib_main_t * vm,
400 unformat_input_t * input, vlib_cli_command_t * cmd)
402 unformat_input_t _line_input, *line_input = &_line_input;
403 clib_error_t *error = 0;
404 stn_rule_add_del_args_t args = {};
409 if (!unformat_user (input, unformat_line_input, line_input))
412 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
414 if (unformat (line_input, "address %U", unformat_ip46_address,
415 &args.address, IP46_TYPE_ANY))
418 (line_input, "interface %U", unformat_vnet_sw_interface,
419 vnet_get_main(), &args.sw_if_index))
421 else if (unformat (line_input, "del"))
425 error = clib_error_return (0, "parse error: '%U'",
426 format_unformat_error, line_input);
433 error = clib_error_return (0, "Missing address");
439 error = clib_error_return (0, "Missing interface");
443 if ((ret = stn_rule_add_del (&args)))
445 error = clib_error_return (0, "stn_rule_add_del returned error %d", ret);
450 unformat_free (line_input);
454 VLIB_CLI_COMMAND (stn_rule_command, static) =
457 .short_help = "address <addr> interface <iface> [del]",
458 .function = stn_rule_fn,