Line data    Source code

       1             : /*
       2             :  * Copyright (c) 2018 Cisco and/or its affiliates.
       3             :  * Licensed under the Apache License, Version 2.0 (the "License");
       4             :  * you may not use this file except in compliance with the License.
       5             :  * You may obtain a copy of the License at:
       6             :  *
       7             :  *     http://www.apache.org/licenses/LICENSE-2.0
       8             :  *
       9             :  * Unless required by applicable law or agreed to in writing, software
      10             :  * distributed under the License is distributed on an "AS IS" BASIS,
      11             :  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
      12             :  * See the License for the specific language governing permissions and
      13             :  * limitations under the License.
      14             :  */
      15             : #include <nat/dslite/dslite.h>
      16             : 
      17             : typedef enum
      18             : {
      19             :   DSLITE_CE_ENCAP_NEXT_IP6_LOOKUP,
      20             :   DSLITE_CE_ENCAP_NEXT_DROP,
      21             :   DSLITE_CE_ENCAP_N_NEXT,
      22             : } dslite_ce_encap_next_t;
      23             : 
      24             : static char *dslite_ce_encap_error_strings[] = {
      25             : #define _(sym,string) string,
      26             :   foreach_dslite_error
      27             : #undef _
      28             : };
      29             : 
      30        2301 : VLIB_NODE_FN (dslite_ce_encap_node) (vlib_main_t * vm,
      31             :                                      vlib_node_runtime_t * node,
      32             :                                      vlib_frame_t * frame)
      33             : {
      34             :   u32 n_left_from, *from, *to_next;
      35             :   dslite_ce_encap_next_t next_index;
      36           1 :   dslite_main_t *dm = &dslite_main;
      37             : 
      38           1 :   from = vlib_frame_vector_args (frame);
      39           1 :   n_left_from = frame->n_vectors;
      40           1 :   next_index = node->cached_next_index;
      41             : 
      42           2 :   while (n_left_from > 0)
      43             :     {
      44             :       u32 n_left_to_next;
      45             : 
      46           1 :       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
      47             : 
      48           2 :       while (n_left_from > 0 && n_left_to_next > 0)
      49             :         {
      50             :           u32 bi0;
      51             :           vlib_buffer_t *b0;
      52           1 :           u32 next0 = DSLITE_CE_ENCAP_NEXT_IP6_LOOKUP;
      53           1 :           u8 error0 = DSLITE_ERROR_CE_ENCAP;
      54             :           ip4_header_t *ip40;
      55             :           ip6_header_t *ip60;
      56             :           u32 proto0;
      57             : 
      58             :           /* speculatively enqueue b0 to the current next frame */
      59           1 :           bi0 = from[0];
      60           1 :           to_next[0] = bi0;
      61           1 :           from += 1;
      62           1 :           to_next += 1;
      63           1 :           n_left_from -= 1;
      64           1 :           n_left_to_next -= 1;
      65             : 
      66           1 :           b0 = vlib_get_buffer (vm, bi0);
      67           1 :           ip40 = vlib_buffer_get_current (b0);
      68           1 :           proto0 = ip_proto_to_nat_proto (ip40->protocol);
      69             : 
      70           1 :           if (PREDICT_FALSE (proto0 == NAT_PROTOCOL_OTHER))
      71             :             {
      72           0 :               error0 = DSLITE_ERROR_UNSUPPORTED_PROTOCOL;
      73           0 :               next0 = DSLITE_CE_ENCAP_NEXT_DROP;
      74           0 :               goto trace0;
      75             :             }
      76             : 
      77             :           /* Construct IPv6 header */
      78           1 :           vlib_buffer_advance (b0, -(sizeof (ip6_header_t)));
      79           1 :           ip60 = vlib_buffer_get_current (b0);
      80           1 :           ip60->ip_version_traffic_class_and_flow_label =
      81           1 :             clib_host_to_net_u32 ((6 << 28) + (ip40->tos << 20));
      82           1 :           ip60->payload_length = ip40->length;
      83           1 :           ip60->protocol = IP_PROTOCOL_IP_IN_IP;
      84           1 :           ip60->hop_limit = ip40->ttl;
      85           1 :           ip60->dst_address.as_u64[0] = dm->aftr_ip6_addr.as_u64[0];
      86           1 :           ip60->dst_address.as_u64[1] = dm->aftr_ip6_addr.as_u64[1];
      87           1 :           ip60->src_address.as_u64[0] = dm->b4_ip6_addr.as_u64[0];
      88           1 :           ip60->src_address.as_u64[1] = dm->b4_ip6_addr.as_u64[1];
      89             : 
      90           1 :         trace0:
      91           1 :           if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)
      92             :                              && (b0->flags & VLIB_BUFFER_IS_TRACED)))
      93             :             {
      94           1 :               dslite_trace_t *t = vlib_add_trace (vm, node, b0, sizeof (*t));
      95           1 :               t->next_index = next0;
      96             :             }
      97             : 
      98           1 :           b0->error = node->errors[error0];
      99             : 
     100             :           /* verify speculative enqueue, maybe switch current next frame */
     101           1 :           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
     102             :                                            n_left_to_next, bi0, next0);
     103             :         }
     104           1 :       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
     105             :     }
     106             : 
     107           1 :   return frame->n_vectors;
     108             : }
     109             : 
     110             : /* *INDENT-OFF* */
     111      148652 : VLIB_REGISTER_NODE (dslite_ce_encap_node) = {
     112             :   .name = "dslite-ce-encap",
     113             :   .vector_size = sizeof (u32),
     114             :   .format_trace = format_dslite_ce_trace,
     115             :   .type = VLIB_NODE_TYPE_INTERNAL,
     116             :   .n_errors = ARRAY_LEN (dslite_ce_encap_error_strings),
     117             :   .error_strings = dslite_ce_encap_error_strings,
     118             :   .n_next_nodes = DSLITE_CE_ENCAP_N_NEXT,
     119             :   /* edit / add dispositions here */
     120             :   .next_nodes = {
     121             :     [DSLITE_CE_ENCAP_NEXT_DROP] = "error-drop",
     122             :     [DSLITE_CE_ENCAP_NEXT_IP6_LOOKUP] = "ip6-lookup",
     123             :   },
     124             : };
     125             : /* *INDENT-ON* */
     126             : 
     127             : /*
     128             :  * fd.io coding-style-patch-verification: ON
     129             :  *
     130             :  * Local Variables:
     131             :  * eval: (c-set-style "gnu")
     132             :  * End:
     133             :  */