ip: punt add punt socket support for icmp6

[vpp.git] / src / vnet / ip / punt_node.c

diff --git a/src/vnet/ip/punt_node.c b/src/vnet/ip/punt_node.c
index b48af84..8a2057b 100644 (file)
--- a/src/vnet/ip/punt_node.c
+++ b/src/vnet/ip/punt_node.c
@@ -23,10 +23,8 @@
  */
 
 #include <vnet/ip/ip.h>
+#include <vnet/ethernet/ethernet.h>
 #include <vlib/vlib.h>
-#include <vnet/pg/pg.h>
-#include <vnet/udp/udp.h>
-#include <vnet/tcp/tcp.h>
 #include <vnet/ip/punt.h>
 #include <vlib/unix/unix.h>
 
@@ -246,10 +244,9 @@ format_udp_punt_trace (u8 * s, va_list * args)
 }
 
 always_inline uword
-punt_socket_inline (vlib_main_t * vm,
-                   vlib_node_runtime_t * node,
-                   vlib_frame_t * frame,
-                   punt_type_t pt, ip_address_family_t af)
+punt_socket_inline2 (vlib_main_t *vm, vlib_node_runtime_t *node,
+                    vlib_frame_t *frame, punt_type_t pt,
+                    ip_address_family_t af, ip_protocol_t protocol)
 {
   u32 *buffers = vlib_frame_vector_args (frame);
   u32 thread_index = vm->thread_index;
@@ -269,33 +266,42 @@ punt_socket_inline (vlib_main_t * vm,
       uword l;
       punt_packetdesc_t packetdesc;
       punt_client_t *c;
-
+      u16 port = 0;
       b = vlib_get_buffer (vm, buffers[i]);
 
       if (PUNT_TYPE_L4 == pt)
        {
-         /* Reverse UDP Punt advance */
-         udp_header_t *udp;
-         if (AF_IP4 == af)
+         if (protocol == IP_PROTOCOL_UDP)
            {
-             vlib_buffer_advance (b, -(sizeof (ip4_header_t) +
-                                       sizeof (udp_header_t)));
-             ip4_header_t *ip = vlib_buffer_get_current (b);
-             udp = (udp_header_t *) (ip + 1);
+             /* Reverse UDP Punt advance */
+             udp_header_t *udp;
+             if (AF_IP4 == af)
+               {
+                 vlib_buffer_advance (
+                   b, -(sizeof (ip4_header_t) + sizeof (udp_header_t)));
+                 ip4_header_t *ip = vlib_buffer_get_current (b);
+                 udp = (udp_header_t *) (ip + 1);
+               }
+             else
+               {
+                 vlib_buffer_advance (
+                   b, -(sizeof (ip6_header_t) + sizeof (udp_header_t)));
+                 ip6_header_t *ip = vlib_buffer_get_current (b);
+                 udp = (udp_header_t *) (ip + 1);
+               }
+             port = clib_net_to_host_u16 (udp->dst_port);
            }
-         else
+         else if (protocol == IP_PROTOCOL_ICMP6)
            {
-             vlib_buffer_advance (b, -(sizeof (ip6_header_t) +
-                                       sizeof (udp_header_t)));
              ip6_header_t *ip = vlib_buffer_get_current (b);
-             udp = (udp_header_t *) (ip + 1);
+             icmp46_header_t *icmp = ip6_next_header (ip);
+             port = icmp->type;
            }
-
          /*
           * Find registerered client
           * If no registered client, drop packet and count
           */
-         c = punt_client_l4_get (af, clib_net_to_host_u16 (udp->dst_port));
+         c = punt_client_l4_get (af, port);
        }
       else if (PUNT_TYPE_IP_PROTO == pt)
        {
@@ -342,7 +348,7 @@ punt_socket_inline (vlib_main_t * vm,
       iov->iov_len = sizeof (packetdesc);
 
       /** VLIB buffer chain -> Unix iovec(s). */
-      vlib_buffer_advance (b, -(sizeof (ethernet_header_t)));
+      vlib_buffer_advance (b, -ethernet_buffer_header_size (b));
       vec_add2 (ptd->iovecs, iov, 1);
       iov->iov_base = b->data + b->current_data;
       iov->iov_len = l = b->current_length;
@@ -399,6 +405,14 @@ error:
   return n_packets;
 }
 
+always_inline uword
+punt_socket_inline (vlib_main_t *vm, vlib_node_runtime_t *node,
+                   vlib_frame_t *frame, punt_type_t pt,
+                   ip_address_family_t af)
+{
+  return punt_socket_inline2 (vm, node, frame, pt, af, IP_PROTOCOL_UDP);
+}
+
 static uword
 udp4_punt_socket (vlib_main_t * vm,
                  vlib_node_runtime_t * node, vlib_frame_t * from_frame)
@@ -429,6 +443,14 @@ ip6_proto_punt_socket (vlib_main_t * vm,
                             PUNT_TYPE_IP_PROTO, AF_IP6);
 }
 
+static uword
+icmp6_punt_socket (vlib_main_t *vm, vlib_node_runtime_t *node,
+                  vlib_frame_t *from_frame)
+{
+  return punt_socket_inline2 (vm, node, from_frame, PUNT_TYPE_L4, AF_IP6,
+                             IP_PROTOCOL_ICMP6);
+}
+
 static uword
 exception_punt_socket (vlib_main_t * vm,
                       vlib_node_runtime_t * node, vlib_frame_t * from_frame)
@@ -486,6 +508,16 @@ VLIB_REGISTER_NODE (exception_punt_socket_node) = {
   .n_errors = PUNT_N_ERROR,
   .error_strings = punt_error_strings,
 };
+VLIB_REGISTER_NODE (icmp6_punt_socket_node) = {
+  .function = icmp6_punt_socket,
+  .name = "ip6-icmp-punt-socket",
+  .format_trace = format_udp_punt_trace,
+  .flags = VLIB_NODE_FLAG_IS_DROP,
+  .vector_size = sizeof (u32),
+  .n_errors = PUNT_N_ERROR,
+  .error_strings = punt_error_strings,
+};
+
 /* *INDENT-ON* */
 
 typedef struct
@@ -549,8 +581,6 @@ punt_socket_rx_fd (vlib_main_t * vm, vlib_node_runtime_t * node, u32 fd)
   b->flags = VNET_BUFFER_F_LOCALLY_ORIGINATED;
   b->current_length = size - sizeof (packetdesc);
 
-  VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b);
-
   switch (packetdesc.action)
     {
     case PUNT_L2:
@@ -576,10 +606,11 @@ punt_socket_rx_fd (vlib_main_t * vm, vlib_node_runtime_t * node, u32 fd)
       goto error;
     }
 
-  if (PREDICT_FALSE (n_trace > 0))
+  if (PREDICT_FALSE
+      (n_trace > 0
+       && vlib_trace_buffer (vm, node, next_index, b, 1 /* follow_chain */ )))
     {
       punt_trace_t *t;
-      vlib_trace_buffer (vm, node, next_index, b, 1 /* follow_chain */ );
       vlib_set_trace_count (vm, node, --n_trace);
       t = vlib_add_trace (vm, node, b, sizeof (*t));
       t->sw_if_index = packetdesc.sw_if_index;
@@ -593,9 +624,11 @@ punt_socket_rx_fd (vlib_main_t * vm, vlib_node_runtime_t * node, u32 fd)
   vlib_validate_buffer_enqueue_x1 (vm, node, next, to_next, n_left_to_next,
                                   bi, next_index);
   vlib_put_next_frame (vm, node, next, n_left_to_next);
+
   return 1;
 
 error:
+  vlib_put_next_frame (vm, node, next, n_left_to_next);
   vlib_node_increment_counter (vm, punt_socket_rx_node.index, error, 1);
   return 0;
 }