Add missing counters for P2P ethernet interfaces
[vpp.git] / src / vnet / ethernet / p2p_ethernet.c
1 /*
2  * p2p_ethernet.c: p2p ethernet
3  *
4  * Copyright (c) 2012 Cisco and/or its affiliates.
5  * Licensed under the Apache License, Version 2.0 (the "License");
6  * you may not use this file except in compliance with the License.
7  * You may obtain a copy of the License at:
8  *
9  *     http://www.apache.org/licenses/LICENSE-2.0
10  *
11  * Unless required by applicable law or agreed to in writing, software
12  * distributed under the License is distributed on an "AS IS" BASIS,
13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14  * See the License for the specific language governing permissions and
15  * limitations under the License.
16  */
17
18 #include <vppinfra/bihash_16_8.h>
19 #include <vnet/vnet.h>
20 #include <vnet/ethernet/p2p_ethernet.h>
21 #include <vnet/l2/l2_input.h>
22
23 p2p_ethernet_main_t p2p_main;
24
25 static void
26 create_p2pe_key (p2p_key_t * p2pe_key, u32 parent_if_index, u8 * client_mac)
27 {
28   clib_memcpy (p2pe_key->mac, client_mac, 6);
29   p2pe_key->pad1 = 0;
30   p2pe_key->hw_if_index = parent_if_index;
31   p2pe_key->pad2 = 0;
32 }
33
34 u32
35 p2p_ethernet_lookup (u32 parent_if_index, u8 * client_mac)
36 {
37   p2p_ethernet_main_t *p2pm = &p2p_main;
38   p2p_key_t p2pe_key;
39   uword *p;
40
41   create_p2pe_key (&p2pe_key, parent_if_index, client_mac);
42   p = hash_get_mem (p2pm->p2p_ethernet_by_key, &p2pe_key);
43   if (p)
44     return p[0];
45
46   return ~0;
47 }
48
49 int
50 p2p_ethernet_add_del (vlib_main_t * vm, u32 parent_if_index,
51                       u8 * client_mac, u32 p2pe_subif_id, int is_add,
52                       u32 * p2pe_if_index)
53 {
54   vnet_main_t *vnm = vnet_get_main ();
55   p2p_ethernet_main_t *p2pm = &p2p_main;
56   vnet_interface_main_t *im = &vnm->interface_main;
57
58   u32 p2pe_sw_if_index = ~0;
59   p2pe_sw_if_index = p2p_ethernet_lookup (parent_if_index, client_mac);
60
61   if (p2pe_if_index)
62     *p2pe_if_index = ~0;
63
64   if (is_add)
65     {
66       if (p2pe_sw_if_index == ~0)
67         {
68           vnet_hw_interface_t *hi;
69
70           hi = vnet_get_hw_interface (vnm, parent_if_index);
71           if (hi->bond_info == VNET_HW_INTERFACE_BOND_INFO_SLAVE)
72             return VNET_API_ERROR_BOND_SLAVE_NOT_ALLOWED;
73
74           u64 sup_and_sub_key =
75             ((u64) (hi->sw_if_index) << 32) | (u64) p2pe_subif_id;
76           uword *p;
77           p = hash_get_mem (im->sw_if_index_by_sup_and_sub, &sup_and_sub_key);
78           if (p)
79             {
80               if (CLIB_DEBUG > 0)
81                 clib_warning
82                   ("p2p ethernet sub-interface on sw_if_index %d with sub id %d already exists\n",
83                    hi->sw_if_index, p2pe_subif_id);
84               return VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
85             }
86           vnet_sw_interface_t template = {
87             .type = VNET_SW_INTERFACE_TYPE_P2P,
88             .flood_class = VNET_FLOOD_CLASS_NORMAL,
89             .sup_sw_if_index = hi->sw_if_index,
90             .sub.id = p2pe_subif_id
91           };
92
93           clib_memcpy (template.p2p.client_mac, client_mac,
94                        sizeof (template.p2p.client_mac));
95
96           if (vnet_create_sw_interface (vnm, &template, &p2pe_sw_if_index))
97             return VNET_API_ERROR_SUBIF_CREATE_FAILED;
98
99           /* Allocate counters for this interface. */
100           {
101             u32 i;
102
103             vnet_interface_counter_lock (im);
104
105             for (i = 0; i < vec_len (im->sw_if_counters); i++)
106               {
107                 vlib_validate_simple_counter (&im->sw_if_counters[i],
108                                               p2pe_sw_if_index);
109                 vlib_zero_simple_counter (&im->sw_if_counters[i],
110                                           p2pe_sw_if_index);
111               }
112
113             for (i = 0; i < vec_len (im->combined_sw_if_counters); i++)
114               {
115                 vlib_validate_combined_counter (&im->combined_sw_if_counters
116                                                 [i], p2pe_sw_if_index);
117                 vlib_zero_combined_counter (&im->combined_sw_if_counters[i],
118                                             p2pe_sw_if_index);
119               }
120
121             vnet_interface_counter_unlock (im);
122           }
123
124           vnet_interface_main_t *im = &vnm->interface_main;
125           sup_and_sub_key =
126             ((u64) (hi->sw_if_index) << 32) | (u64) p2pe_subif_id;
127           u64 *kp = clib_mem_alloc (sizeof (*kp));
128
129           *kp = sup_and_sub_key;
130           hash_set (hi->sub_interface_sw_if_index_by_id, p2pe_subif_id,
131                     p2pe_sw_if_index);
132           hash_set_mem (im->sw_if_index_by_sup_and_sub, kp, p2pe_sw_if_index);
133
134           p2p_key_t *p_p2pe_key;
135           p_p2pe_key = clib_mem_alloc (sizeof (*p_p2pe_key));
136           create_p2pe_key (p_p2pe_key, parent_if_index, client_mac);
137           hash_set_mem (p2pm->p2p_ethernet_by_key, p_p2pe_key,
138                         p2pe_sw_if_index);
139
140           if (p2pe_if_index)
141             *p2pe_if_index = p2pe_sw_if_index;
142
143           vec_validate (p2pm->p2p_ethernet_by_sw_if_index, parent_if_index);
144           if (p2pm->p2p_ethernet_by_sw_if_index[parent_if_index] == 0)
145             {
146               vnet_feature_enable_disable ("device-input",
147                                            "p2p-ethernet-input",
148                                            parent_if_index, 1, 0, 0);
149               /* Set promiscuous mode on the l2 interface */
150               ethernet_set_flags (vnm, parent_if_index,
151                                   ETHERNET_INTERFACE_FLAG_ACCEPT_ALL);
152
153             }
154           p2pm->p2p_ethernet_by_sw_if_index[parent_if_index]++;
155           /* set the interface mode */
156           set_int_l2_mode (vm, vnm, MODE_L3, p2pe_subif_id, 0, 0, 0, 0);
157           return 0;
158         }
159       return VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
160     }
161   else
162     {
163       if (p2pe_sw_if_index == ~0)
164         return VNET_API_ERROR_SUBIF_DOESNT_EXIST;
165       else
166         {
167           int rv = 0;
168           rv = vnet_delete_sub_interface (p2pe_sw_if_index);
169           if (!rv)
170             {
171               vec_validate (p2pm->p2p_ethernet_by_sw_if_index,
172                             parent_if_index);
173               if (p2pm->p2p_ethernet_by_sw_if_index[parent_if_index] == 1)
174                 {
175                   vnet_feature_enable_disable ("device-input",
176                                                "p2p-ethernet-input",
177                                                parent_if_index, 0, 0, 0);
178                   /* Disable promiscuous mode on the l2 interface */
179                   ethernet_set_flags (vnm, parent_if_index, 0);
180                 }
181               p2pm->p2p_ethernet_by_sw_if_index[parent_if_index]--;
182
183               /* Remove p2p_ethernet from hash map */
184               p2p_key_t *p_p2pe_key;
185               p_p2pe_key = clib_mem_alloc (sizeof (*p_p2pe_key));
186               create_p2pe_key (p_p2pe_key, parent_if_index, client_mac);
187               hash_unset_mem (p2pm->p2p_ethernet_by_key, p_p2pe_key);
188             }
189           return rv;
190         }
191     }
192 }
193
194 static clib_error_t *
195 vnet_p2p_ethernet_add_del (vlib_main_t * vm, unformat_input_t * input,
196                            vlib_cli_command_t * cmd)
197 {
198   vnet_main_t *vnm = vnet_get_main ();
199
200   int is_add = 1;
201   int remote_mac = 0;
202   u32 hw_if_index = ~0;
203   u32 sub_id = ~0;
204   u8 client_mac[6];
205
206   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
207     {
208       if (unformat
209           (input, "%U", unformat_vnet_hw_interface, vnm, &hw_if_index))
210         ;
211       else if (unformat (input, "%U", unformat_ethernet_address, &client_mac))
212         remote_mac = 1;
213       else if (unformat (input, "sub-id %d", &sub_id))
214         ;
215       else if (unformat (input, "del"))
216         is_add = 0;
217       else
218         break;
219     }
220
221   if (hw_if_index == ~0)
222     return clib_error_return (0, "Please specify parent interface ...");
223   if (!remote_mac)
224     return clib_error_return (0, "Please specify client MAC address ...");
225   if (sub_id == ~0 && is_add)
226     return clib_error_return (0, "Please specify sub-interface id ...");
227
228   u32 rv;
229   rv = p2p_ethernet_add_del (vm, hw_if_index, client_mac, sub_id, is_add, 0);
230   switch (rv)
231     {
232     case VNET_API_ERROR_BOND_SLAVE_NOT_ALLOWED:
233       return clib_error_return (0,
234                                 "not allowed as parent interface belongs to a BondEthernet interface");
235     case -1:
236       return clib_error_return (0,
237                                 "p2p ethernet for given parent interface and client mac already exists");
238     case -2:
239       return clib_error_return (0,
240                                 "couldn't create p2p ethernet subinterface");
241     case -3:
242       return clib_error_return (0,
243                                 "p2p ethernet for given parent interface and client mac doesn't exist");
244     default:
245       break;
246     }
247   return 0;
248 }
249
250 VLIB_CLI_COMMAND (p2p_ethernet_add_del_command, static) =
251 {
252 .path = "p2p_ethernet ",.function = vnet_p2p_ethernet_add_del,.short_help =
253     "p2p_ethernet <intfc> <mac-address> [sub-id <id> | del]",};
254
255 static clib_error_t *
256 p2p_ethernet_init (vlib_main_t * vm)
257 {
258   p2p_ethernet_main_t *p2pm = &p2p_main;
259
260   p2pm->vlib_main = vm;
261   p2pm->vnet_main = vnet_get_main ();
262   p2pm->p2p_ethernet_by_key =
263     hash_create_mem (0, sizeof (p2p_key_t), sizeof (uword));
264
265   return 0;
266 }
267
268 VLIB_INIT_FUNCTION (p2p_ethernet_init);
269
270 /*
271  * fd.io coding-style-patch-verification: ON
272  *
273  * Local Variables:
274  * eval: (c-set-style "gnu")
275  * End:
276  */