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/tunnel/tunnel_dp.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 static 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           u8 inner_protocol0;
  87
  88           bi0 = to_next[0] = from[0];
  89           from += 1;
  90           n_left_from -= 1;
  91           to_next += 1;
  92           n_left_to_next -= 1;
  93
  94           b0 = vlib_get_buffer (vm, bi0);
  95
  96           ipip_tunnel_key_t key0 = {
  97             .fib_index = vnet_buffer (b0)->ip.fib_index,
  98             .mode = IPIP_MODE_P2P,
  99           };
 100
 101           if (is_ipv6)
 102             {
 103               ip60 = vlib_buffer_get_current (b0);
 104               /* Check for outer fragmentation */
 105               if (ip60->protocol == IP_PROTOCOL_IPV6_FRAGMENTATION)
 106                 {
 107                   next0 = IPIP_INPUT_NEXT_DROP;
 108                   b0->error = node->errors[IPIP_ERROR_FRAGMENTED_PACKET];
 109                   goto drop;
 110                 }
 111
 112               vlib_buffer_advance (b0, sizeof (*ip60));
 113               ip_set (&key0.dst, &ip60->src_address, false);
 114               ip_set (&key0.src, &ip60->dst_address, false);
 115               inner_protocol0 = ip60->protocol;
 116               key0.transport = IPIP_TRANSPORT_IP6;
 117             }
 118           else
 119             {
 120               ip40 = vlib_buffer_get_current (b0);
 121               /* Check for outer fragmentation */
 122               if (ip40->flags_and_fragment_offset &
 123                   clib_host_to_net_u16 (IP4_HEADER_FLAG_MORE_FRAGMENTS))
 124                 {
 125                   next0 = IPIP_INPUT_NEXT_DROP;
 126                   b0->error = node->errors[IPIP_ERROR_FRAGMENTED_PACKET];
 127                   goto drop;
 128                 }
 129               vlib_buffer_advance (b0, sizeof (*ip40));
 130               ip_set (&key0.dst, &ip40->src_address, true);
 131               ip_set (&key0.src, &ip40->dst_address, true);
 132               inner_protocol0 = ip40->protocol;
 133               key0.transport = IPIP_TRANSPORT_IP4;
 134             }
 135
 136           /*
 137            * Find tunnel. First a lookup for P2P tunnels, then a lookup
 138            * for multipoint tunnels
 139            */
 140           ipip_tunnel_t *t0 = ipip_tunnel_db_find (&key0);
 141           if (!t0)
 142             {
 143               ip46_address_reset (&key0.dst);
 144               key0.mode = IPIP_MODE_6RD;
 145               t0 = ipip_tunnel_db_find (&key0);
 146               if (!t0)
 147                 {
 148                   next0 = IPIP_INPUT_NEXT_DROP;
 149                   b0->error = node->errors[IPIP_ERROR_NO_TUNNEL];
 150                   goto drop;
 151                 }
 152             }
 153           tunnel_sw_if_index = t0->sw_if_index;
 154
 155           len = vlib_buffer_length_in_chain (vm, b0);
 156           vnet_buffer (b0)->sw_if_index[VLIB_RX] = tunnel_sw_if_index;
 157
 158           if (inner_protocol0 == IP_PROTOCOL_IPV6)
 159             {
 160               next0 = IPIP_INPUT_NEXT_IP6_INPUT;
 161
 162               if (is_ipv6)
 163                 tunnel_decap_fixup_6o6 (t0->flags, (ip60 + 1), ip60);
 164               else
 165                 tunnel_decap_fixup_6o4 (t0->flags,
 166                                         (ip6_header_t *) (ip40 + 1), ip40);
 167             }
 168           else if (inner_protocol0 == IP_PROTOCOL_IP_IN_IP)
 169             {
 170               next0 = IPIP_INPUT_NEXT_IP4_INPUT;
 171
 172               if (is_ipv6)
 173                 tunnel_decap_fixup_4o6 (t0->flags,
 174                                         (ip4_header_t *) (ip60 + 1), ip60);
 175               else
 176                 tunnel_decap_fixup_4o4 (t0->flags, ip40 + 1, ip40);
 177             }
 178
 179           if (!is_ipv6 && t0->mode == IPIP_MODE_6RD
 180               && t0->sixrd.security_check)
 181             {
 182               ip6_header_t *inner_ip60 = vlib_buffer_get_current (b0);
 183               if (sixrd_get_addr_net (t0, inner_ip60->src_address.as_u64[0])
 184                   != ip40->src_address.as_u32)
 185                 {
 186                   next0 = IPIP_INPUT_NEXT_DROP;
 187                   b0->error = node->errors[IPIP_ERROR_NO_TUNNEL];
 188                   goto drop;
 189                 }
 190             }
 191
 192           vlib_increment_combined_counter (im->combined_sw_if_counters +
 193                                            VNET_INTERFACE_COUNTER_RX,
 194                                            thread_index, tunnel_sw_if_index,
 195                                            1 /* packets */ ,
 196                                            len /* bytes */ );
 197
 198         drop:
 199           if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
 200             {
 201               ipip_rx_trace_t *tr =
 202                 vlib_add_trace (vm, node, b0, sizeof (*tr));
 203               tr->tunnel_id = tunnel_sw_if_index;
 204               if (is_ipv6)
 205                 {
 206                   tr->length = ip60->payload_length;
 207                   tr->src.ip6.as_u64[0] = ip60->src_address.as_u64[0];
 208                   tr->src.ip6.as_u64[1] = ip60->src_address.as_u64[1];
 209                   tr->dst.ip6.as_u64[0] = ip60->dst_address.as_u64[0];
 210                   tr->dst.ip6.as_u64[1] = ip60->dst_address.as_u64[1];
 211                 }
 212               else
 213                 {
 214                   tr->length = ip40->length;
 215                   tr->src.ip4.as_u32 = ip40->src_address.as_u32;
 216                   tr->dst.ip4.as_u32 = ip40->dst_address.as_u32;
 217                 }
 218             }
 219
 220           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
 221                                            n_left_to_next, bi0, next0);
 222         }
 223
 224       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
 225     }
 226   vlib_node_increment_counter (vm,
 227                                !is_ipv6 ? ipip4_input_node.index :
 228                                ipip6_input_node.index, IPIP_ERROR_DECAP_PKTS,
 229                                from_frame->n_vectors);
 230   return from_frame->n_vectors;
 231 }
 232
 233 VLIB_NODE_FN (ipip4_input_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
 234                                  vlib_frame_t * from_frame)
 235 {
 236   return ipip_input (vm, node, from_frame, /* is_ip6 */ false);
 237 }
 238
 239 VLIB_NODE_FN (ipip6_input_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
 240                                  vlib_frame_t * from_frame)
 241 {
 242   return ipip_input (vm, node, from_frame, /* is_ip6 */ true);
 243 }
 244
 245 static char *ipip_error_strings[] = {
 246 #define _(sym,string) string,
 247   foreach_ipip_error
 248 #undef _
 249 };
 250
 251 /* *INDENT-OFF* */
 252 VLIB_REGISTER_NODE(ipip4_input_node) = {
 253     .name = "ipip4-input",
 254     /* Takes a vector of packets. */
 255     .vector_size = sizeof(u32),
 256     .n_errors = IPIP_N_ERROR,
 257     .error_strings = ipip_error_strings,
 258     .n_next_nodes = IPIP_INPUT_N_NEXT,
 259     .next_nodes =
 260         {
 261 #define _(s, n) [IPIP_INPUT_NEXT_##s] = n,
 262             foreach_ipip_input_next
 263 #undef _
 264         },
 265     .format_trace = format_ipip_rx_trace,
 266 };
 267
 268 VLIB_REGISTER_NODE(ipip6_input_node) = {
 269     .name = "ipip6-input",
 270     /* Takes a vector of packets. */
 271     .vector_size = sizeof(u32),
 272     .n_errors = IPIP_N_ERROR,
 273     .error_strings = ipip_error_strings,
 274     .n_next_nodes = IPIP_INPUT_N_NEXT,
 275     .next_nodes =
 276         {
 277 #define _(s, n) [IPIP_INPUT_NEXT_##s] = n,
 278             foreach_ipip_input_next
 279 #undef _
 280         },
 281     .format_trace = format_ipip_rx_trace,
 282 };
 283
 284 /* *INDENT-ON* */
 285
 286 /*
 287  * fd.io coding-style-patch-verification: ON
 288  *
 289  * Local Variables:
 290  * eval: (c-set-style "gnu")
 291  * End:
 292  */