src/vnet/ipip/node.c

   1 /*
   2  * node.c: ipip packet processing
   3  *
   4  * Copyright (c) 2018 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:
   8  *
   9  *     http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  * Unless required by applicable law or aipiped 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.
  16  */
  17
  18 #include <vlib/vlib.h>
  19 #include <vnet/ipip/ipip.h>
  20 #include <vnet/ip/ip6_packet.h>
  21 #include <vnet/mpls/mpls.h>
  22 #include <vnet/pg/pg.h>
  23 #include <vppinfra/sparse_vec.h>
  24
  25 #define foreach_ipip_input_next                                                \
  26   _(PUNT, "error-punt")                                                        \
  27   _(DROP, "error-drop")                                                        \
  28   _(IP4_INPUT, "ip4-input")                                                    \
  29   _(IP6_INPUT, "ip6-input")
  30
  31 typedef enum
  32 {
  33 #define _(s, n) IPIP_INPUT_NEXT_##s,
  34   foreach_ipip_input_next
  35 #undef _
  36     IPIP_INPUT_N_NEXT,
  37 } ipip_input_next_t;
  38
  39 typedef struct
  40 {
  41   u32 tunnel_id;
  42   u32 length;
  43   ip46_address_t src;
  44   ip46_address_t dst;
  45   u8 is_ipv6;
  46 } ipip_rx_trace_t;
  47
  48 u8 *
  49 format_ipip_rx_trace (u8 * s, va_list * args)
  50 {
  51   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
  52   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
  53   ipip_rx_trace_t *t = va_arg (*args, ipip_rx_trace_t *);
  54
  55   s = format (s, "IPIP: tunnel %d len %d src %U dst %U", t->tunnel_id,
  56               clib_net_to_host_u16 (t->length), format_ip46_address, &t->src,
  57               IP46_TYPE_ANY, format_ip46_address, &t->dst, IP46_TYPE_ANY);
  58   return s;
  59 }
  60
  61 always_inline uword
  62 ipip_input (vlib_main_t * vm, vlib_node_runtime_t * node,
  63             vlib_frame_t * from_frame, bool is_ipv6)
  64 {
  65   ipip_main_t *gm = &ipip_main;
  66   u32 n_left_from, next_index, *from, *to_next, n_left_to_next;
  67   u32 tunnel_sw_if_index = ~0;
  68   u32 thread_index = vm->thread_index;
  69   u32 len;
  70   vnet_interface_main_t *im = &gm->vnet_main->interface_main;
  71
  72   from = vlib_frame_vector_args (from_frame);
  73   n_left_from = from_frame->n_vectors;
  74   next_index = node->cached_next_index;
  75   while (n_left_from > 0)
  76     {
  77       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
  78
  79       while (n_left_from > 0 && n_left_to_next > 0)
  80         {
  81           u32 bi0;
  82           vlib_buffer_t *b0;
  83           ip4_header_t *ip40;
  84           ip6_header_t *ip60;
  85           u32 next0 = IPIP_INPUT_NEXT_DROP;
  86           ip46_address_t src0 = ip46_address_initializer, dst0 =
  87             ip46_address_initializer;
  88           ipip_transport_t transport0;
  89           u8 inner_protocol0;
  90
  91           bi0 = to_next[0] = from[0];
  92           from += 1;
  93           n_left_from -= 1;
  94           to_next += 1;
  95           n_left_to_next -= 1;
  96
  97           b0 = vlib_get_buffer (vm, bi0);
  98
  99           if (is_ipv6)
 100             {
 101               ip60 = vlib_buffer_get_current (b0);
 102               vlib_buffer_advance (b0, sizeof (*ip60));
 103               ip_set (&src0, &ip60->src_address, false);
 104               ip_set (&dst0, &ip60->dst_address, false);
 105               inner_protocol0 = ip60->protocol;
 106               transport0 = IPIP_TRANSPORT_IP6;
 107             }
 108           else
 109             {
 110               ip40 = vlib_buffer_get_current (b0);
 111               /* Check for outer fragmentation */
 112               if (ip40->flags_and_fragment_offset &
 113                   clib_host_to_net_u16 (IP4_HEADER_FLAG_MORE_FRAGMENTS))
 114                 {
 115                   next0 = IPIP_INPUT_NEXT_DROP;
 116                   b0->error = node->errors[IPIP_ERROR_FRAGMENTED_PACKET];
 117                   goto drop;
 118                 }
 119               vlib_buffer_advance (b0, sizeof (*ip40));
 120               ip_set (&src0, &ip40->src_address, true);
 121               ip_set (&dst0, &ip40->dst_address, true);
 122               inner_protocol0 = ip40->protocol;
 123               transport0 = IPIP_TRANSPORT_IP4;
 124             }
 125
 126           /*
 127            * Find tunnel. First a lookup for P2P tunnels, then a lookup
 128            * for multipoint tunnels
 129            */
 130           ipip_tunnel_key_t key0 = {.transport = transport0,
 131             .fib_index = vnet_buffer (b0)->ip.fib_index,
 132             .src = dst0,
 133             .dst = src0
 134           };
 135           ipip_tunnel_t *t0 = ipip_tunnel_db_find (&key0);
 136           if (!t0)
 137             {
 138               ip46_address_reset (&key0.dst);
 139               t0 = ipip_tunnel_db_find (&key0);
 140               if (!t0)
 141                 {
 142                   next0 = IPIP_INPUT_NEXT_DROP;
 143                   b0->error = node->errors[IPIP_ERROR_NO_TUNNEL];
 144                   goto drop;
 145                 }
 146             }
 147           tunnel_sw_if_index = t0->sw_if_index;
 148
 149           len = vlib_buffer_length_in_chain (vm, b0);
 150           vnet_buffer (b0)->sw_if_index[VLIB_RX] = tunnel_sw_if_index;
 151
 152           if (inner_protocol0 == IP_PROTOCOL_IPV6)
 153             next0 = IPIP_INPUT_NEXT_IP6_INPUT;
 154           else if (inner_protocol0 == IP_PROTOCOL_IP_IN_IP)
 155             next0 = IPIP_INPUT_NEXT_IP4_INPUT;
 156
 157           if (!is_ipv6 && t0->mode == IPIP_MODE_6RD
 158               && t0->sixrd.security_check)
 159             {
 160               ip6_header_t *inner_ip60 = vlib_buffer_get_current (b0);
 161               if (sixrd_get_addr_net (t0, inner_ip60->src_address.as_u64[0])
 162                   != ip40->src_address.as_u32)
 163                 {
 164                   next0 = IPIP_INPUT_NEXT_DROP;
 165                   b0->error = node->errors[IPIP_ERROR_NO_TUNNEL];
 166                   goto drop;
 167                 }
 168             }
 169
 170           vlib_increment_combined_counter (im->combined_sw_if_counters +
 171                                            VNET_INTERFACE_COUNTER_RX,
 172                                            thread_index, tunnel_sw_if_index,
 173                                            1 /* packets */ ,
 174                                            len /* bytes */ );
 175
 176         drop:
 177           if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
 178             {
 179               ipip_rx_trace_t *tr =
 180                 vlib_add_trace (vm, node, b0, sizeof (*tr));
 181               tr->tunnel_id = tunnel_sw_if_index;
 182               if (is_ipv6)
 183                 {
 184                   tr->length = ip60->payload_length;
 185                   tr->src.ip6.as_u64[0] = ip60->src_address.as_u64[0];
 186                   tr->src.ip6.as_u64[1] = ip60->src_address.as_u64[1];
 187                   tr->dst.ip6.as_u64[0] = ip60->dst_address.as_u64[0];
 188                   tr->dst.ip6.as_u64[1] = ip60->dst_address.as_u64[1];
 189                 }
 190               else
 191                 {
 192                   tr->length = ip40->length;
 193                   tr->src.ip4.as_u32 = ip40->src_address.as_u32;
 194                   tr->dst.ip4.as_u32 = ip40->dst_address.as_u32;
 195                 }
 196             }
 197
 198           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
 199                                            n_left_to_next, bi0, next0);
 200         }
 201
 202       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
 203     }
 204   vlib_node_increment_counter (vm,
 205                                !is_ipv6 ? ipip4_input_node.index :
 206                                ipip6_input_node.index, IPIP_ERROR_DECAP_PKTS,
 207                                from_frame->n_vectors);
 208   return from_frame->n_vectors;
 209 }
 210
 211 static uword
 212 ipip4_input (vlib_main_t * vm, vlib_node_runtime_t * node,
 213              vlib_frame_t * from_frame)
 214 {
 215   return ipip_input (vm, node, from_frame, /* is_ip6 */ false);
 216 }
 217
 218 static uword
 219 ipip6_input (vlib_main_t * vm, vlib_node_runtime_t * node,
 220              vlib_frame_t * from_frame)
 221 {
 222   return ipip_input (vm, node, from_frame, /* is_ip6 */ true);
 223 }
 224
 225 static char *ipip_error_strings[] = {
 226 #define _(sym,string) string,
 227   foreach_ipip_error
 228 #undef _
 229 };
 230
 231 /* *INDENT-OFF* */
 232 VLIB_REGISTER_NODE(ipip4_input_node) = {
 233     .function = ipip4_input,
 234     .name = "ipip4-input",
 235     /* Takes a vector of packets. */
 236     .vector_size = sizeof(u32),
 237     .n_errors = IPIP_N_ERROR,
 238     .error_strings = ipip_error_strings,
 239     .n_next_nodes = IPIP_INPUT_N_NEXT,
 240     .next_nodes =
 241         {
 242 #define _(s, n) [IPIP_INPUT_NEXT_##s] = n,
 243             foreach_ipip_input_next
 244 #undef _
 245         },
 246     .format_trace = format_ipip_rx_trace,
 247 };
 248
 249 VLIB_REGISTER_NODE(ipip6_input_node) = {
 250     .function = ipip6_input,
 251     .name = "ipip6-input",
 252     /* Takes a vector of packets. */
 253     .vector_size = sizeof(u32),
 254     .n_errors = IPIP_N_ERROR,
 255     .error_strings = ipip_error_strings,
 256     .n_next_nodes = IPIP_INPUT_N_NEXT,
 257     .next_nodes =
 258         {
 259 #define _(s, n) [IPIP_INPUT_NEXT_##s] = n,
 260             foreach_ipip_input_next
 261 #undef _
 262         },
 263     .format_trace = format_ipip_rx_trace,
 264 };
 265
 266 VLIB_NODE_FUNCTION_MULTIARCH(ipip4_input_node, ipip4_input)
 267 VLIB_NODE_FUNCTION_MULTIARCH(ipip6_input_node, ipip6_input)
 268 /* *INDENT-ON* */
 269
 270 /*
 271  * fd.io coding-style-patch-verification: ON
 272  *
 273  * Local Variables:
 274  * eval: (c-set-style "gnu")
 275  * End:
 276  */