2 * proxy_node.c: dhcp proxy node processing
4 * Copyright (c) 2013 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.
18 #include <vlib/vlib.h>
19 #include <vnet/pg/pg.h>
20 #include <dhcp/dhcp_proxy.h>
21 #include <dhcp/client.h>
22 #include <vnet/fib/ip4_fib.h>
24 static char *dhcp_proxy_error_strings[] = {
25 #define dhcp_proxy_error(n,s) s,
26 #include <dhcp/dhcp4_proxy_error.def>
27 #undef dhcp_proxy_error
30 #define foreach_dhcp_proxy_to_server_input_next \
31 _ (DROP, "error-drop") \
32 _ (LOOKUP, "ip4-lookup") \
33 _ (SEND_TO_CLIENT, "dhcp-proxy-to-client")
37 #define _(s,n) DHCP_PROXY_TO_SERVER_INPUT_NEXT_##s,
38 foreach_dhcp_proxy_to_server_input_next
40 DHCP_PROXY_TO_SERVER_INPUT_N_NEXT,
41 } dhcp_proxy_to_server_input_next_t;
45 /* 0 => to server, 1 => to client */
47 ip4_address_t trace_ip4_address;
50 u32 original_sw_if_index;
52 /* enough space for the DHCP header plus some options */
53 u8 packet_data[2 * sizeof (dhcp_header_t)];
57 #define VPP_DHCP_OPTION82_SUB1_SIZE 6
58 #define VPP_DHCP_OPTION82_SUB5_SIZE 6
59 #define VPP_DHCP_OPTION82_VSS_SIZE 12
60 #define VPP_DHCP_OPTION82_SIZE (VPP_DHCP_OPTION82_SUB1_SIZE + \
61 VPP_DHCP_OPTION82_SUB5_SIZE + \
62 VPP_DHCP_OPTION82_VSS_SIZE +3)
64 static vlib_node_registration_t dhcp_proxy_to_server_node;
65 static vlib_node_registration_t dhcp_proxy_to_client_node;
68 format_dhcp_proxy_trace (u8 * s, va_list * args)
70 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
71 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
72 dhcp_proxy_trace_t *t = va_arg (*args, dhcp_proxy_trace_t *);
75 s = format (s, "DHCP proxy: sent to server %U\n",
76 format_ip4_address, &t->trace_ip4_address, t->error);
78 s = format (s, "DHCP proxy: broadcast to client from %U\n",
79 format_ip4_address, &t->trace_ip4_address);
81 if (t->error != (u32) ~ 0)
82 s = format (s, " error: %s\n", dhcp_proxy_error_strings[t->error]);
84 s = format (s, " original_sw_if_index: %d, sw_if_index: %d\n",
85 t->original_sw_if_index, t->sw_if_index);
87 format_dhcp_header, t->packet_data, sizeof (t->packet_data));
93 format_dhcp_proxy_header_with_length (u8 * s, va_list * args)
95 dhcp_header_t *h = va_arg (*args, dhcp_header_t *);
96 u32 max_header_bytes = va_arg (*args, u32);
99 header_bytes = sizeof (h[0]);
100 if (max_header_bytes != 0 && header_bytes > max_header_bytes)
101 return format (s, "dhcp header truncated");
103 s = format (s, "DHCP Proxy");
109 dhcp_proxy_to_server_input (vlib_main_t * vm,
110 vlib_node_runtime_t * node,
111 vlib_frame_t * from_frame)
113 u32 n_left_from, next_index, *from, *to_next;
114 dhcp_proxy_main_t *dpm = &dhcp_proxy_main;
115 from = vlib_frame_vector_args (from_frame);
116 n_left_from = from_frame->n_vectors;
117 u32 pkts_to_server = 0, pkts_to_client = 0, pkts_no_server = 0;
118 u32 pkts_no_interface_address = 0;
119 u32 pkts_too_big = 0;
120 ip4_main_t *im = &ip4_main;
122 next_index = node->cached_next_index;
124 while (n_left_from > 0)
128 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
130 while (n_left_from > 0 && n_left_to_next > 0)
140 u32 error0 = (u32) ~ 0;
142 u32 original_sw_if_index = 0;
145 dhcp_server_t *server;
147 dhcp_option_t *o, *end;
156 b0 = vlib_get_buffer (vm, bi0);
158 h0 = vlib_buffer_get_current (b0);
161 * udp_local hands us the DHCP header, need udp hdr,
162 * ip hdr to relay to server
164 vlib_buffer_advance (b0, -(sizeof (*u0)));
165 u0 = vlib_buffer_get_current (b0);
167 /* This blows. Return traffic has src_port = 67, dst_port = 67 */
169 clib_net_to_host_u16 (UDP_DST_PORT_dhcp_to_server))
171 vlib_buffer_advance (b0, sizeof (*u0));
172 next0 = DHCP_PROXY_TO_SERVER_INPUT_NEXT_SEND_TO_CLIENT;
178 rx_sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
179 fib_index = im->fib_index_by_sw_if_index[rx_sw_if_index];
180 proxy = dhcp_get_proxy (dpm, fib_index, FIB_PROTOCOL_IP4);
182 if (PREDICT_FALSE (NULL == proxy))
184 error0 = DHCP_PROXY_ERROR_NO_SERVER;
185 next0 = DHCP_PROXY_TO_SERVER_INPUT_NEXT_DROP;
190 if (!vlib_buffer_chain_linearize (vm, b0))
192 error0 = DHCP_PROXY_ERROR_PKT_TOO_BIG;
193 next0 = DHCP_PROXY_TO_SERVER_INPUT_NEXT_DROP;
197 space_left = vlib_buffer_space_left_at_end (vm, b0);
198 /* cant parse chains...
199 * and we need some space for option 82*/
200 if ((b0->flags & VLIB_BUFFER_NEXT_PRESENT) != 0 ||
201 space_left < VPP_DHCP_OPTION82_SIZE)
203 error0 = DHCP_PROXY_ERROR_PKT_TOO_BIG;
204 next0 = DHCP_PROXY_TO_SERVER_INPUT_NEXT_DROP;
209 server = &proxy->dhcp_servers[0];
210 vlib_buffer_advance (b0, -(sizeof (*ip0)));
211 ip0 = vlib_buffer_get_current (b0);
213 /* disable UDP checksum */
215 sum0 = ip0->checksum;
216 old0 = ip0->dst_address.as_u32;
217 new0 = server->dhcp_server.ip4.as_u32;
218 ip0->dst_address.as_u32 = server->dhcp_server.ip4.as_u32;
219 sum0 = ip_csum_update (sum0, old0, new0,
220 ip4_header_t /* structure */ ,
221 dst_address /* changed member */ );
222 ip0->checksum = ip_csum_fold (sum0);
224 sum0 = ip0->checksum;
225 old0 = ip0->src_address.as_u32;
226 new0 = proxy->dhcp_src_address.ip4.as_u32;
227 ip0->src_address.as_u32 = new0;
228 sum0 = ip_csum_update (sum0, old0, new0,
229 ip4_header_t /* structure */ ,
230 src_address /* changed member */ );
231 ip0->checksum = ip_csum_fold (sum0);
233 /* Send to DHCP server via the configured FIB */
234 vnet_buffer (b0)->sw_if_index[VLIB_TX] = server->server_fib_index;
236 h0->gateway_ip_address = proxy->dhcp_src_address.ip4;
240 end = (void *) vlib_buffer_get_tail (b0);
242 /* TLVs are not performance-friendly... */
243 while (o->option != DHCP_PACKET_OPTION_END && o < end)
245 if (DHCP_PACKET_OPTION_MSG_TYPE == o->option)
247 if (DHCP_PACKET_DISCOVER == o->data[0])
252 o = (dhcp_option_t *) (o->data + o->length);
255 if (o->option == DHCP_PACKET_OPTION_END && o <= end)
257 vnet_main_t *vnm = vnet_get_main ();
259 ip4_address_t _ia0, *ia0 = &_ia0;
261 vnet_sw_interface_t *swif;
263 original_sw_if_index = sw_if_index =
264 vnet_buffer (b0)->sw_if_index[VLIB_RX];
265 swif = vnet_get_sw_interface (vnm, sw_if_index);
266 if (swif->flags & VNET_SW_INTERFACE_FLAG_UNNUMBERED)
267 sw_if_index = swif->unnumbered_sw_if_index;
270 * Get the first ip4 address on the [client-side]
271 * RX interface, if not unnumbered. otherwise use
272 * the loopback interface's ip address.
274 ia0 = ip4_interface_first_address (&ip4_main, sw_if_index, 0);
278 error0 = DHCP_PROXY_ERROR_NO_INTERFACE_ADDRESS;
279 next0 = DHCP_PROXY_TO_SERVER_INPUT_NEXT_DROP;
280 pkts_no_interface_address++;
285 o->option = 82; /* option 82 */
286 o->length = 12; /* 12 octets to follow */
287 o->data[0] = 1; /* suboption 1, circuit ID (=FIB id) */
288 o->data[1] = 4; /* length of suboption */
289 u32 *o_ifid = (u32 *) & o->data[2];
290 *o_ifid = clib_host_to_net_u32 (original_sw_if_index);
291 o->data[6] = 5; /* suboption 5 (client RX intfc address) */
292 o->data[7] = 4; /* length 4 */
293 u32 *o_addr = (u32 *) & o->data[8];
294 *o_addr = ia0->as_u32;
295 o->data[12] = DHCP_PACKET_OPTION_END;
297 vss = dhcp_get_vss_info (dpm, fib_index, FIB_PROTOCOL_IP4);
300 u32 id_len; /* length of VPN ID */
302 if (vss->vss_type == VSS_TYPE_VPN_ID)
304 id_len = sizeof (vss->vpn_id); /* vpn_id is 7 bytes */
305 memcpy (&o->data[15], vss->vpn_id, id_len);
307 else if (vss->vss_type == VSS_TYPE_ASCII)
309 id_len = vec_len (vss->vpn_ascii_id);
310 memcpy (&o->data[15], vss->vpn_ascii_id, id_len);
312 else /* must be VSS_TYPE_DEFAULT, no VPN ID */
315 o->data[12] = 151; /* vss suboption */
316 o->data[13] = id_len + 1; /* length: vss_type + id_len */
317 o->data[14] = vss->vss_type; /* vss option type */
318 o->data[15 + id_len] = 152; /* vss control suboption */
319 o->data[16 + id_len] = 0; /* length */
320 o->data[17 + id_len] = DHCP_PACKET_OPTION_END; /* "end-of-options" (0xFF) */
321 /* 5 bytes for suboption headers 151+len, 152+len and 0xFF */
322 o->length += id_len + 5;
326 b0->current_length += len;
327 /* Fix IP header length and checksum */
328 old_l0 = ip0->length;
329 new_l0 = clib_net_to_host_u16 (old_l0);
331 new_l0 = clib_host_to_net_u16 (new_l0);
332 ip0->length = new_l0;
333 sum0 = ip0->checksum;
334 sum0 = ip_csum_update (sum0, old_l0, new_l0, ip4_header_t,
335 length /* changed member */ );
336 ip0->checksum = ip_csum_fold (sum0);
339 new_l0 = clib_net_to_host_u16 (u0->length);
341 u0->length = clib_host_to_net_u16 (new_l0);
345 vlib_node_increment_counter
346 (vm, dhcp_proxy_to_server_node.index,
347 DHCP_PROXY_ERROR_OPTION_82_ERROR, 1);
350 next0 = DHCP_PROXY_TO_SERVER_INPUT_NEXT_LOOKUP;
353 * If we have multiple servers configured and this is the
354 * client's discover message, then send copies to each of
357 if (is_discover && vec_len (proxy->dhcp_servers) > 1)
361 for (ii = 1; ii < vec_len (proxy->dhcp_servers); ii++)
366 c0 = vlib_buffer_copy (vm, b0);
369 vlib_node_increment_counter
370 (vm, dhcp_proxy_to_server_node.index,
371 DHCP_PROXY_ERROR_ALLOC_FAIL, 1);
374 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (c0);
375 ci0 = vlib_get_buffer_index (vm, c0);
376 server = &proxy->dhcp_servers[ii];
378 ip0 = vlib_buffer_get_current (c0);
380 sum0 = ip0->checksum;
381 old0 = ip0->dst_address.as_u32;
382 new0 = server->dhcp_server.ip4.as_u32;
383 ip0->dst_address.as_u32 = server->dhcp_server.ip4.as_u32;
384 sum0 = ip_csum_update (sum0, old0, new0,
385 ip4_header_t /* structure */ ,
386 dst_address /* changed member */ );
387 ip0->checksum = ip_csum_fold (sum0);
393 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
394 to_next, n_left_to_next,
397 if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
399 dhcp_proxy_trace_t *tr;
401 tr = vlib_add_trace (vm, node, c0, sizeof (*tr));
402 tr->which = 0; /* to server */
404 tr->original_sw_if_index = original_sw_if_index;
405 tr->sw_if_index = sw_if_index;
406 if (next0 == DHCP_PROXY_TO_SERVER_INPUT_NEXT_LOOKUP)
407 tr->trace_ip4_address.as_u32 =
408 server->dhcp_server.ip4.as_u32;
410 clib_memcpy_fast (tr->packet_data, h0,
411 sizeof (tr->packet_data));
415 if (PREDICT_FALSE (0 == n_left_to_next))
417 vlib_put_next_frame (vm, node, next_index,
419 vlib_get_next_frame (vm, node, next_index,
420 to_next, n_left_to_next);
425 if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
427 dhcp_proxy_trace_t *tr = vlib_add_trace (vm, node,
429 tr->which = 0; /* to server */
431 tr->original_sw_if_index = original_sw_if_index;
432 tr->sw_if_index = sw_if_index;
433 if (next0 == DHCP_PROXY_TO_SERVER_INPUT_NEXT_LOOKUP)
434 tr->trace_ip4_address.as_u32 =
435 proxy->dhcp_servers[0].dhcp_server.ip4.as_u32;
436 clib_memcpy_fast (tr->packet_data, h0,
437 sizeof (tr->packet_data));
445 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
446 to_next, n_left_to_next,
450 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
452 vlib_node_increment_counter (vm, dhcp_proxy_to_server_node.index,
453 DHCP_PROXY_ERROR_RELAY_TO_CLIENT,
455 vlib_node_increment_counter (vm, dhcp_proxy_to_server_node.index,
456 DHCP_PROXY_ERROR_RELAY_TO_SERVER,
458 vlib_node_increment_counter (vm, dhcp_proxy_to_server_node.index,
459 DHCP_PROXY_ERROR_NO_SERVER, pkts_no_server);
460 vlib_node_increment_counter (vm, dhcp_proxy_to_server_node.index,
461 DHCP_PROXY_ERROR_NO_INTERFACE_ADDRESS,
462 pkts_no_interface_address);
463 vlib_node_increment_counter (vm, dhcp_proxy_to_server_node.index,
464 DHCP_PROXY_ERROR_PKT_TOO_BIG, pkts_too_big);
465 return from_frame->n_vectors;
469 VLIB_REGISTER_NODE (dhcp_proxy_to_server_node, static) = {
470 .function = dhcp_proxy_to_server_input,
471 .name = "dhcp-proxy-to-server",
472 /* Takes a vector of packets. */
473 .vector_size = sizeof (u32),
475 .n_errors = DHCP_PROXY_N_ERROR,
476 .error_strings = dhcp_proxy_error_strings,
478 .n_next_nodes = DHCP_PROXY_TO_SERVER_INPUT_N_NEXT,
480 #define _(s,n) [DHCP_PROXY_TO_SERVER_INPUT_NEXT_##s] = n,
481 foreach_dhcp_proxy_to_server_input_next
485 .format_buffer = format_dhcp_proxy_header_with_length,
486 .format_trace = format_dhcp_proxy_trace,
488 .unformat_buffer = unformat_dhcp_proxy_header,
495 DHCP4_PROXY_NEXT_DROP,
501 dhcp_proxy_to_client_input (vlib_main_t * vm,
502 vlib_node_runtime_t * node,
503 vlib_frame_t * from_frame)
505 u32 n_left_from, *from, *to_next, n_left_to_next;
506 ethernet_main_t *em = vnet_get_ethernet_main ();
507 dhcp_proxy_main_t *dpm = &dhcp_proxy_main;
508 vnet_main_t *vnm = vnet_get_main ();
509 ip4_main_t *im = &ip4_main;
512 from = vlib_frame_vector_args (from_frame);
513 n_left_from = from_frame->n_vectors;
514 next_index = node->cached_next_index;
516 while (n_left_from > 0)
518 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
520 while (n_left_from > 0 && n_left_to_next > 0)
526 ip4_header_t *ip0 = 0;
527 ip4_address_t *ia0 = 0;
530 ethernet_interface_t *ei0;
531 ethernet_header_t *mac0;
532 vnet_hw_interface_t *hi0;
533 u32 sw_if_index = ~0;
534 vnet_sw_interface_t *si0;
535 u32 error0 = (u32) ~ 0;
536 vnet_sw_interface_t *swif;
539 dhcp_server_t *server;
540 u32 original_sw_if_index = (u32) ~ 0;
541 dhcp4_next_t next0 = DHCP4_PROXY_NEXT_TX;
542 ip4_address_t relay_addr = {
546 bi0 = to_next[0] = from[0];
552 b0 = vlib_get_buffer (vm, bi0);
553 h0 = vlib_buffer_get_current (b0);
556 * udp_local hands us the DHCP header, need udp hdr,
557 * ip hdr to relay to client
559 vlib_buffer_advance (b0, -(sizeof (*u0)));
560 u0 = vlib_buffer_get_current (b0);
562 vlib_buffer_advance (b0, -(sizeof (*ip0)));
563 ip0 = vlib_buffer_get_current (b0);
565 /* Consumed by dhcp client code? */
566 if (dhcp_client_for_us (bi0, b0, ip0, u0, h0))
568 error0 = DHCP_PROXY_ERROR_FOR_US;
572 // if (1 /* dpm->insert_option_82 */ )
573 /* linearize needed to "unclone" and scan options */
574 int rv = vlib_buffer_chain_linearize (vm, b0);
575 if ((b0->flags & VLIB_BUFFER_NEXT_PRESENT) != 0 || !rv)
577 error0 = DHCP_PROXY_ERROR_PKT_TOO_BIG;
581 dhcp_option_t *o = h0->options, *end =
582 (void *) vlib_buffer_get_tail (b0);
584 /* Parse through TLVs looking for option 82.
585 The circuit-ID is the FIB number we need
586 to track down the client-facing interface */
588 while (o->option != DHCP_PACKET_OPTION_END && o < end)
594 dhcp_option_t *sub = (dhcp_option_t *) & o->data[0];
595 dhcp_option_t *subend =
596 (dhcp_option_t *) (o->data + o->length);
597 while (sub->option != DHCP_PACKET_OPTION_END
600 /* If this is one of ours, it will have
601 total length 12, circuit-id suboption type,
602 and the sw_if_index */
603 if (sub->option == 1 && sub->length == 4)
605 sw_if_index = ((sub->data[0] << 24) |
606 (sub->data[1] << 16) |
607 (sub->data[2] << 8) |
610 else if (sub->option == 5 && sub->length == 4)
612 relay_addr.as_u8[0] = sub->data[0];
613 relay_addr.as_u8[1] = sub->data[1];
614 relay_addr.as_u8[2] = sub->data[2];
615 relay_addr.as_u8[3] = sub->data[3];
617 else if (sub->option == 151 &&
618 sub->length == 7 && sub->data[0] == 1)
620 else if (sub->option == 152 && sub->length == 0)
622 sub = (dhcp_option_t *) (sub->data + sub->length);
624 if (vss_ctrl && vss_exist)
625 vlib_node_increment_counter
626 (vm, dhcp_proxy_to_client_node.index,
627 DHCP_PROXY_ERROR_OPTION_82_VSS_NOT_PROCESSED, 1);
630 o = (dhcp_option_t *) (o->data + o->length);
633 if (sw_if_index == (u32) ~ 0)
635 error0 = DHCP_PROXY_ERROR_NO_OPTION_82;
638 vlib_node_increment_counter (vm,
639 dhcp_proxy_to_client_node.index,
641 b0->error = node->errors[error0];
642 next0 = DHCP4_PROXY_NEXT_DROP;
646 if (relay_addr.as_u32 == 0)
648 error0 = DHCP_PROXY_ERROR_BAD_OPTION_82_ADDR;
652 if (sw_if_index >= vec_len (im->fib_index_by_sw_if_index))
654 error0 = DHCP_PROXY_ERROR_BAD_OPTION_82_ITF;
658 fib_index = im->fib_index_by_sw_if_index[sw_if_index];
659 proxy = dhcp_get_proxy (dpm, fib_index, FIB_PROTOCOL_IP4);
661 if (PREDICT_FALSE (NULL == proxy))
663 error0 = DHCP_PROXY_ERROR_NO_SERVER;
667 vec_foreach (server, proxy->dhcp_servers)
669 if (ip0->src_address.as_u32 == server->dhcp_server.ip4.as_u32)
675 error0 = DHCP_PROXY_ERROR_BAD_SVR_FIB_OR_ADDRESS;
679 vnet_buffer (b0)->sw_if_index[VLIB_TX] = sw_if_index;
681 swif = vnet_get_sw_interface (vnm, sw_if_index);
682 original_sw_if_index = sw_if_index;
683 if (swif->flags & VNET_SW_INTERFACE_FLAG_UNNUMBERED)
684 sw_if_index = swif->unnumbered_sw_if_index;
686 ia0 = ip4_interface_first_address (&ip4_main, sw_if_index, 0);
689 error0 = DHCP_PROXY_ERROR_NO_INTERFACE_ADDRESS;
693 if (relay_addr.as_u32 != ia0->as_u32)
695 error0 = DHCP_PROXY_ERROR_BAD_YIADDR;
700 u0->dst_port = clib_net_to_host_u16 (UDP_DST_PORT_dhcp_to_client);
701 sum0 = ip0->checksum;
702 old0 = ip0->dst_address.as_u32;
704 ip0->dst_address.as_u32 = new0;
706 ip_csum_update (sum0, old0, new0, ip4_header_t /* structure */ ,
707 dst_address /* offset of changed member */ );
708 ip0->checksum = ip_csum_fold (sum0);
710 sum0 = ip0->checksum;
711 old0 = ip0->src_address.as_u32;
713 ip0->src_address.as_u32 = new0;
715 ip_csum_update (sum0, old0, new0, ip4_header_t /* structure */ ,
716 src_address /* offset of changed member */ );
717 ip0->checksum = ip_csum_fold (sum0);
719 vlib_buffer_advance (b0, -(sizeof (ethernet_header_t)));
720 si0 = vnet_get_sw_interface (vnm, original_sw_if_index);
721 if (si0->type == VNET_SW_INTERFACE_TYPE_SUB)
722 vlib_buffer_advance (b0, -4 /* space for VLAN tag */ );
724 mac0 = vlib_buffer_get_current (b0);
726 hi0 = vnet_get_sup_hw_interface (vnm, original_sw_if_index);
727 ei0 = pool_elt_at_index (em->interfaces, hi0->hw_instance);
728 clib_memcpy (mac0->src_address, ei0->address,
729 sizeof (ei0->address));
730 clib_memset (mac0->dst_address, 0xff, sizeof (mac0->dst_address));
731 mac0->type = (si0->type == VNET_SW_INTERFACE_TYPE_SUB) ?
732 clib_net_to_host_u16 (0x8100) : clib_net_to_host_u16 (0x0800);
734 if (si0->type == VNET_SW_INTERFACE_TYPE_SUB)
736 u32 *vlan_tag = (u32 *) (mac0 + 1);
738 tmp = (si0->sub.id << 16) | 0x0800;
739 *vlan_tag = clib_host_to_net_u32 (tmp);
743 if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
745 dhcp_proxy_trace_t *tr = vlib_add_trace (vm, node,
747 tr->which = 1; /* to client */
748 tr->trace_ip4_address.as_u32 = ia0 ? ia0->as_u32 : 0;
750 tr->original_sw_if_index = original_sw_if_index;
751 tr->sw_if_index = sw_if_index;
752 clib_memcpy_fast (tr->packet_data, h0,
753 sizeof (tr->packet_data));
756 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
757 to_next, n_left_to_next,
760 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
763 return from_frame->n_vectors;
767 VLIB_REGISTER_NODE (dhcp_proxy_to_client_node, static) = {
768 .function = dhcp_proxy_to_client_input,
769 .name = "dhcp-proxy-to-client",
770 /* Takes a vector of packets. */
771 .vector_size = sizeof (u32),
773 .n_errors = DHCP_PROXY_N_ERROR,
774 .error_strings = dhcp_proxy_error_strings,
775 .format_buffer = format_dhcp_proxy_header_with_length,
776 .format_trace = format_dhcp_proxy_trace,
778 .unformat_buffer = unformat_dhcp_proxy_header,
780 .n_next_nodes = DHCP4_PROXY_N_NEXT,
782 [DHCP4_PROXY_NEXT_DROP] = "error-drop",
783 [DHCP4_PROXY_NEXT_TX] = "interface-output",
789 dhcp_maybe_register_udp_ports (dhcp_port_reg_flags_t ports)
791 dhcp_proxy_main_t *dm = &dhcp_proxy_main;
792 vlib_main_t *vm = dm->vlib_main;
793 int port_regs_diff = dm->udp_ports_registered ^ ports;
798 if ((port_regs_diff & DHCP_PORT_REG_CLIENT) & ports)
799 udp_register_dst_port (vm, UDP_DST_PORT_dhcp_to_client,
800 dhcp_proxy_to_client_node.index, 1 /* is_ip4 */ );
802 if ((port_regs_diff & DHCP_PORT_REG_SERVER) & ports)
803 udp_register_dst_port (vm, UDP_DST_PORT_dhcp_to_server,
804 dhcp_proxy_to_server_node.index, 1 /* is_ip4 */ );
806 dm->udp_ports_registered |= ports;
809 static clib_error_t *
810 dhcp4_proxy_init (vlib_main_t * vm)
812 dhcp_proxy_main_t *dm = &dhcp_proxy_main;
813 vlib_node_t *error_drop_node;
815 error_drop_node = vlib_get_node_by_name (vm, (u8 *) "error-drop");
816 dm->error_drop_node_index = error_drop_node->index;
823 VLIB_INIT_FUNCTION (dhcp4_proxy_init);
826 dhcp4_proxy_set_server (ip46_address_t * addr,
827 ip46_address_t * src_addr,
828 u32 rx_table_id, u32 server_table_id, int is_del)
830 u32 rx_fib_index = 0;
833 const fib_prefix_t all_1s = {
835 .fp_addr.ip4.as_u32 = 0xffffffff,
836 .fp_proto = FIB_PROTOCOL_IP4,
839 if (ip46_address_is_zero (addr))
840 return VNET_API_ERROR_INVALID_DST_ADDRESS;
842 if (ip46_address_is_zero (src_addr))
843 return VNET_API_ERROR_INVALID_SRC_ADDRESS;
845 dhcp_maybe_register_udp_ports (DHCP_PORT_REG_CLIENT | DHCP_PORT_REG_SERVER);
847 rx_fib_index = fib_table_find_or_create_and_lock (FIB_PROTOCOL_IP4,
853 if (dhcp_proxy_server_del (FIB_PROTOCOL_IP4, rx_fib_index,
854 addr, server_table_id))
856 fib_table_entry_special_remove (rx_fib_index,
857 &all_1s, FIB_SOURCE_DHCP);
858 fib_table_unlock (rx_fib_index, FIB_PROTOCOL_IP4, FIB_SOURCE_DHCP);
863 if (dhcp_proxy_server_add (FIB_PROTOCOL_IP4,
865 rx_fib_index, server_table_id))
867 fib_table_entry_special_add (rx_fib_index,
869 FIB_SOURCE_DHCP, FIB_ENTRY_FLAG_LOCAL);
870 fib_table_lock (rx_fib_index, FIB_PROTOCOL_IP4, FIB_SOURCE_DHCP);
873 fib_table_unlock (rx_fib_index, FIB_PROTOCOL_IP4, FIB_SOURCE_DHCP);
878 static clib_error_t *
879 dhcp4_proxy_set_command_fn (vlib_main_t * vm,
880 unformat_input_t * input,
881 vlib_cli_command_t * cmd)
883 ip46_address_t server_addr, src_addr;
884 u32 server_table_id = 0, rx_table_id = 0;
886 int set_src = 0, set_server = 0;
888 clib_memset (&server_addr, 0, sizeof (server_addr));
889 clib_memset (&src_addr, 0, sizeof (src_addr));
891 while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
893 if (unformat (input, "server %U",
894 unformat_ip4_address, &server_addr.ip4))
896 else if (unformat (input, "server-fib-id %d", &server_table_id))
898 else if (unformat (input, "rx-fib-id %d", &rx_table_id))
900 else if (unformat (input, "src-address %U",
901 unformat_ip4_address, &src_addr.ip4))
903 else if (unformat (input, "delete") || unformat (input, "del"))
909 if (is_del || (set_server && set_src))
913 rv = dhcp4_proxy_set_server (&server_addr, &src_addr, rx_table_id,
914 server_table_id, is_del);
920 case VNET_API_ERROR_INVALID_DST_ADDRESS:
921 return clib_error_return (0, "Invalid server address");
923 case VNET_API_ERROR_INVALID_SRC_ADDRESS:
924 return clib_error_return (0, "Invalid src address");
926 case VNET_API_ERROR_NO_SUCH_ENTRY:
927 return clib_error_return
928 (0, "Fib id %d: no per-fib DHCP server configured", rx_table_id);
931 return clib_error_return (0, "BUG: rv %d", rv);
935 return clib_error_return (0, "parse error`%U'",
936 format_unformat_error, input);
940 VLIB_CLI_COMMAND (dhcp_proxy_set_command, static) = {
941 .path = "set dhcp proxy",
942 .short_help = "set dhcp proxy [del] server <ip-addr> src-address <ip-addr> [server-fib-id <n>] [rx-fib-id <n>]",
943 .function = dhcp4_proxy_set_command_fn,
948 format_dhcp4_proxy_server (u8 * s, va_list * args)
950 dhcp_proxy_t *proxy = va_arg (*args, dhcp_proxy_t *);
951 ip4_fib_t *rx_fib, *server_fib;
952 dhcp_server_t *server;
956 s = format (s, "%=14s%=16s%s", "RX FIB", "Src Address",
957 "Servers FIB,Address");
961 rx_fib = ip4_fib_get (proxy->rx_fib_index);
963 s = format (s, "%=14u%=16U",
965 format_ip46_address, &proxy->dhcp_src_address, IP46_TYPE_ANY);
967 vec_foreach (server, proxy->dhcp_servers)
969 server_fib = ip4_fib_get (server->server_fib_index);
970 s = format (s, "%u,%U ",
971 server_fib->table_id,
972 format_ip46_address, &server->dhcp_server, IP46_TYPE_ANY);
978 dhcp4_proxy_show_walk (dhcp_proxy_t * server, void *ctx)
980 vlib_main_t *vm = ctx;
982 vlib_cli_output (vm, "%U", format_dhcp4_proxy_server, server);
987 static clib_error_t *
988 dhcp4_proxy_show_command_fn (vlib_main_t * vm,
989 unformat_input_t * input,
990 vlib_cli_command_t * cmd)
992 vlib_cli_output (vm, "%U", format_dhcp4_proxy_server,
993 NULL /* header line */ );
995 dhcp_proxy_walk (FIB_PROTOCOL_IP4, dhcp4_proxy_show_walk, vm);
1001 VLIB_CLI_COMMAND (dhcp_proxy_show_command, static) = {
1002 .path = "show dhcp proxy",
1003 .short_help = "Display dhcp proxy server info",
1004 .function = dhcp4_proxy_show_command_fn,
1008 static clib_error_t *
1009 dhcp_option_82_vss_fn (vlib_main_t * vm,
1010 unformat_input_t * input, vlib_cli_command_t * cmd)
1012 u8 is_del = 0, vss_type = VSS_TYPE_DEFAULT;
1013 u32 oui = 0, fib_id = 0, tbl_id = ~0;
1014 u8 *vpn_ascii_id = 0;
1016 while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
1018 if (unformat (input, "table %d", &tbl_id))
1020 else if (unformat (input, "oui %d", &oui))
1021 vss_type = VSS_TYPE_VPN_ID;
1022 else if (unformat (input, "vpn-id %d", &fib_id))
1023 vss_type = VSS_TYPE_VPN_ID;
1024 else if (unformat (input, "vpn-ascii-id %s", &vpn_ascii_id))
1025 vss_type = VSS_TYPE_ASCII;
1026 else if (unformat (input, "delete") || unformat (input, "del"))
1033 return clib_error_return (0, "no table ID specified.");
1035 int rv = dhcp_proxy_set_vss (FIB_PROTOCOL_IP4, tbl_id, vss_type,
1036 vpn_ascii_id, oui, fib_id, is_del);
1041 case VNET_API_ERROR_NO_SUCH_ENTRY:
1042 return clib_error_return (0,
1043 "option 82 vss for table %d not found in in pool.",
1046 return clib_error_return (0, "BUG: rv %d", rv);
1052 VLIB_CLI_COMMAND (dhcp_proxy_vss_command,static) = {
1053 .path = "set dhcp option-82 vss",
1054 .short_help = "set dhcp option-82 vss [del] table <table id> [oui <n> vpn-id <n> | vpn-ascii-id <text>]",
1055 .function = dhcp_option_82_vss_fn,
1059 static clib_error_t *
1060 dhcp_vss_show_command_fn (vlib_main_t * vm,
1061 unformat_input_t * input, vlib_cli_command_t * cmd)
1063 dhcp_vss_walk (FIB_PROTOCOL_IP4, dhcp_vss_show_walk, vm);
1069 VLIB_CLI_COMMAND (dhcp_proxy_vss_show_command, static) = {
1070 .path = "show dhcp vss",
1071 .short_help = "show dhcp VSS",
1072 .function = dhcp_vss_show_command_fn,
1076 static clib_error_t *
1077 dhcp_option_82_address_show_command_fn (vlib_main_t * vm,
1078 unformat_input_t * input,
1079 vlib_cli_command_t * cmd)
1081 vnet_main_t *vnm = vnet_get_main ();
1082 u32 sw_if_index0 = 0, sw_if_index;
1083 vnet_sw_interface_t *swif;
1086 while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
1089 if (unformat (input, "%U",
1090 unformat_vnet_sw_interface, vnm, &sw_if_index0))
1092 swif = vnet_get_sw_interface (vnm, sw_if_index0);
1093 sw_if_index = (swif->flags & VNET_SW_INTERFACE_FLAG_UNNUMBERED) ?
1094 swif->unnumbered_sw_if_index : sw_if_index0;
1095 ia0 = ip4_interface_first_address (&ip4_main, sw_if_index, 0);
1098 vlib_cli_output (vm, "%=20s%=20s", "interface",
1099 "source IP address");
1101 vlib_cli_output (vm, "%=20U%=20U",
1102 format_vnet_sw_if_index_name,
1103 vnm, sw_if_index0, format_ip4_address, ia0);
1106 vlib_cli_output (vm, "%=34s %=20U",
1107 "No IPv4 address configured on",
1108 format_vnet_sw_if_index_name, vnm, sw_if_index);
1118 VLIB_CLI_COMMAND (dhcp_proxy_address_show_command,static) = {
1119 .path = "show dhcp option-82-address interface",
1120 .short_help = "show dhcp option-82-address interface <interface>",
1121 .function = dhcp_option_82_address_show_command_fn,
1126 * fd.io coding-style-patch-verification: ON
1129 * eval: (c-set-style "gnu")