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
25typedef struct
26{
27  u32 next_index;
28  u32 flow_label;
29} export_trace_t;
30
31/* packet trace format function */
32static u8 *
33format_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
44vlib_node_registration_t export_node;
45extern ioam_export_main_t ioam_export_main;
46
47#define foreach_export_error \
48_(RECORDED, "Packets recorded for export")
49
50typedef enum
51{
52#define _(sym,str) EXPORT_ERROR_##sym,
53  foreach_export_error
54#undef _
55    EXPORT_N_ERROR,
56} export_error_t;
57
58static char *export_error_strings[] = {
59#define _(sym,string) string,
60  foreach_export_error
61#undef _
62};
63
64typedef enum
65{
66  EXPORT_NEXT_POP_HBYH,
67  EXPORT_N_NEXT,
68} export_next_t;
69
70always_inline void
71copy3cachelines (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
126static void
127ip6_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
140static uword
141ip6_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 */
154VLIB_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};
170