aboutsummaryrefslogtreecommitdiffstats
path: root/vnet/vnet/ip/icmp6.c
diff options
context:
space:
mode:
Diffstat (limited to 'vnet/vnet/ip/icmp6.c')
-rw-r--r--vnet/vnet/ip/icmp6.c514
1 files changed, 276 insertions, 238 deletions
diff --git a/vnet/vnet/ip/icmp6.c b/vnet/vnet/ip/icmp6.c
index a04373a3..70696d0c 100644
--- a/vnet/vnet/ip/icmp6.c
+++ b/vnet/vnet/ip/icmp6.c
@@ -41,11 +41,12 @@
#include <vnet/ip/ip.h>
#include <vnet/pg/pg.h>
-static u8 * format_ip6_icmp_type_and_code (u8 * s, va_list * args)
+static u8 *
+format_ip6_icmp_type_and_code (u8 * s, va_list * args)
{
icmp6_type_t type = va_arg (*args, int);
u8 code = va_arg (*args, int);
- char * t = 0;
+ char *t = 0;
#define _(n,f) case n: t = #f; break;
@@ -59,7 +60,7 @@ static u8 * format_ip6_icmp_type_and_code (u8 * s, va_list * args)
#undef _
- if (! t)
+ if (!t)
return format (s, "unknown 0x%x", type);
s = format (s, "%s", t);
@@ -80,9 +81,10 @@ static u8 * format_ip6_icmp_type_and_code (u8 * s, va_list * args)
return s;
}
-static u8 * format_icmp6_header (u8 * s, va_list * args)
+static u8 *
+format_icmp6_header (u8 * s, va_list * args)
{
- icmp46_header_t * icmp = va_arg (*args, icmp46_header_t *);
+ icmp46_header_t *icmp = va_arg (*args, icmp46_header_t *);
u32 max_header_bytes = va_arg (*args, u32);
/* Nothing to do. */
@@ -94,47 +96,49 @@ static u8 * format_icmp6_header (u8 * s, va_list * args)
clib_net_to_host_u16 (icmp->checksum));
if (max_header_bytes >=
- sizeof(icmp6_neighbor_solicitation_or_advertisement_header_t) &&
+ sizeof (icmp6_neighbor_solicitation_or_advertisement_header_t) &&
(icmp->type == ICMP6_neighbor_solicitation ||
icmp->type == ICMP6_neighbor_advertisement))
- {
- icmp6_neighbor_solicitation_or_advertisement_header_t *icmp6_nd =
- (icmp6_neighbor_solicitation_or_advertisement_header_t *) icmp;
- s = format (s, "\n target address %U",
- format_ip6_address, &icmp6_nd->target_address);
- }
+ {
+ icmp6_neighbor_solicitation_or_advertisement_header_t *icmp6_nd =
+ (icmp6_neighbor_solicitation_or_advertisement_header_t *) icmp;
+ s = format (s, "\n target address %U",
+ format_ip6_address, &icmp6_nd->target_address);
+ }
return s;
}
-u8 * format_icmp6_input_trace (u8 * s, va_list * va)
+u8 *
+format_icmp6_input_trace (u8 * s, va_list * va)
{
CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
- icmp6_input_trace_t * t = va_arg (*va, icmp6_input_trace_t *);
+ icmp6_input_trace_t *t = va_arg (*va, icmp6_input_trace_t *);
s = format (s, "%U",
- format_ip6_header,
- t->packet_data, sizeof (t->packet_data));
+ format_ip6_header, t->packet_data, sizeof (t->packet_data));
return s;
}
-static char * icmp_error_strings[] = {
+static char *icmp_error_strings[] = {
#define _(f,s) s,
foreach_icmp6_error
#undef _
};
-typedef enum {
+typedef enum
+{
ICMP_INPUT_NEXT_DROP,
ICMP_INPUT_N_NEXT,
} icmp_input_next_t;
-typedef struct {
- uword * type_and_code_by_name;
+typedef struct
+{
+ uword *type_and_code_by_name;
- uword * type_by_name;
+ uword *type_by_name;
/* Vector dispatch table indexed by [icmp type]. */
u8 input_next_index_by_type[256];
@@ -152,17 +156,16 @@ icmp6_main_t icmp6_main;
static uword
ip6_icmp_input (vlib_main_t * vm,
- vlib_node_runtime_t * node,
- vlib_frame_t * frame)
+ vlib_node_runtime_t * node, vlib_frame_t * frame)
{
- icmp6_main_t * im = &icmp6_main;
- u32 * from, * to_next;
+ icmp6_main_t *im = &icmp6_main;
+ u32 *from, *to_next;
u32 n_left_from, n_left_to_next, next_index;
from = vlib_frame_vector_args (frame);
n_left_from = frame->n_vectors;
next_index = node->cached_next_index;
-
+
if (node->flags & VLIB_NODE_FLAG_TRACE)
vlib_trace_frame_buffers_only (vm, node, from, frame->n_vectors,
/* stride */ 1,
@@ -174,19 +177,19 @@ ip6_icmp_input (vlib_main_t * vm,
while (n_left_from > 0 && n_left_to_next > 0)
{
- vlib_buffer_t * b0;
- ip6_header_t * ip0;
- icmp46_header_t * icmp0;
+ vlib_buffer_t *b0;
+ ip6_header_t *ip0;
+ icmp46_header_t *icmp0;
icmp6_type_t type0;
u32 bi0, next0, error0, len0;
-
+
bi0 = to_next[0] = from[0];
from += 1;
n_left_from -= 1;
to_next += 1;
n_left_to_next -= 1;
-
+
b0 = vlib_get_buffer (vm, bi0);
ip0 = vlib_buffer_get_current (b0);
icmp0 = ip6_next_header (ip0);
@@ -195,18 +198,28 @@ ip6_icmp_input (vlib_main_t * vm,
error0 = ICMP6_ERROR_NONE;
next0 = im->input_next_index_by_type[type0];
- error0 = next0 == ICMP_INPUT_NEXT_DROP ? ICMP6_ERROR_UNKNOWN_TYPE : error0;
+ error0 =
+ next0 == ICMP_INPUT_NEXT_DROP ? ICMP6_ERROR_UNKNOWN_TYPE : error0;
/* Check code is valid for type. */
- error0 = icmp0->code > im->max_valid_code_by_type[type0] ? ICMP6_ERROR_INVALID_CODE_FOR_TYPE : error0;
+ error0 =
+ icmp0->code >
+ im->max_valid_code_by_type[type0] ?
+ ICMP6_ERROR_INVALID_CODE_FOR_TYPE : error0;
/* Checksum is already validated by ip6_local node so we don't need to check that. */
/* Check that hop limit == 255 for certain types. */
- error0 = ip0->hop_limit < im->min_valid_hop_limit_by_type[type0] ? ICMP6_ERROR_INVALID_HOP_LIMIT_FOR_TYPE : error0;
+ error0 =
+ ip0->hop_limit <
+ im->min_valid_hop_limit_by_type[type0] ?
+ ICMP6_ERROR_INVALID_HOP_LIMIT_FOR_TYPE : error0;
len0 = clib_net_to_host_u16 (ip0->payload_length);
- error0 = len0 < im->min_valid_length_by_type[type0] ? ICMP6_ERROR_LENGTH_TOO_SMALL_FOR_TYPE : error0;
+ error0 =
+ len0 <
+ im->min_valid_length_by_type[type0] ?
+ ICMP6_ERROR_LENGTH_TOO_SMALL_FOR_TYPE : error0;
b0->error = node->errors[error0];
@@ -216,13 +229,14 @@ ip6_icmp_input (vlib_main_t * vm,
to_next, n_left_to_next,
bi0, next0);
}
-
+
vlib_put_next_frame (vm, node, next_index, n_left_to_next);
}
return frame->n_vectors;
}
+/* *INDENT-OFF* */
VLIB_REGISTER_NODE (ip6_icmp_input_node) = {
.function = ip6_icmp_input,
.name = "ip6-icmp-input",
@@ -239,8 +253,10 @@ VLIB_REGISTER_NODE (ip6_icmp_input_node) = {
[ICMP_INPUT_NEXT_DROP] = "error-drop",
},
};
+/* *INDENT-ON* */
-typedef enum {
+typedef enum
+{
ICMP6_ECHO_REQUEST_NEXT_LOOKUP,
ICMP6_ECHO_REQUEST_NEXT_OUTPUT,
ICMP6_ECHO_REQUEST_N_NEXT,
@@ -248,17 +264,16 @@ typedef enum {
static uword
ip6_icmp_echo_request (vlib_main_t * vm,
- vlib_node_runtime_t * node,
- vlib_frame_t * frame)
+ vlib_node_runtime_t * node, vlib_frame_t * frame)
{
- u32 * from, * to_next;
+ u32 *from, *to_next;
u32 n_left_from, n_left_to_next, next_index;
- ip6_main_t * im = &ip6_main;
+ ip6_main_t *im = &ip6_main;
from = vlib_frame_vector_args (frame);
n_left_from = frame->n_vectors;
next_index = node->cached_next_index;
-
+
if (node->flags & VLIB_NODE_FLAG_TRACE)
vlib_trace_frame_buffers_only (vm, node, from, frame->n_vectors,
/* stride */ 1,
@@ -270,16 +285,16 @@ ip6_icmp_echo_request (vlib_main_t * vm,
while (n_left_from > 2 && n_left_to_next > 2)
{
- vlib_buffer_t * p0, * p1;
- ip6_header_t * ip0, * ip1;
- icmp46_header_t * icmp0, * icmp1;
+ vlib_buffer_t *p0, *p1;
+ ip6_header_t *ip0, *ip1;
+ icmp46_header_t *icmp0, *icmp1;
ip6_address_t tmp0, tmp1;
ip_csum_t sum0, sum1;
u32 bi0, bi1;
- u32 fib_index0, fib_index1;
- u32 next0 = ICMP6_ECHO_REQUEST_NEXT_LOOKUP;
- u32 next1 = ICMP6_ECHO_REQUEST_NEXT_LOOKUP;
-
+ u32 fib_index0, fib_index1;
+ u32 next0 = ICMP6_ECHO_REQUEST_NEXT_LOOKUP;
+ u32 next1 = ICMP6_ECHO_REQUEST_NEXT_LOOKUP;
+
bi0 = to_next[0] = from[0];
bi1 = to_next[1] = from[1];
@@ -287,7 +302,7 @@ ip6_icmp_echo_request (vlib_main_t * vm,
n_left_from -= 2;
to_next += 2;
n_left_to_next -= 2;
-
+
p0 = vlib_get_buffer (vm, bi0);
p1 = vlib_get_buffer (vm, bi1);
ip0 = vlib_buffer_get_current (p0);
@@ -338,14 +353,14 @@ ip6_icmp_echo_request (vlib_main_t * vm,
clib_memcpy (tmp_mac, eth0->dst_address, 6);
clib_memcpy (eth0->dst_address, eth0->src_address, 6);
clib_memcpy (eth0->src_address, tmp_mac, 6);
- vnet_buffer(p0)->sw_if_index[VLIB_TX] =
- vnet_buffer (p0)->sw_if_index[VLIB_RX];
+ vnet_buffer (p0)->sw_if_index[VLIB_TX] =
+ vnet_buffer (p0)->sw_if_index[VLIB_RX];
next0 = ICMP6_ECHO_REQUEST_NEXT_OUTPUT;
}
else
{
/* Determine the correct lookup fib indices... */
- fib_index0 = vec_elt (im->fib_index_by_sw_if_index,
+ fib_index0 = vec_elt (im->fib_index_by_sw_if_index,
vnet_buffer (p0)->sw_if_index[VLIB_RX]);
vnet_buffer (p0)->sw_if_index[VLIB_TX] = fib_index0;
}
@@ -362,48 +377,48 @@ ip6_icmp_echo_request (vlib_main_t * vm,
clib_memcpy (tmp_mac, eth1->dst_address, 6);
clib_memcpy (eth1->dst_address, eth1->src_address, 6);
clib_memcpy (eth1->src_address, tmp_mac, 6);
- vnet_buffer(p1)->sw_if_index[VLIB_TX] =
- vnet_buffer (p1)->sw_if_index[VLIB_RX];
+ vnet_buffer (p1)->sw_if_index[VLIB_TX] =
+ vnet_buffer (p1)->sw_if_index[VLIB_RX];
next1 = ICMP6_ECHO_REQUEST_NEXT_OUTPUT;
}
else
{
/* Determine the correct lookup fib indices... */
- fib_index1 = vec_elt (im->fib_index_by_sw_if_index,
+ fib_index1 = vec_elt (im->fib_index_by_sw_if_index,
vnet_buffer (p1)->sw_if_index[VLIB_RX]);
vnet_buffer (p1)->sw_if_index[VLIB_TX] = fib_index1;
}
- vnet_buffer (p0)->sw_if_index[VLIB_RX]
- = vnet_main.local_interface_sw_if_index;
- vnet_buffer (p1)->sw_if_index[VLIB_RX]
- = vnet_main.local_interface_sw_if_index;
+ vnet_buffer (p0)->sw_if_index[VLIB_RX]
+ = vnet_main.local_interface_sw_if_index;
+ vnet_buffer (p1)->sw_if_index[VLIB_RX]
+ = vnet_main.local_interface_sw_if_index;
- /* verify speculative enqueues, maybe switch current next frame */
- /* if next0==next1==next_index then nothing special needs to be done */
- vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
- to_next, n_left_to_next,
- bi0, bi1, next0, next1);
+ /* verify speculative enqueues, maybe switch current next frame */
+ /* if next0==next1==next_index then nothing special needs to be done */
+ vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
+ to_next, n_left_to_next,
+ bi0, bi1, next0, next1);
}
-
+
while (n_left_from > 0 && n_left_to_next > 0)
{
- vlib_buffer_t * p0;
- ip6_header_t * ip0;
- icmp46_header_t * icmp0;
+ vlib_buffer_t *p0;
+ ip6_header_t *ip0;
+ icmp46_header_t *icmp0;
u32 bi0;
ip6_address_t tmp0;
ip_csum_t sum0;
- u32 fib_index0;
- u32 next0 = ICMP6_ECHO_REQUEST_NEXT_LOOKUP;
-
+ u32 fib_index0;
+ u32 next0 = ICMP6_ECHO_REQUEST_NEXT_LOOKUP;
+
bi0 = to_next[0] = from[0];
from += 1;
n_left_from -= 1;
to_next += 1;
n_left_to_next -= 1;
-
+
p0 = vlib_get_buffer (vm, bi0);
ip0 = vlib_buffer_get_current (p0);
icmp0 = ip6_next_header (ip0);
@@ -438,35 +453,35 @@ ip6_icmp_echo_request (vlib_main_t * vm,
clib_memcpy (tmp_mac, eth0->dst_address, 6);
clib_memcpy (eth0->dst_address, eth0->src_address, 6);
clib_memcpy (eth0->src_address, tmp_mac, 6);
- vnet_buffer(p0)->sw_if_index[VLIB_TX] =
- vnet_buffer (p0)->sw_if_index[VLIB_RX];
+ vnet_buffer (p0)->sw_if_index[VLIB_TX] =
+ vnet_buffer (p0)->sw_if_index[VLIB_RX];
next0 = ICMP6_ECHO_REQUEST_NEXT_OUTPUT;
}
else
{
- fib_index0 = vec_elt (im->fib_index_by_sw_if_index,
+ fib_index0 = vec_elt (im->fib_index_by_sw_if_index,
vnet_buffer (p0)->sw_if_index[VLIB_RX]);
vnet_buffer (p0)->sw_if_index[VLIB_TX] = fib_index0;
}
- vnet_buffer (p0)->sw_if_index[VLIB_RX]
- = vnet_main.local_interface_sw_if_index;
+ vnet_buffer (p0)->sw_if_index[VLIB_RX]
+ = vnet_main.local_interface_sw_if_index;
- /* Verify speculative enqueue, maybe switch current next frame */
- vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
+ /* Verify speculative enqueue, maybe switch current next frame */
+ vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
to_next, n_left_to_next,
bi0, next0);
}
-
+
vlib_put_next_frame (vm, node, next_index, n_left_to_next);
}
vlib_error_count (vm, ip6_icmp_input_node.index,
- ICMP6_ERROR_ECHO_REPLIES_SENT,
- frame->n_vectors);
+ ICMP6_ERROR_ECHO_REPLIES_SENT, frame->n_vectors);
return frame->n_vectors;
}
+/* *INDENT-OFF* */
VLIB_REGISTER_NODE (ip6_icmp_echo_request_node,static) = {
.function = ip6_icmp_echo_request,
.name = "ip6-icmp-echo-request",
@@ -481,154 +496,163 @@ VLIB_REGISTER_NODE (ip6_icmp_echo_request_node,static) = {
[ICMP6_ECHO_REQUEST_NEXT_OUTPUT] = "interface-output",
},
};
+/* *INDENT-ON* */
-typedef enum {
+typedef enum
+{
IP6_ICMP_ERROR_NEXT_DROP,
IP6_ICMP_ERROR_NEXT_LOOKUP,
IP6_ICMP_ERROR_N_NEXT,
} ip6_icmp_error_next_t;
void
-icmp6_error_set_vnet_buffer (vlib_buffer_t *b, u8 type, u8 code, u32 data)
+icmp6_error_set_vnet_buffer (vlib_buffer_t * b, u8 type, u8 code, u32 data)
{
- vnet_buffer(b)->ip.icmp.type = type;
- vnet_buffer(b)->ip.icmp.code = code;
- vnet_buffer(b)->ip.icmp.data = data;
+ vnet_buffer (b)->ip.icmp.type = type;
+ vnet_buffer (b)->ip.icmp.code = code;
+ vnet_buffer (b)->ip.icmp.data = data;
}
static u8
icmp6_icmp_type_to_error (u8 type)
{
- switch (type) {
- case ICMP6_destination_unreachable:
- return ICMP6_ERROR_DEST_UNREACH_SENT;
- case ICMP6_packet_too_big:
- return ICMP6_ERROR_PACKET_TOO_BIG_SENT;
- case ICMP6_time_exceeded:
- return ICMP6_ERROR_TTL_EXPIRE_SENT;
- case ICMP6_parameter_problem:
- return ICMP6_ERROR_PARAM_PROBLEM_SENT;
- default:
- return ICMP6_ERROR_DROP;
- }
+ switch (type)
+ {
+ case ICMP6_destination_unreachable:
+ return ICMP6_ERROR_DEST_UNREACH_SENT;
+ case ICMP6_packet_too_big:
+ return ICMP6_ERROR_PACKET_TOO_BIG_SENT;
+ case ICMP6_time_exceeded:
+ return ICMP6_ERROR_TTL_EXPIRE_SENT;
+ case ICMP6_parameter_problem:
+ return ICMP6_ERROR_PARAM_PROBLEM_SENT;
+ default:
+ return ICMP6_ERROR_DROP;
+ }
}
static uword
ip6_icmp_error (vlib_main_t * vm,
- vlib_node_runtime_t * node,
- vlib_frame_t * frame)
+ vlib_node_runtime_t * node, vlib_frame_t * frame)
{
- u32 * from, * to_next;
+ u32 *from, *to_next;
uword n_left_from, n_left_to_next;
ip6_icmp_error_next_t next_index;
ip6_main_t *im = &ip6_main;
- ip_lookup_main_t * lm = &im->lookup_main;
+ ip_lookup_main_t *lm = &im->lookup_main;
- from = vlib_frame_vector_args(frame);
+ from = vlib_frame_vector_args (frame);
n_left_from = frame->n_vectors;
next_index = node->cached_next_index;
if (node->flags & VLIB_NODE_FLAG_TRACE)
vlib_trace_frame_buffers_only (vm, node, from, frame->n_vectors,
- /* stride */ 1, sizeof (icmp6_input_trace_t));
+ /* stride */ 1,
+ sizeof (icmp6_input_trace_t));
while (n_left_from > 0)
{
- vlib_get_next_frame(vm, node, next_index, to_next, n_left_to_next);
+ vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
while (n_left_from > 0 && n_left_to_next > 0)
- {
- u32 pi0 = from[0];
- u32 next0 = IP6_ICMP_ERROR_NEXT_LOOKUP;
- u8 error0 = ICMP6_ERROR_NONE;
- vlib_buffer_t * p0;
- ip6_header_t * ip0, * out_ip0;
- icmp46_header_t * icmp0;
- u32 sw_if_index0, if_add_index0;
- int bogus_length;
-
- /* Speculatively enqueue p0 to the current next frame */
- to_next[0] = pi0;
- from += 1;
- to_next += 1;
- n_left_from -= 1;
- n_left_to_next -= 1;
-
- p0 = vlib_get_buffer(vm, pi0);
- ip0 = vlib_buffer_get_current(p0);
- sw_if_index0 = vnet_buffer(p0)->sw_if_index[VLIB_RX];
-
- /* RFC4443 says to keep as much of the original packet as possible
- * within the minimum MTU. We cheat "a little" here by keeping whatever fits
- * in the first buffer, to be more efficient */
- if (PREDICT_FALSE(p0->total_length_not_including_first_buffer))
- { /* clear current_length of all other buffers in chain */
- vlib_buffer_t *b = p0;
- p0->total_length_not_including_first_buffer = 0;
- while (b->flags & VLIB_BUFFER_NEXT_PRESENT)
- {
- b = vlib_get_buffer (vm, b->next_buffer);
- b->current_length = 0;
- }
- }
- p0->current_length = p0->current_length > 1280 ? 1280 : p0->current_length;
-
- /* Add IP header and ICMPv6 header including a 4 byte data field */
- vlib_buffer_advance(p0,
- -sizeof(ip6_header_t)-sizeof(icmp46_header_t)-4);
- out_ip0 = vlib_buffer_get_current(p0);
- icmp0 = (icmp46_header_t *) &out_ip0[1];
-
- /* Fill ip header fields */
- out_ip0->ip_version_traffic_class_and_flow_label =
- clib_host_to_net_u32(0x6<<28);
-
- out_ip0->payload_length = clib_host_to_net_u16(p0->current_length - sizeof(ip6_header_t));
- out_ip0->protocol = IP_PROTOCOL_ICMP6;
- out_ip0->hop_limit = 0xff;
- out_ip0->dst_address = ip0->src_address;
- if_add_index0 =
- lm->if_address_pool_index_by_sw_if_index[sw_if_index0];
- if (PREDICT_TRUE(if_add_index0 != ~0))
- {
- ip_interface_address_t *if_add =
- pool_elt_at_index(lm->if_address_pool, if_add_index0);
- ip6_address_t *if_ip =
- ip_interface_address_get_address(lm, if_add);
- out_ip0->src_address = *if_ip;
- }
- else /* interface has no IP6 address - should not happen */
- {
- next0 = IP6_ICMP_ERROR_NEXT_DROP;
- error0 = ICMP6_ERROR_DROP;
- }
-
- /* Fill icmp header fields */
- icmp0->type = vnet_buffer(p0)->ip.icmp.type;
- icmp0->code = vnet_buffer(p0)->ip.icmp.code;
- *((u32 *)(icmp0 + 1)) = clib_host_to_net_u32(vnet_buffer(p0)->ip.icmp.data);
- icmp0->checksum = 0;
- icmp0->checksum = ip6_tcp_udp_icmp_compute_checksum(
- vm, p0, out_ip0, &bogus_length);
-
-
-
- /* Update error status */
+ {
+ u32 pi0 = from[0];
+ u32 next0 = IP6_ICMP_ERROR_NEXT_LOOKUP;
+ u8 error0 = ICMP6_ERROR_NONE;
+ vlib_buffer_t *p0;
+ ip6_header_t *ip0, *out_ip0;
+ icmp46_header_t *icmp0;
+ u32 sw_if_index0, if_add_index0;
+ int bogus_length;
+
+ /* Speculatively enqueue p0 to the current next frame */
+ to_next[0] = pi0;
+ from += 1;
+ to_next += 1;
+ n_left_from -= 1;
+ n_left_to_next -= 1;
+
+ p0 = vlib_get_buffer (vm, pi0);
+ ip0 = vlib_buffer_get_current (p0);
+ sw_if_index0 = vnet_buffer (p0)->sw_if_index[VLIB_RX];
+
+ /* RFC4443 says to keep as much of the original packet as possible
+ * within the minimum MTU. We cheat "a little" here by keeping whatever fits
+ * in the first buffer, to be more efficient */
+ if (PREDICT_FALSE (p0->total_length_not_including_first_buffer))
+ { /* clear current_length of all other buffers in chain */
+ vlib_buffer_t *b = p0;
+ p0->total_length_not_including_first_buffer = 0;
+ while (b->flags & VLIB_BUFFER_NEXT_PRESENT)
+ {
+ b = vlib_get_buffer (vm, b->next_buffer);
+ b->current_length = 0;
+ }
+ }
+ p0->current_length =
+ p0->current_length > 1280 ? 1280 : p0->current_length;
+
+ /* Add IP header and ICMPv6 header including a 4 byte data field */
+ vlib_buffer_advance (p0,
+ -sizeof (ip6_header_t) -
+ sizeof (icmp46_header_t) - 4);
+ out_ip0 = vlib_buffer_get_current (p0);
+ icmp0 = (icmp46_header_t *) & out_ip0[1];
+
+ /* Fill ip header fields */
+ out_ip0->ip_version_traffic_class_and_flow_label =
+ clib_host_to_net_u32 (0x6 << 28);
+
+ out_ip0->payload_length =
+ clib_host_to_net_u16 (p0->current_length - sizeof (ip6_header_t));
+ out_ip0->protocol = IP_PROTOCOL_ICMP6;
+ out_ip0->hop_limit = 0xff;
+ out_ip0->dst_address = ip0->src_address;
+ if_add_index0 =
+ lm->if_address_pool_index_by_sw_if_index[sw_if_index0];
+ if (PREDICT_TRUE (if_add_index0 != ~0))
+ {
+ ip_interface_address_t *if_add =
+ pool_elt_at_index (lm->if_address_pool, if_add_index0);
+ ip6_address_t *if_ip =
+ ip_interface_address_get_address (lm, if_add);
+ out_ip0->src_address = *if_ip;
+ }
+ else /* interface has no IP6 address - should not happen */
+ {
+ next0 = IP6_ICMP_ERROR_NEXT_DROP;
+ error0 = ICMP6_ERROR_DROP;
+ }
+
+ /* Fill icmp header fields */
+ icmp0->type = vnet_buffer (p0)->ip.icmp.type;
+ icmp0->code = vnet_buffer (p0)->ip.icmp.code;
+ *((u32 *) (icmp0 + 1)) =
+ clib_host_to_net_u32 (vnet_buffer (p0)->ip.icmp.data);
+ icmp0->checksum = 0;
+ icmp0->checksum =
+ ip6_tcp_udp_icmp_compute_checksum (vm, p0, out_ip0,
+ &bogus_length);
+
+
+
+ /* Update error status */
if (error0 == ICMP6_ERROR_NONE)
- error0 = icmp6_icmp_type_to_error(icmp0->type);
- vlib_error_count(vm, node->node_index, error0, 1);
-
- /* Verify speculative enqueue, maybe switch current next frame */
- vlib_validate_buffer_enqueue_x1(vm, node, next_index,
- to_next, n_left_to_next,
- pi0, next0);
- }
- vlib_put_next_frame(vm, node, next_index, n_left_to_next);
+ error0 = icmp6_icmp_type_to_error (icmp0->type);
+ vlib_error_count (vm, node->node_index, error0, 1);
+
+ /* Verify speculative enqueue, maybe switch current next frame */
+ vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
+ to_next, n_left_to_next,
+ pi0, next0);
+ }
+ vlib_put_next_frame (vm, node, next_index, n_left_to_next);
}
return frame->n_vectors;
}
+/* *INDENT-OFF* */
VLIB_REGISTER_NODE (ip6_icmp_error_node) = {
.function = ip6_icmp_error,
.name = "ip6-icmp-error",
@@ -645,12 +669,14 @@ VLIB_REGISTER_NODE (ip6_icmp_error_node) = {
.format_trace = format_icmp6_input_trace,
};
+/* *INDENT-ON* */
-static uword unformat_icmp_type_and_code (unformat_input_t * input, va_list * args)
+static uword
+unformat_icmp_type_and_code (unformat_input_t * input, va_list * args)
{
- icmp46_header_t * h = va_arg (*args, icmp46_header_t *);
- icmp6_main_t * cm = &icmp6_main;
+ icmp46_header_t *h = va_arg (*args, icmp46_header_t *);
+ icmp6_main_t *cm = &icmp6_main;
u32 i;
if (unformat_user (input, unformat_vlib_number_by_name,
@@ -674,22 +700,20 @@ static uword unformat_icmp_type_and_code (unformat_input_t * input, va_list * ar
static void
icmp6_pg_edit_function (pg_main_t * pg,
pg_stream_t * s,
- pg_edit_group_t * g,
- u32 * packets,
- u32 n_packets)
+ pg_edit_group_t * g, u32 * packets, u32 n_packets)
{
- vlib_main_t * vm = vlib_get_main();
+ vlib_main_t *vm = vlib_get_main ();
u32 ip_offset, icmp_offset;
int bogus_length;
icmp_offset = g->start_byte_offset;
- ip_offset = (g-1)->start_byte_offset;
+ ip_offset = (g - 1)->start_byte_offset;
while (n_packets >= 1)
{
- vlib_buffer_t * p0;
- ip6_header_t * ip0;
- icmp46_header_t * icmp0;
+ vlib_buffer_t *p0;
+ ip6_header_t *ip0;
+ icmp46_header_t *icmp0;
p0 = vlib_get_buffer (vm, packets[0]);
n_packets -= 1;
@@ -699,13 +723,14 @@ icmp6_pg_edit_function (pg_main_t * pg,
ip0 = (void *) (p0->data + ip_offset);
icmp0 = (void *) (p0->data + icmp_offset);
- icmp0->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, p0, ip0,
- &bogus_length);
+ icmp0->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, p0, ip0,
+ &bogus_length);
ASSERT (bogus_length == 0);
}
}
-typedef struct {
+typedef struct
+{
pg_edit_t type, code;
pg_edit_t checksum;
} pg_icmp46_header_t;
@@ -715,19 +740,19 @@ pg_icmp_header_init (pg_icmp46_header_t * p)
{
/* Initialize fields that are not bit fields in the IP header. */
#define _(f) pg_edit_init (&p->f, icmp46_header_t, f);
- _ (type);
- _ (code);
- _ (checksum);
+ _(type);
+ _(code);
+ _(checksum);
#undef _
}
static uword
unformat_pg_icmp_header (unformat_input_t * input, va_list * args)
{
- pg_stream_t * s = va_arg (*args, pg_stream_t *);
- pg_icmp46_header_t * p;
+ pg_stream_t *s = va_arg (*args, pg_stream_t *);
+ pg_icmp46_header_t *p;
u32 group_index;
-
+
p = pg_create_edit_group (s, sizeof (p[0]), sizeof (icmp46_header_t),
&group_index);
pg_icmp_header_init (p);
@@ -737,7 +762,7 @@ unformat_pg_icmp_header (unformat_input_t * input, va_list * args)
{
icmp46_header_t tmp;
- if (! unformat (input, "ICMP %U", unformat_icmp_type_and_code, &tmp))
+ if (!unformat (input, "ICMP %U", unformat_icmp_type_and_code, &tmp))
goto error;
pg_edit_set_fixed (&p->type, tmp.type);
@@ -748,8 +773,7 @@ unformat_pg_icmp_header (unformat_input_t * input, va_list * args)
while (1)
{
if (unformat (input, "checksum %U",
- unformat_pg_edit,
- unformat_pg_number, &p->checksum))
+ unformat_pg_edit, unformat_pg_number, &p->checksum))
;
/* Can't parse input: try next protocol level. */
@@ -757,27 +781,28 @@ unformat_pg_icmp_header (unformat_input_t * input, va_list * args)
break;
}
- if (! unformat_user (input, unformat_pg_payload, s))
+ if (!unformat_user (input, unformat_pg_payload, s))
goto error;
if (p->checksum.type == PG_EDIT_UNSPECIFIED)
{
- pg_edit_group_t * g = pg_stream_get_group (s, group_index);
+ pg_edit_group_t *g = pg_stream_get_group (s, group_index);
g->edit_function = icmp6_pg_edit_function;
g->edit_function_opaque = 0;
}
return 1;
- error:
+error:
/* Free up any edits we may have added. */
pg_free_edit_group (s);
return 0;
}
-void icmp6_register_type (vlib_main_t * vm, icmp6_type_t type, u32 node_index)
+void
+icmp6_register_type (vlib_main_t * vm, icmp6_type_t type, u32 node_index)
{
- icmp6_main_t * im = &icmp6_main;
+ icmp6_main_t *im = &icmp6_main;
ASSERT ((int) type < ARRAY_LEN (im->input_next_index_by_type));
im->input_next_index_by_type[type]
@@ -787,10 +812,10 @@ void icmp6_register_type (vlib_main_t * vm, icmp6_type_t type, u32 node_index)
static clib_error_t *
icmp6_init (vlib_main_t * vm)
{
- ip_main_t * im = &ip_main;
- ip_protocol_info_t * pi;
- icmp6_main_t * cm = &icmp6_main;
- clib_error_t * error;
+ ip_main_t *im = &ip_main;
+ ip_protocol_info_t *pi;
+ icmp6_main_t *cm = &icmp6_main;
+ clib_error_t *error;
error = vlib_call_init_function (vm, ip_main_init);
@@ -812,33 +837,46 @@ icmp6_init (vlib_main_t * vm)
#undef _
memset (cm->input_next_index_by_type,
- ICMP_INPUT_NEXT_DROP,
- sizeof (cm->input_next_index_by_type));
+ ICMP_INPUT_NEXT_DROP, sizeof (cm->input_next_index_by_type));
memset (cm->max_valid_code_by_type, 0, sizeof (cm->max_valid_code_by_type));
#define _(a,n,t) cm->max_valid_code_by_type[ICMP6_##a] = clib_max (cm->max_valid_code_by_type[ICMP6_##a], n);
foreach_icmp6_code;
#undef _
- memset (cm->min_valid_hop_limit_by_type, 0, sizeof (cm->min_valid_hop_limit_by_type));
+ memset (cm->min_valid_hop_limit_by_type, 0,
+ sizeof (cm->min_valid_hop_limit_by_type));
cm->min_valid_hop_limit_by_type[ICMP6_router_solicitation] = 255;
cm->min_valid_hop_limit_by_type[ICMP6_router_advertisement] = 255;
cm->min_valid_hop_limit_by_type[ICMP6_neighbor_solicitation] = 255;
cm->min_valid_hop_limit_by_type[ICMP6_neighbor_advertisement] = 255;
cm->min_valid_hop_limit_by_type[ICMP6_redirect] = 255;
- memset (cm->min_valid_length_by_type, sizeof (icmp46_header_t), sizeof (cm->min_valid_length_by_type));
- cm->min_valid_length_by_type[ICMP6_router_solicitation] = sizeof (icmp6_neighbor_discovery_header_t);
- cm->min_valid_length_by_type[ICMP6_router_advertisement] = sizeof (icmp6_router_advertisement_header_t);
- cm->min_valid_length_by_type[ICMP6_neighbor_solicitation]
- = sizeof (icmp6_neighbor_solicitation_or_advertisement_header_t);
- cm->min_valid_length_by_type[ICMP6_neighbor_advertisement]
- = sizeof (icmp6_neighbor_solicitation_or_advertisement_header_t);
- cm->min_valid_length_by_type[ICMP6_redirect] = sizeof (icmp6_redirect_header_t);
-
- icmp6_register_type (vm, ICMP6_echo_request, ip6_icmp_echo_request_node.index);
+ memset (cm->min_valid_length_by_type, sizeof (icmp46_header_t),
+ sizeof (cm->min_valid_length_by_type));
+ cm->min_valid_length_by_type[ICMP6_router_solicitation] =
+ sizeof (icmp6_neighbor_discovery_header_t);
+ cm->min_valid_length_by_type[ICMP6_router_advertisement] =
+ sizeof (icmp6_router_advertisement_header_t);
+ cm->min_valid_length_by_type[ICMP6_neighbor_solicitation] =
+ sizeof (icmp6_neighbor_solicitation_or_advertisement_header_t);
+ cm->min_valid_length_by_type[ICMP6_neighbor_advertisement] =
+ sizeof (icmp6_neighbor_solicitation_or_advertisement_header_t);
+ cm->min_valid_length_by_type[ICMP6_redirect] =
+ sizeof (icmp6_redirect_header_t);
+
+ icmp6_register_type (vm, ICMP6_echo_request,
+ ip6_icmp_echo_request_node.index);
return vlib_call_init_function (vm, ip6_neighbor_init);
}
VLIB_INIT_FUNCTION (icmp6_init);
+
+/*
+ * fd.io coding-style-patch-verification: ON
+ *
+ * Local Variables:
+ * eval: (c-set-style "gnu")
+ * End:
+ */