src/plugins/ioam/export/node.c

   1 /*
   2  * Copyright (c) 2016 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 <vlib/vlib.h>
  16 #include <vnet/vnet.h>
  17 #include <vnet/pg/pg.h>
  18 #include <vppinfra/error.h>
  19 #include <vnet/ethernet/ethernet.h>
  20 #include <vnet/ip/ip.h>
  21 #include <vnet/ip/ip6_hop_by_hop.h>
  22 #include <ioam/export-common/ioam_export.h>
  23
  24
  25 typedef struct
  26 {
  27   u32 next_index;
  28   u32 flow_label;
  29 } export_trace_t;
  30
  31 /* packet trace format function */
  32 static u8 *
  33 format_export_trace (u8 * s, va_list * args)
  34 {
  35   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
  36   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
  37   export_trace_t *t = va_arg (*args, export_trace_t *);
  38
  39   s = format (s, "EXPORT: flow_label %d, next index %d",
  40               t->flow_label, t->next_index);
  41   return s;
  42 }
  43
  44 vlib_node_registration_t export_node;
  45 extern ioam_export_main_t ioam_export_main;
  46
  47 #define foreach_export_error \
  48 _(RECORDED, "Packets recorded for export")
  49
  50 typedef enum
  51 {
  52 #define _(sym,str) EXPORT_ERROR_##sym,
  53   foreach_export_error
  54 #undef _
  55     EXPORT_N_ERROR,
  56 } export_error_t;
  57
  58 static char *export_error_strings[] = {
  59 #define _(sym,string) string,
  60   foreach_export_error
  61 #undef _
  62 };
  63
  64 typedef enum
  65 {
  66   EXPORT_NEXT_POP_HBYH,
  67   EXPORT_N_NEXT,
  68 } export_next_t;
  69
  70 always_inline void
  71 copy3cachelines (void *dst, const void *src, size_t n)
  72 {
  73 #if 0
  74   if (PREDICT_FALSE (n < DEFAULT_EXPORT_SIZE))
  75     {
  76       /* Copy only the first 1/2 cache lines whatever is available */
  77       if (n >= 64)
  78         clib_mov64 ((u8 *) dst, (const u8 *) src);
  79       if (n >= 128)
  80         clib_mov64 ((u8 *) dst + 64, (const u8 *) src + 64);
  81       return;
  82     }
  83   clib_mov64 ((u8 *) dst, (const u8 *) src);
  84   clib_mov64 ((u8 *) dst + 64, (const u8 *) src + 64);
  85   clib_mov64 ((u8 *) dst + 128, (const u8 *) src + 128);
  86 #endif
  87 #if 1
  88
  89   u64 *copy_dst, *copy_src;
  90   int i;
  91   copy_dst = (u64 *) dst;
  92   copy_src = (u64 *) src;
  93   if (PREDICT_FALSE (n < DEFAULT_EXPORT_SIZE))
  94     {
  95       for (i = 0; i < n / 64; i++)
  96         {
  97           copy_dst[0] = copy_src[0];
  98           copy_dst[1] = copy_src[1];
  99           copy_dst[2] = copy_src[2];
 100           copy_dst[3] = copy_src[3];
 101           copy_dst[4] = copy_src[4];
 102           copy_dst[5] = copy_src[5];
 103           copy_dst[6] = copy_src[6];
 104           copy_dst[7] = copy_src[7];
 105           copy_dst += 8;
 106           copy_src += 8;
 107         }
 108       return;
 109     }
 110   for (i = 0; i < 3; i++)
 111     {
 112       copy_dst[0] = copy_src[0];
 113       copy_dst[1] = copy_src[1];
 114       copy_dst[2] = copy_src[2];
 115       copy_dst[3] = copy_src[3];
 116       copy_dst[4] = copy_src[4];
 117       copy_dst[5] = copy_src[5];
 118       copy_dst[6] = copy_src[6];
 119       copy_dst[7] = copy_src[7];
 120       copy_dst += 8;
 121       copy_src += 8;
 122     }
 123 #endif
 124 }
 125
 126 static void
 127 ip6_export_fixup_func (vlib_buffer_t * export_buf, vlib_buffer_t * pak_buf)
 128 {
 129   ip6_header_t *ip6_temp =
 130       (ip6_header_t *) (export_buf->data + export_buf->current_length);
 131   u32 flow_label_temp =
 132       clib_net_to_host_u32(ip6_temp->ip_version_traffic_class_and_flow_label)
 133       & 0xFFF00000;
 134   flow_label_temp |=
 135       IOAM_MASK_DECAP_BIT((vnet_buffer(pak_buf)->l2_classify.opaque_index));
 136   ip6_temp->ip_version_traffic_class_and_flow_label =
 137       clib_host_to_net_u32(flow_label_temp);
 138 }
 139
 140 static uword
 141 ip6_export_node_fn (vlib_main_t * vm,
 142                     vlib_node_runtime_t * node, vlib_frame_t * frame)
 143 {
 144   ioam_export_main_t *em = &ioam_export_main;
 145   ioam_export_node_common(em, vm, node, frame, ip6_header_t, payload_length,
 146                           ip_version_traffic_class_and_flow_label,
 147                           EXPORT_NEXT_POP_HBYH, ip6_export_fixup_func);
 148   return frame->n_vectors;
 149 }
 150
 151 /*
 152  * Node for IP6 export
 153  */
 154 VLIB_REGISTER_NODE (export_node) =
 155 {
 156   .function = ip6_export_node_fn,
 157   .name = "ip6-export",
 158   .vector_size = sizeof (u32),
 159   .format_trace = format_export_trace,
 160   .type = VLIB_NODE_TYPE_INTERNAL,
 161   .n_errors = ARRAY_LEN (export_error_strings),
 162   .error_strings = export_error_strings,
 163   .n_next_nodes = EXPORT_N_NEXT,
 164   /* edit / add dispositions here */
 165   .next_nodes =
 166   {
 167     [EXPORT_NEXT_POP_HBYH] = "ip6-pop-hop-by-hop"
 168   },
 169 };