MPLS Mcast
[vpp.git] / src / vnet / mpls / mpls_api.c
1 /*
2  *------------------------------------------------------------------
3  * mpls_api.c - mpls api
4  *
5  * Copyright (c) 2016 Cisco and/or its affiliates.
6  * Licensed under the Apache License, Version 2.0 (the "License");
7  * you may not use this file except in compliance with the License.
8  * You may obtain a copy of the License at:
9  *
10  *     http://www.apache.org/licenses/LICENSE-2.0
11  *
12  * Unless required by applicable law or agreed to in writing, software
13  * distributed under the License is distributed on an "AS IS" BASIS,
14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15  * See the License for the specific language governing permissions and
16  * limitations under the License.
17  *------------------------------------------------------------------
18  */
19
20 #include <vnet/vnet.h>
21 #include <vlibmemory/api.h>
22
23 #include <vnet/interface.h>
24 #include <vnet/api_errno.h>
25 #include <vnet/mpls/mpls.h>
26 #include <vnet/mpls/mpls_tunnel.h>
27 #include <vnet/fib/fib_table.h>
28 #include <vnet/fib/fib_api.h>
29 #include <vnet/fib/mpls_fib.h>
30 #include <vnet/fib/fib_path_list.h>
31
32 #include <vnet/vnet_msg_enum.h>
33
34 #define vl_typedefs             /* define message structures */
35 #include <vnet/vnet_all_api_h.h>
36 #undef vl_typedefs
37
38 #define vl_endianfun            /* define message structures */
39 #include <vnet/vnet_all_api_h.h>
40 #undef vl_endianfun
41
42 /* instantiate all the print functions we know about */
43 #define vl_print(handle, ...) vlib_cli_output (handle, __VA_ARGS__)
44 #define vl_printfun
45 #include <vnet/vnet_all_api_h.h>
46 #undef vl_printfun
47
48 #include <vlibapi/api_helper_macros.h>
49
50 #define foreach_vpe_api_msg                                 \
51 _(MPLS_IP_BIND_UNBIND, mpls_ip_bind_unbind)                 \
52 _(MPLS_ROUTE_ADD_DEL, mpls_route_add_del)                   \
53 _(MPLS_TUNNEL_ADD_DEL, mpls_tunnel_add_del)                 \
54 _(MPLS_TUNNEL_DUMP, mpls_tunnel_dump)                       \
55 _(MPLS_FIB_DUMP, mpls_fib_dump)
56
57 extern void stats_dslock_with_hint (int hint, int tag);
58 extern void stats_dsunlock (void);
59
60 static int
61 mpls_ip_bind_unbind_handler (vnet_main_t * vnm,
62                              vl_api_mpls_ip_bind_unbind_t * mp)
63 {
64   u32 mpls_fib_index, ip_fib_index;
65
66   mpls_fib_index =
67     fib_table_find (FIB_PROTOCOL_MPLS, ntohl (mp->mb_mpls_table_id));
68
69   if (~0 == mpls_fib_index)
70     {
71       if (mp->mb_create_table_if_needed)
72         {
73           mpls_fib_index =
74             fib_table_find_or_create_and_lock (FIB_PROTOCOL_MPLS,
75                                                ntohl (mp->mb_mpls_table_id));
76         }
77       else
78         return VNET_API_ERROR_NO_SUCH_FIB;
79     }
80
81   ip_fib_index = fib_table_find ((mp->mb_is_ip4 ?
82                                   FIB_PROTOCOL_IP4 :
83                                   FIB_PROTOCOL_IP6),
84                                  ntohl (mp->mb_ip_table_id));
85   if (~0 == ip_fib_index)
86     return VNET_API_ERROR_NO_SUCH_FIB;
87
88   fib_prefix_t pfx = {
89     .fp_len = mp->mb_address_length,
90   };
91
92   if (mp->mb_is_ip4)
93     {
94       pfx.fp_proto = FIB_PROTOCOL_IP4;
95       clib_memcpy (&pfx.fp_addr.ip4, mp->mb_address,
96                    sizeof (pfx.fp_addr.ip4));
97     }
98   else
99     {
100       pfx.fp_proto = FIB_PROTOCOL_IP6;
101       clib_memcpy (&pfx.fp_addr.ip6, mp->mb_address,
102                    sizeof (pfx.fp_addr.ip6));
103     }
104
105   if (mp->mb_is_bind)
106     fib_table_entry_local_label_add (ip_fib_index, &pfx,
107                                      ntohl (mp->mb_label));
108   else
109     fib_table_entry_local_label_remove (ip_fib_index, &pfx,
110                                         ntohl (mp->mb_label));
111
112   return (0);
113 }
114
115 void
116 vl_api_mpls_ip_bind_unbind_t_handler (vl_api_mpls_ip_bind_unbind_t * mp)
117 {
118   vl_api_mpls_ip_bind_unbind_reply_t *rmp;
119   vnet_main_t *vnm;
120   int rv;
121
122   vnm = vnet_get_main ();
123   vnm->api_errno = 0;
124
125   rv = mpls_ip_bind_unbind_handler (vnm, mp);
126   rv = (rv == 0) ? vnm->api_errno : rv;
127
128   REPLY_MACRO (VL_API_MPLS_IP_BIND_UNBIND_REPLY);
129 }
130
131 static int
132 mpls_route_add_del_t_handler (vnet_main_t * vnm,
133                               vl_api_mpls_route_add_del_t * mp)
134 {
135   u32 fib_index, next_hop_fib_index;
136   mpls_label_t *label_stack = NULL;
137   int rv, ii, n_labels;;
138
139   fib_prefix_t pfx = {
140     .fp_len = 21,
141     .fp_proto = FIB_PROTOCOL_MPLS,
142     .fp_eos = mp->mr_eos,
143     .fp_label = ntohl (mp->mr_label),
144   };
145   if (pfx.fp_eos)
146     {
147       if (mp->mr_next_hop_proto_is_ip4)
148         {
149           pfx.fp_payload_proto = DPO_PROTO_IP4;
150         }
151       else
152         {
153           pfx.fp_payload_proto = DPO_PROTO_IP6;
154         }
155     }
156   else
157     {
158       pfx.fp_payload_proto = DPO_PROTO_MPLS;
159     }
160
161   rv = add_del_route_check (FIB_PROTOCOL_MPLS,
162                             mp->mr_table_id,
163                             mp->mr_next_hop_sw_if_index,
164                             dpo_proto_to_fib (pfx.fp_payload_proto),
165                             mp->mr_next_hop_table_id,
166                             mp->mr_create_table_if_needed,
167                             mp->mr_is_rpf_id,
168                             &fib_index, &next_hop_fib_index);
169
170   if (0 != rv)
171     return (rv);
172
173   ip46_address_t nh;
174   memset (&nh, 0, sizeof (nh));
175
176   if (mp->mr_next_hop_proto_is_ip4)
177     memcpy (&nh.ip4, mp->mr_next_hop, sizeof (nh.ip4));
178   else
179     memcpy (&nh.ip6, mp->mr_next_hop, sizeof (nh.ip6));
180
181   n_labels = mp->mr_next_hop_n_out_labels;
182   if (n_labels == 0)
183     ;
184   else if (1 == n_labels)
185     vec_add1 (label_stack, ntohl (mp->mr_next_hop_out_label_stack[0]));
186   else
187     {
188       vec_validate (label_stack, n_labels - 1);
189       for (ii = 0; ii < n_labels; ii++)
190         label_stack[ii] = ntohl (mp->mr_next_hop_out_label_stack[ii]);
191     }
192
193   return (add_del_route_t_handler (mp->mr_is_multipath, mp->mr_is_add, 0,       // mp->is_drop,
194                                    0,   // mp->is_unreach,
195                                    0,   // mp->is_prohibit,
196                                    0,   // mp->is_local,
197                                    mp->mr_is_multicast,
198                                    mp->mr_is_classify,
199                                    mp->mr_classify_table_index,
200                                    mp->mr_is_resolve_host,
201                                    mp->mr_is_resolve_attached,
202                                    mp->mr_is_interface_rx,
203                                    mp->mr_is_rpf_id,
204                                    fib_index, &pfx,
205                                    mp->mr_next_hop_proto_is_ip4,
206                                    &nh, ntohl (mp->mr_next_hop_sw_if_index),
207                                    next_hop_fib_index,
208                                    mp->mr_next_hop_weight,
209                                    ntohl (mp->mr_next_hop_via_label),
210                                    label_stack));
211 }
212
213 void
214 vl_api_mpls_route_add_del_t_handler (vl_api_mpls_route_add_del_t * mp)
215 {
216   vl_api_mpls_route_add_del_reply_t *rmp;
217   vnet_main_t *vnm;
218   int rv;
219
220   vnm = vnet_get_main ();
221   vnm->api_errno = 0;
222
223   rv = mpls_route_add_del_t_handler (vnm, mp);
224
225   rv = (rv == 0) ? vnm->api_errno : rv;
226
227   REPLY_MACRO (VL_API_MPLS_ROUTE_ADD_DEL_REPLY);
228 }
229
230 static void
231 vl_api_mpls_tunnel_add_del_t_handler (vl_api_mpls_tunnel_add_del_t * mp)
232 {
233   vl_api_mpls_tunnel_add_del_reply_t *rmp;
234   int rv = 0;
235   u32 tunnel_sw_if_index;
236   int ii;
237   fib_route_path_t rpath, *rpaths = NULL;
238
239   memset (&rpath, 0, sizeof (rpath));
240
241   stats_dslock_with_hint (1 /* release hint */ , 5 /* tag */ );
242
243   if (mp->mt_next_hop_proto_is_ip4)
244     {
245       rpath.frp_proto = FIB_PROTOCOL_IP4;
246       clib_memcpy (&rpath.frp_addr.ip4,
247                    mp->mt_next_hop, sizeof (rpath.frp_addr.ip4));
248     }
249   else
250     {
251       rpath.frp_proto = FIB_PROTOCOL_IP6;
252       clib_memcpy (&rpath.frp_addr.ip6,
253                    mp->mt_next_hop, sizeof (rpath.frp_addr.ip6));
254     }
255   rpath.frp_sw_if_index = ntohl (mp->mt_next_hop_sw_if_index);
256   rpath.frp_weight = 1;
257
258   if (mp->mt_is_add)
259     {
260       for (ii = 0; ii < mp->mt_next_hop_n_out_labels; ii++)
261         vec_add1 (rpath.frp_label_stack,
262                   ntohl (mp->mt_next_hop_out_label_stack[ii]));
263     }
264
265   vec_add1 (rpaths, rpath);
266
267   tunnel_sw_if_index = ntohl (mp->mt_sw_if_index);
268
269   if (mp->mt_is_add)
270     {
271       if (~0 == tunnel_sw_if_index)
272         tunnel_sw_if_index = vnet_mpls_tunnel_create (mp->mt_l2_only,
273                                                       mp->mt_is_multicast);
274       vnet_mpls_tunnel_path_add (tunnel_sw_if_index, rpaths);
275     }
276   else
277     {
278       tunnel_sw_if_index = ntohl (mp->mt_sw_if_index);
279       if (!vnet_mpls_tunnel_path_remove (tunnel_sw_if_index, rpaths))
280         vnet_mpls_tunnel_del (tunnel_sw_if_index);
281     }
282
283   vec_free (rpaths);
284
285   stats_dsunlock ();
286
287   /* *INDENT-OFF* */
288   REPLY_MACRO2(VL_API_MPLS_TUNNEL_ADD_DEL_REPLY,
289   ({
290     rmp->sw_if_index = ntohl(tunnel_sw_if_index);
291   }));
292   /* *INDENT-ON* */
293 }
294
295 typedef struct mpls_tunnel_send_walk_ctx_t_
296 {
297   unix_shared_memory_queue_t *q;
298   u32 index;
299   u32 context;
300 } mpls_tunnel_send_walk_ctx_t;
301
302 static void
303 send_mpls_tunnel_entry (u32 mti, void *arg)
304 {
305   fib_route_path_encode_t *api_rpaths, *api_rpath;
306   mpls_tunnel_send_walk_ctx_t *ctx;
307   vl_api_mpls_tunnel_details_t *mp;
308   const mpls_tunnel_t *mt;
309   vl_api_fib_path2_t *fp;
310   u32 n;
311
312   ctx = arg;
313
314   if (~0 != ctx->index && mti != ctx->index)
315     return;
316
317   mt = mpls_tunnel_get (mti);
318   n = fib_path_list_get_n_paths (mt->mt_path_list);
319
320   mp = vl_msg_api_alloc (sizeof (*mp) + n * sizeof (vl_api_fib_path2_t));
321   memset (mp, 0, sizeof (*mp) + n * sizeof (vl_api_fib_path2_t));
322
323   mp->_vl_msg_id = ntohs (VL_API_MPLS_TUNNEL_DETAILS);
324   mp->context = ctx->context;
325
326   mp->mt_tunnel_index = ntohl (mti);
327   mp->mt_count = ntohl (n);
328
329   fib_path_list_walk (mt->mt_path_list, fib_path_encode, &api_rpaths);
330
331   fp = mp->mt_paths;
332   vec_foreach (api_rpath, api_rpaths)
333   {
334     memset (fp, 0, sizeof (*fp));
335
336     fp->weight = htonl (api_rpath->rpath.frp_weight);
337     fp->sw_if_index = htonl (api_rpath->rpath.frp_sw_if_index);
338     copy_fib_next_hop (api_rpath, fp);
339     fp++;
340   }
341
342   // FIXME
343   // memcpy (mp->mt_next_hop_out_labels,
344   //   mt->mt_label_stack, nlabels * sizeof (u32));
345
346
347   vl_msg_api_send_shmem (ctx->q, (u8 *) & mp);
348 }
349
350 static void
351 vl_api_mpls_tunnel_dump_t_handler (vl_api_mpls_tunnel_dump_t * mp)
352 {
353   unix_shared_memory_queue_t *q;
354
355   q = vl_api_client_index_to_input_queue (mp->client_index);
356   if (q == 0)
357     return;
358
359   mpls_tunnel_send_walk_ctx_t ctx = {
360     .q = q,
361     .index = ntohl (mp->tunnel_index),
362     .context = mp->context,
363   };
364   mpls_tunnel_walk (send_mpls_tunnel_entry, &ctx);
365 }
366
367 static void
368 send_mpls_fib_details (vpe_api_main_t * am,
369                        unix_shared_memory_queue_t * q,
370                        u32 table_id, u32 label, u32 eos,
371                        fib_route_path_encode_t * api_rpaths, u32 context)
372 {
373   vl_api_mpls_fib_details_t *mp;
374   fib_route_path_encode_t *api_rpath;
375   vl_api_fib_path2_t *fp;
376   int path_count;
377
378   path_count = vec_len (api_rpaths);
379   mp = vl_msg_api_alloc (sizeof (*mp) + path_count * sizeof (*fp));
380   if (!mp)
381     return;
382   memset (mp, 0, sizeof (*mp));
383   mp->_vl_msg_id = ntohs (VL_API_MPLS_FIB_DETAILS);
384   mp->context = context;
385
386   mp->table_id = htonl (table_id);
387   mp->eos_bit = eos;
388   mp->label = htonl (label);
389
390   mp->count = htonl (path_count);
391   fp = mp->path;
392   vec_foreach (api_rpath, api_rpaths)
393   {
394     memset (fp, 0, sizeof (*fp));
395     fp->weight = htonl (api_rpath->rpath.frp_weight);
396     fp->sw_if_index = htonl (api_rpath->rpath.frp_sw_if_index);
397     copy_fib_next_hop (api_rpath, fp);
398     fp++;
399   }
400
401   vl_msg_api_send_shmem (q, (u8 *) & mp);
402 }
403
404 typedef struct vl_api_mpls_fib_dump_table_walk_ctx_t_
405 {
406   fib_node_index_t *lfeis;
407 } vl_api_mpls_fib_dump_table_walk_ctx_t;
408
409 static int
410 vl_api_mpls_fib_dump_table_walk (fib_node_index_t fei, void *arg)
411 {
412   vl_api_mpls_fib_dump_table_walk_ctx_t *ctx = arg;
413
414   vec_add1 (ctx->lfeis, fei);
415
416   return (1);
417 }
418
419 static void
420 vl_api_mpls_fib_dump_t_handler (vl_api_mpls_fib_dump_t * mp)
421 {
422   vpe_api_main_t *am = &vpe_api_main;
423   unix_shared_memory_queue_t *q;
424   mpls_main_t *mm = &mpls_main;
425   fib_table_t *fib_table;
426   mpls_fib_t *mpls_fib;
427   fib_node_index_t *lfeip = NULL;
428   fib_prefix_t pfx;
429   u32 fib_index;
430   fib_route_path_encode_t *api_rpaths;
431   vl_api_mpls_fib_dump_table_walk_ctx_t ctx = {
432     .lfeis = NULL,
433   };
434
435   q = vl_api_client_index_to_input_queue (mp->client_index);
436   if (q == 0)
437     return;
438
439   /* *INDENT-OFF* */
440   pool_foreach (mpls_fib, mm->mpls_fibs,
441   ({
442     mpls_fib_table_walk (mpls_fib,
443                          vl_api_mpls_fib_dump_table_walk,
444                          &ctx);
445   }));
446   /* *INDENT-ON* */
447   vec_sort_with_function (ctx.lfeis, fib_entry_cmp_for_sort);
448
449   vec_foreach (lfeip, ctx.lfeis)
450   {
451     fib_entry_get_prefix (*lfeip, &pfx);
452     fib_index = fib_entry_get_fib_index (*lfeip);
453     fib_table = fib_table_get (fib_index, pfx.fp_proto);
454     api_rpaths = NULL;
455     fib_entry_encode (*lfeip, &api_rpaths);
456     send_mpls_fib_details (am, q,
457                            fib_table->ft_table_id,
458                            pfx.fp_label, pfx.fp_eos, api_rpaths, mp->context);
459     vec_free (api_rpaths);
460   }
461
462   vec_free (ctx.lfeis);
463 }
464
465 /*
466  * mpls_api_hookup
467  * Add vpe's API message handlers to the table.
468  * vlib has alread mapped shared memory and
469  * added the client registration handlers.
470  * See .../vlib-api/vlibmemory/memclnt_vlib.c:memclnt_process()
471  */
472 #define vl_msg_name_crc_list
473 #include <vnet/vnet_all_api_h.h>
474 #undef vl_msg_name_crc_list
475
476 static void
477 setup_message_id_table (api_main_t * am)
478 {
479 #define _(id,n,crc) vl_msg_api_add_msg_name_crc (am, #n "_" #crc, id);
480   foreach_vl_msg_name_crc_mpls;
481 #undef _
482 }
483
484 static clib_error_t *
485 mpls_api_hookup (vlib_main_t * vm)
486 {
487   api_main_t *am = &api_main;
488
489 #define _(N,n)                                                  \
490     vl_msg_api_set_handlers(VL_API_##N, #n,                     \
491                            vl_api_##n##_t_handler,              \
492                            vl_noop_handler,                     \
493                            vl_api_##n##_t_endian,               \
494                            vl_api_##n##_t_print,                \
495                            sizeof(vl_api_##n##_t), 1);
496   foreach_vpe_api_msg;
497 #undef _
498
499   /*
500    * Trace space for 8 MPLS encap labels
501    */
502   am->api_trace_cfg[VL_API_MPLS_TUNNEL_ADD_DEL].size += 8 * sizeof (u32);
503
504   /*
505    * Set up the (msg_name, crc, message-id) table
506    */
507   setup_message_id_table (am);
508
509   return 0;
510 }
511
512 VLIB_API_INIT_FUNCTION (mpls_api_hookup);
513
514 /*
515  * fd.io coding-style-patch-verification: ON
516  *
517  * Local Variables:
518  * eval: (c-set-style "gnu")
519  * End:
520  */