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:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
15 #include <vlib/vlib.h>
16 #include <vnet/vnet.h>
17 #include <vnet/pg/pg.h>
18 #include <vppinfra/error.h>
20 #include <vnet/ip/ip6.h>
21 #include <vnet/ip/ip6_hop_by_hop.h>
22 #include <vnet/ip/ip6_hop_by_hop_packet.h>
24 #include <vppinfra/hash.h>
25 #include <vppinfra/error.h>
26 #include <vppinfra/elog.h>
28 #include <ioam/lib-trace/trace_util.h>
30 /* Timestamp precision multipliers for seconds, milliseconds, microseconds
31 * and nanoseconds respectively.
33 static f64 trace_tsp_mul[4] = { 1, 1e3, 1e6, 1e9 };
42 extern ip6_hop_by_hop_ioam_main_t ip6_hop_by_hop_ioam_main;
43 extern ip6_main_t ip6_main;
45 #define foreach_ip6_hop_by_hop_ioam_trace_stats \
46 _(PROCESSED, "Pkts with ip6 hop-by-hop trace options") \
47 _(PROFILE_MISS, "Pkts with ip6 hop-by-hop trace options but no profile set") \
48 _(UPDATED, "Pkts with trace updated") \
49 _(FULL, "Pkts with trace options but no space")
51 static char *ip6_hop_by_hop_ioam_trace_stats_strings[] = {
52 #define _(sym,string) string,
53 foreach_ip6_hop_by_hop_ioam_trace_stats
59 #define _(sym,str) IP6_IOAM_TRACE_##sym,
60 foreach_ip6_hop_by_hop_ioam_trace_stats
62 IP6_IOAM_TRACE_N_STATS,
63 } ip6_ioam_trace_stats_t;
69 u64 counters[ARRAY_LEN (ip6_hop_by_hop_ioam_trace_stats_strings)];
72 vlib_main_t *vlib_main;
73 vnet_main_t *vnet_main;
74 } ip6_hop_by_hop_ioam_trace_main_t;
76 ip6_hop_by_hop_ioam_trace_main_t ip6_hop_by_hop_ioam_trace_main;
79 ip6_ioam_trace_stats_increment_counter (u32 counter_index, u64 increment)
81 ip6_hop_by_hop_ioam_trace_main_t *hm = &ip6_hop_by_hop_ioam_trace_main;
83 hm->counters[counter_index] += increment;
88 format_ioam_data_list_element (u8 * s, va_list * args)
90 u32 *elt = va_arg (*args, u32 *);
91 u8 *trace_type_p = va_arg (*args, u8 *);
92 u8 trace_type = *trace_type_p;
95 if (trace_type & BIT_TTL_NODEID)
97 u32 ttl_node_id_host_byte_order = clib_net_to_host_u32 (*elt);
98 s = format (s, "ttl 0x%x node id 0x%x ",
99 ttl_node_id_host_byte_order >> 24,
100 ttl_node_id_host_byte_order & 0x00FFFFFF);
105 if (trace_type & BIT_ING_INTERFACE && trace_type & BIT_ING_INTERFACE)
107 u32 ingress_host_byte_order = clib_net_to_host_u32 (*elt);
108 s = format (s, "ingress 0x%x egress 0x%x ",
109 ingress_host_byte_order >> 16,
110 ingress_host_byte_order & 0xFFFF);
114 if (trace_type & BIT_TIMESTAMP)
116 u32 ts_in_host_byte_order = clib_net_to_host_u32 (*elt);
117 s = format (s, "ts 0x%x \n", ts_in_host_byte_order);
121 if (trace_type & BIT_APPDATA)
123 u32 appdata_in_host_byte_order = clib_net_to_host_u32 (*elt);
124 s = format (s, "app 0x%x ", appdata_in_host_byte_order);
133 ioam_trace_get_sizeof_handler (u32 * result)
136 u8 trace_data_size = 0;
137 trace_profile *profile = NULL;
141 profile = trace_profile_find ();
143 if (PREDICT_FALSE (!profile))
145 ip6_ioam_trace_stats_increment_counter (IP6_IOAM_TRACE_PROFILE_MISS, 1);
149 trace_data_size = fetch_trace_data_size (profile->trace_type);
150 if (PREDICT_FALSE (trace_data_size == 0))
151 return VNET_API_ERROR_INVALID_VALUE;
153 if (PREDICT_FALSE (profile->num_elts * trace_data_size > 254))
154 return VNET_API_ERROR_INVALID_VALUE;
156 size += profile->num_elts * trace_data_size;
165 ip6_hop_by_hop_ioam_trace_rewrite_handler (u8 * rewrite_string,
168 ioam_trace_option_t *trace_option = NULL;
169 u8 trace_data_size = 0;
170 u8 trace_option_elts = 0;
171 trace_profile *profile = NULL;
174 profile = trace_profile_find ();
176 if (PREDICT_FALSE (!profile))
178 ip6_ioam_trace_stats_increment_counter (IP6_IOAM_TRACE_PROFILE_MISS, 1);
182 if (PREDICT_FALSE (!rewrite_string))
185 trace_option_elts = profile->num_elts;
186 trace_data_size = fetch_trace_data_size (profile->trace_type);
187 trace_option = (ioam_trace_option_t *) rewrite_string;
188 trace_option->hdr.type = HBH_OPTION_TYPE_IOAM_TRACE_DATA_LIST |
189 HBH_OPTION_TYPE_DATA_CHANGE_ENROUTE;
190 trace_option->hdr.length = 2 /*ioam_trace_type,data_list_elts_left */ +
191 trace_option_elts * trace_data_size;
192 trace_option->ioam_trace_type = profile->trace_type & TRACE_TYPE_MASK;
193 trace_option->data_list_elts_left = trace_option_elts;
195 sizeof (ioam_trace_option_t) + (trace_option_elts * trace_data_size);
202 ip6_hbh_ioam_trace_data_list_handler (vlib_buffer_t * b, ip6_header_t * ip,
203 ip6_hop_by_hop_option_t * opt)
205 ip6_main_t *im = &ip6_main;
206 ip_lookup_main_t *lm = &im->lookup_main;
207 ip6_hop_by_hop_ioam_main_t *hm = &ip6_hop_by_hop_ioam_main;
209 ioam_trace_option_t *trace = (ioam_trace_option_t *) opt;
210 u32 adj_index = vnet_buffer (b)->ip.adj_index[VLIB_TX];
211 ip_adjacency_t *adj = ip_get_adjacency (lm, adj_index);
215 trace_profile *profile = NULL;
218 profile = trace_profile_find ();
220 if (PREDICT_FALSE (!profile))
222 ip6_ioam_trace_stats_increment_counter (IP6_IOAM_TRACE_PROFILE_MISS, 1);
229 if (PREDICT_TRUE (trace->data_list_elts_left))
231 trace->data_list_elts_left--;
232 /* fetch_trace_data_size returns in bytes. Convert it to 4-bytes
233 * to skip to this node's location.
236 trace->data_list_elts_left *
237 fetch_trace_data_size (trace->ioam_trace_type) / 4;
238 elt = &trace->elts[elt_index];
239 if (trace->ioam_trace_type & BIT_TTL_NODEID)
242 clib_host_to_net_u32 ((ip->hop_limit << 24) | profile->node_id);
246 if (trace->ioam_trace_type & BIT_ING_INTERFACE)
249 (vnet_buffer (b)->sw_if_index[VLIB_RX] & 0xFFFF) << 16 |
250 (adj->rewrite_header.sw_if_index & 0xFFFF);
251 *elt = clib_host_to_net_u32 (*elt);
255 if (trace->ioam_trace_type & BIT_TIMESTAMP)
257 /* Send least significant 32 bits */
259 (f64) (((f64) hm->unix_time_0) +
260 (vlib_time_now (hm->vlib_main) - hm->vlib_time_0));
262 time_u64.as_u64 = time_f64 * trace_tsp_mul[profile->trace_tsp];
263 *elt = clib_host_to_net_u32 (time_u64.as_u32[0]);
267 if (trace->ioam_trace_type & BIT_APPDATA)
269 /* $$$ set elt0->app_data */
270 *elt = clib_host_to_net_u32 (profile->app_data);
273 ip6_ioam_trace_stats_increment_counter (IP6_IOAM_TRACE_UPDATED, 1);
277 ip6_ioam_trace_stats_increment_counter (IP6_IOAM_TRACE_FULL, 1);
283 ip6_hbh_ioam_trace_data_list_trace_handler (u8 * s,
284 ip6_hop_by_hop_option_t * opt)
286 ioam_trace_option_t *trace;
287 u8 trace_data_size_in_words = 0;
291 trace = (ioam_trace_option_t *) opt;
294 format (s, " Trace Type 0x%x , %d elts left ts msb(s) 0x%x\n",
295 trace->ioam_trace_type, trace->data_list_elts_left,
299 format (s, " Trace Type 0x%x , %d elts left\n", trace->ioam_trace_type,
300 trace->data_list_elts_left);
301 trace_data_size_in_words =
302 fetch_trace_data_size (trace->ioam_trace_type) / 4;
303 elt = &trace->elts[0];
304 while ((u8 *) elt < ((u8 *) (&trace->elts[0]) + trace->hdr.length - 2
305 /* -2 accounts for ioam_trace_type,elts_left */ ))
307 s = format (s, " [%d] %U\n", elt_index,
308 format_ioam_data_list_element,
309 elt, &trace->ioam_trace_type);
311 elt += trace_data_size_in_words;
317 static clib_error_t *
318 ip6_show_ioam_trace_cmd_fn (vlib_main_t * vm,
319 unformat_input_t * input,
320 vlib_cli_command_t * cmd)
322 ip6_hop_by_hop_ioam_trace_main_t *hm = &ip6_hop_by_hop_ioam_trace_main;
326 for (i = 0; i < IP6_IOAM_TRACE_N_STATS; i++)
329 format (s, " %s - %lu\n", ip6_hop_by_hop_ioam_trace_stats_strings[i],
333 vlib_cli_output (vm, "%v", s);
340 VLIB_CLI_COMMAND (ip6_show_ioam_trace_cmd, static) = {
341 .path = "show ioam trace",
342 .short_help = "iOAM trace statistics",
343 .function = ip6_show_ioam_trace_cmd_fn,
348 static clib_error_t *
349 ip6_hop_by_hop_ioam_trace_init (vlib_main_t * vm)
351 ip6_hop_by_hop_ioam_trace_main_t *hm = &ip6_hop_by_hop_ioam_trace_main;
354 if ((error = vlib_call_init_function (vm, ip_main_init)))
357 if ((error = vlib_call_init_function (vm, ip6_lookup_init)))
360 if ((error = vlib_call_init_function (vm, ip6_hop_by_hop_ioam_init)))
364 hm->vnet_main = vnet_get_main ();
365 memset (hm->counters, 0, sizeof (hm->counters));
368 if (ip6_hbh_register_option
369 (HBH_OPTION_TYPE_IOAM_TRACE_DATA_LIST,
370 ip6_hbh_ioam_trace_data_list_handler,
371 ip6_hbh_ioam_trace_data_list_trace_handler) < 0)
372 return (clib_error_create
373 ("registration of HBH_OPTION_TYPE_IOAM_TRACE_DATA_LIST failed"));
376 if (ip6_hbh_add_register_option (HBH_OPTION_TYPE_IOAM_TRACE_DATA_LIST,
377 sizeof (ioam_trace_option_t),
378 ip6_hop_by_hop_ioam_trace_rewrite_handler)
380 return (clib_error_create
381 ("registration of HBH_OPTION_TYPE_IOAM_TRACE_DATA_LIST for rewrite failed"));
387 VLIB_INIT_FUNCTION (ip6_hop_by_hop_ioam_trace_init);
390 * fd.io coding-style-patch-verification: ON
393 * eval: (c-set-style "gnu")