58714083fe4a286797b7122da0317c0837e28d88
[vpp.git] / src / plugins / ioam / encap / ip6_ioam_e2e.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
16 #include <vlib/vlib.h>
17 #include <vnet/vnet.h>
18 #include <vnet/pg/pg.h>
19 #include <vppinfra/error.h>
20
21 #include <vnet/ip/ip.h>
22
23 #include <vppinfra/hash.h>
24 #include <vppinfra/error.h>
25 #include <vppinfra/elog.h>
26
27 #include <vnet/ip/ip6_hop_by_hop.h>
28 #include "ip6_ioam_e2e.h"
29
30 ioam_e2e_main_t ioam_e2e_main;
31
32 static u8 * ioam_e2e_trace_handler (u8 * s,
33                                     ip6_hop_by_hop_option_t *opt)
34 {
35   ioam_e2e_option_t * e2e = (ioam_e2e_option_t *)opt;
36   u32 seqno = 0;
37
38   if (e2e)
39     {
40       seqno = clib_net_to_host_u32 (e2e->e2e_hdr.e2e_data);
41     }
42
43   s = format (s, "SeqNo = 0x%Lx", seqno);
44   return s;
45 }
46
47 int
48 ioam_e2e_config_handler (void *data, u8 disable)
49 {
50   int *analyse = data;
51
52   /* Register hanlders if enabled */
53   if (!disable)
54     {
55       /* If encap node register for encap handler */
56       if (0 == *analyse)
57         {
58           if (ip6_hbh_register_option(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE,
59                                       ioam_seqno_encap_handler,
60                                       ioam_e2e_trace_handler) < 0)
61             {
62               return (-1);
63             }
64         }
65       /* If analyze node then register for decap handler */
66       else
67         {
68           if (ip6_hbh_pop_register_option(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE,
69                                           ioam_seqno_decap_handler) < 0)
70             {
71               return (-1);
72             }
73         }
74       return 0;
75     }
76
77   /* UnRegister handlers */
78   (void) ip6_hbh_unregister_option(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE);
79   (void) ip6_hbh_pop_unregister_option(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE);
80   return 0;
81 }
82
83 int
84 ioam_e2e_rewrite_handler (u8 *rewrite_string,
85                           u8 *rewrite_size)
86 {
87   ioam_e2e_option_t *e2e_option;
88
89   if (rewrite_string && *rewrite_size == sizeof(ioam_e2e_option_t))
90     {
91       e2e_option = (ioam_e2e_option_t *)rewrite_string;
92       e2e_option->hdr.type = HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE
93           | HBH_OPTION_TYPE_SKIP_UNKNOWN;
94       e2e_option->hdr.length = sizeof (ioam_e2e_option_t) -
95           sizeof (ip6_hop_by_hop_option_t);
96       return(0);
97     }
98   return(-1);
99 }
100
101 u32
102 ioam_e2e_flow_handler (u32 ctx, u8 add)
103 {
104   ioam_e2e_data_t *data;
105   u16 i;
106
107   if (add)
108     {
109       pool_get(ioam_e2e_main.e2e_data, data);
110       data->flow_ctx =  ctx;
111       ioam_seqno_init_data(&data->seqno_data);
112       return ((u32) (data - ioam_e2e_main.e2e_data));
113     }
114
115   /* Delete case */
116   for (i = 0; i < vec_len(ioam_e2e_main.e2e_data); i++)
117     {
118       if (pool_is_free_index(ioam_e2e_main.e2e_data, i))
119         continue;
120
121       data = pool_elt_at_index(ioam_e2e_main.e2e_data, i);
122       if (data && (data->flow_ctx == ctx))
123         {
124           pool_put_index(ioam_e2e_main.e2e_data, i);
125           return (0);
126         }
127     }
128   return 0;
129 }
130
131 static clib_error_t *
132 ioam_show_e2e_cmd_fn (vlib_main_t * vm,
133                       unformat_input_t * input,
134                       vlib_cli_command_t * cmd)
135 {
136   ioam_e2e_data_t *e2e_data;
137   u8 *s = 0;
138   int i;
139
140   vec_reset_length(s);
141
142   s = format(0, "IOAM E2E information: \n");
143   for (i = 0; i < vec_len(ioam_e2e_main.e2e_data); i++)
144     {
145       if (pool_is_free_index(ioam_e2e_main.e2e_data, i))
146         continue;
147
148       e2e_data = pool_elt_at_index(ioam_e2e_main.e2e_data, i);
149       s = format(s, "Flow name: %s\n", get_flow_name_from_flow_ctx(e2e_data->flow_ctx));
150
151       s = show_ioam_seqno_cmd_fn(s,
152                                  &e2e_data->seqno_data,
153                                  !IOAM_DEAP_ENABLED(e2e_data->flow_ctx));
154     }
155
156   vlib_cli_output(vm, "%v", s);
157   return 0;
158 }
159
160
161 VLIB_CLI_COMMAND (ioam_show_e2e_cmd, static) = {
162     .path = "show ioam e2e ",
163     .short_help = "show ioam e2e information",
164     .function = ioam_show_e2e_cmd_fn,
165 };
166
167 /*
168  * Init handler E2E headet handling.
169  * Init hanlder registers encap, decap, trace and Rewrite handlers.
170  */
171 static clib_error_t *
172 ioam_e2e_init (vlib_main_t * vm)
173 {
174   /*
175    * As of now we have only PPC under E2E header.
176    */
177   if (ip6_hbh_config_handler_register(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE,
178                                       ioam_e2e_config_handler) < 0)
179     {
180       return (clib_error_create("Registration of "
181           "HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE for rewrite failed"));
182     }
183
184   if (ip6_hbh_add_register_option(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE,
185                                   sizeof(ioam_e2e_option_t),
186                                   ioam_e2e_rewrite_handler) < 0)
187     {
188       return (clib_error_create("Registration of "
189           "HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE for rewrite failed"));
190     }
191
192   if (ip6_hbh_flow_handler_register(HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE,
193                                     ioam_e2e_flow_handler) < 0)
194     {
195       return (clib_error_create("Registration of "
196           "HBH_OPTION_TYPE_IOAM_EDGE_TO_EDGE Flow handler failed"));
197     }
198
199   ioam_e2e_main.vlib_main = vm;
200   ioam_e2e_main.vnet_main = vnet_get_main();
201
202   return (0);
203 }
204
205 /*
206  * Init function for the E2E lib.
207  * ip6_hop_by_hop_ioam_e2e_init gets called during init.
208  */
209 /* *INDENT-OFF* */
210 VLIB_INIT_FUNCTION (ioam_e2e_init) =
211 {
212     .runs_after = VLIB_INITS("ip6_hop_by_hop_ioam_init"),
213 };
214 /* *INDENT-ON* */