FIB path weight incorrect in dump (VPP-922)
[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                                    mp->mr_next_hop_preference,
210                                    ntohl (mp->mr_next_hop_via_label),
211                                    label_stack));
212 }
213
214 void
215 vl_api_mpls_route_add_del_t_handler (vl_api_mpls_route_add_del_t * mp)
216 {
217   vl_api_mpls_route_add_del_reply_t *rmp;
218   vnet_main_t *vnm;
219   int rv;
220
221   vnm = vnet_get_main ();
222   vnm->api_errno = 0;
223
224   rv = mpls_route_add_del_t_handler (vnm, mp);
225
226   rv = (rv == 0) ? vnm->api_errno : rv;
227
228   REPLY_MACRO (VL_API_MPLS_ROUTE_ADD_DEL_REPLY);
229 }
230
231 static void
232 vl_api_mpls_tunnel_add_del_t_handler (vl_api_mpls_tunnel_add_del_t * mp)
233 {
234   vl_api_mpls_tunnel_add_del_reply_t *rmp;
235   int rv = 0;
236   u32 tunnel_sw_if_index;
237   int ii;
238   fib_route_path_t rpath, *rpaths = NULL;
239
240   memset (&rpath, 0, sizeof (rpath));
241
242   stats_dslock_with_hint (1 /* release hint */ , 5 /* tag */ );
243
244   if (mp->mt_next_hop_proto_is_ip4)
245     {
246       rpath.frp_proto = FIB_PROTOCOL_IP4;
247       clib_memcpy (&rpath.frp_addr.ip4,
248                    mp->mt_next_hop, sizeof (rpath.frp_addr.ip4));
249     }
250   else
251     {
252       rpath.frp_proto = FIB_PROTOCOL_IP6;
253       clib_memcpy (&rpath.frp_addr.ip6,
254                    mp->mt_next_hop, sizeof (rpath.frp_addr.ip6));
255     }
256   rpath.frp_sw_if_index = ntohl (mp->mt_next_hop_sw_if_index);
257   rpath.frp_weight = 1;
258
259   if (mp->mt_is_add)
260     {
261       for (ii = 0; ii < mp->mt_next_hop_n_out_labels; ii++)
262         vec_add1 (rpath.frp_label_stack,
263                   ntohl (mp->mt_next_hop_out_label_stack[ii]));
264     }
265
266   vec_add1 (rpaths, rpath);
267
268   tunnel_sw_if_index = ntohl (mp->mt_sw_if_index);
269
270   if (mp->mt_is_add)
271     {
272       if (~0 == tunnel_sw_if_index)
273         tunnel_sw_if_index = vnet_mpls_tunnel_create (mp->mt_l2_only,
274                                                       mp->mt_is_multicast);
275       vnet_mpls_tunnel_path_add (tunnel_sw_if_index, rpaths);
276     }
277   else
278     {
279       tunnel_sw_if_index = ntohl (mp->mt_sw_if_index);
280       if (!vnet_mpls_tunnel_path_remove (tunnel_sw_if_index, rpaths))
281         vnet_mpls_tunnel_del (tunnel_sw_if_index);
282     }
283
284   vec_free (rpaths);
285
286   stats_dsunlock ();
287
288   /* *INDENT-OFF* */
289   REPLY_MACRO2(VL_API_MPLS_TUNNEL_ADD_DEL_REPLY,
290   ({
291     rmp->sw_if_index = ntohl(tunnel_sw_if_index);
292   }));
293   /* *INDENT-ON* */
294 }
295
296 typedef struct mpls_tunnel_send_walk_ctx_t_
297 {
298   unix_shared_memory_queue_t *q;
299   u32 index;
300   u32 context;
301 } mpls_tunnel_send_walk_ctx_t;
302
303 static void
304 send_mpls_tunnel_entry (u32 mti, void *arg)
305 {
306   fib_route_path_encode_t *api_rpaths, *api_rpath;
307   mpls_tunnel_send_walk_ctx_t *ctx;
308   vl_api_mpls_tunnel_details_t *mp;
309   const mpls_tunnel_t *mt;
310   vl_api_fib_path2_t *fp;
311   u32 n;
312
313   ctx = arg;
314
315   if (~0 != ctx->index && mti != ctx->index)
316     return;
317
318   mt = mpls_tunnel_get (mti);
319   n = fib_path_list_get_n_paths (mt->mt_path_list);
320
321   mp = vl_msg_api_alloc (sizeof (*mp) + n * sizeof (vl_api_fib_path2_t));
322   memset (mp, 0, sizeof (*mp) + n * sizeof (vl_api_fib_path2_t));
323
324   mp->_vl_msg_id = ntohs (VL_API_MPLS_TUNNEL_DETAILS);
325   mp->context = ctx->context;
326
327   mp->mt_tunnel_index = ntohl (mti);
328   mp->mt_count = ntohl (n);
329
330   fib_path_list_walk (mt->mt_path_list, fib_path_encode, &api_rpaths);
331
332   fp = mp->mt_paths;
333   vec_foreach (api_rpath, api_rpaths)
334   {
335     memset (fp, 0, sizeof (*fp));
336
337     fp->weight = api_rpath->rpath.frp_weight;
338     fp->preference = api_rpath->rpath.frp_preference;
339     fp->sw_if_index = htonl (api_rpath->rpath.frp_sw_if_index);
340     copy_fib_next_hop (api_rpath, fp);
341     fp++;
342   }
343
344   // FIXME
345   // memcpy (mp->mt_next_hop_out_labels,
346   //   mt->mt_label_stack, nlabels * sizeof (u32));
347
348
349   vl_msg_api_send_shmem (ctx->q, (u8 *) & mp);
350 }
351
352 static void
353 vl_api_mpls_tunnel_dump_t_handler (vl_api_mpls_tunnel_dump_t * mp)
354 {
355   unix_shared_memory_queue_t *q;
356
357   q = vl_api_client_index_to_input_queue (mp->client_index);
358   if (q == 0)
359     return;
360
361   mpls_tunnel_send_walk_ctx_t ctx = {
362     .q = q,
363     .index = ntohl (mp->tunnel_index),
364     .context = mp->context,
365   };
366   mpls_tunnel_walk (send_mpls_tunnel_entry, &ctx);
367 }
368
369 static void
370 send_mpls_fib_details (vpe_api_main_t * am,
371                        unix_shared_memory_queue_t * q,
372                        u32 table_id, u32 label, u32 eos,
373                        fib_route_path_encode_t * api_rpaths, u32 context)
374 {
375   vl_api_mpls_fib_details_t *mp;
376   fib_route_path_encode_t *api_rpath;
377   vl_api_fib_path2_t *fp;
378   int path_count;
379
380   path_count = vec_len (api_rpaths);
381   mp = vl_msg_api_alloc (sizeof (*mp) + path_count * sizeof (*fp));
382   if (!mp)
383     return;
384   memset (mp, 0, sizeof (*mp));
385   mp->_vl_msg_id = ntohs (VL_API_MPLS_FIB_DETAILS);
386   mp->context = context;
387
388   mp->table_id = htonl (table_id);
389   mp->eos_bit = eos;
390   mp->label = htonl (label);
391
392   mp->count = htonl (path_count);
393   fp = mp->path;
394   vec_foreach (api_rpath, api_rpaths)
395   {
396     memset (fp, 0, sizeof (*fp));
397     fp->weight = api_rpath->rpath.frp_weight;
398     fp->preference = api_rpath->rpath.frp_preference;
399     fp->sw_if_index = htonl (api_rpath->rpath.frp_sw_if_index);
400     copy_fib_next_hop (api_rpath, fp);
401     fp++;
402   }
403
404   vl_msg_api_send_shmem (q, (u8 *) & mp);
405 }
406
407 typedef struct vl_api_mpls_fib_dump_table_walk_ctx_t_
408 {
409   fib_node_index_t *lfeis;
410 } vl_api_mpls_fib_dump_table_walk_ctx_t;
411
412 static int
413 vl_api_mpls_fib_dump_table_walk (fib_node_index_t fei, void *arg)
414 {
415   vl_api_mpls_fib_dump_table_walk_ctx_t *ctx = arg;
416
417   vec_add1 (ctx->lfeis, fei);
418
419   return (1);
420 }
421
422 static void
423 vl_api_mpls_fib_dump_t_handler (vl_api_mpls_fib_dump_t * mp)
424 {
425   vpe_api_main_t *am = &vpe_api_main;
426   unix_shared_memory_queue_t *q;
427   mpls_main_t *mm = &mpls_main;
428   fib_table_t *fib_table;
429   mpls_fib_t *mpls_fib;
430   fib_node_index_t *lfeip = NULL;
431   fib_prefix_t pfx;
432   u32 fib_index;
433   fib_route_path_encode_t *api_rpaths;
434   vl_api_mpls_fib_dump_table_walk_ctx_t ctx = {
435     .lfeis = NULL,
436   };
437
438   q = vl_api_client_index_to_input_queue (mp->client_index);
439   if (q == 0)
440     return;
441
442   /* *INDENT-OFF* */
443   pool_foreach (mpls_fib, mm->mpls_fibs,
444   ({
445     mpls_fib_table_walk (mpls_fib,
446                          vl_api_mpls_fib_dump_table_walk,
447                          &ctx);
448   }));
449   /* *INDENT-ON* */
450   vec_sort_with_function (ctx.lfeis, fib_entry_cmp_for_sort);
451
452   vec_foreach (lfeip, ctx.lfeis)
453   {
454     fib_entry_get_prefix (*lfeip, &pfx);
455     fib_index = fib_entry_get_fib_index (*lfeip);
456     fib_table = fib_table_get (fib_index, pfx.fp_proto);
457     api_rpaths = NULL;
458     fib_entry_encode (*lfeip, &api_rpaths);
459     send_mpls_fib_details (am, q,
460                            fib_table->ft_table_id,
461                            pfx.fp_label, pfx.fp_eos, api_rpaths, mp->context);
462     vec_free (api_rpaths);
463   }
464
465   vec_free (ctx.lfeis);
466 }
467
468 /*
469  * mpls_api_hookup
470  * Add vpe's API message handlers to the table.
471  * vlib has alread mapped shared memory and
472  * added the client registration handlers.
473  * See .../vlib-api/vlibmemory/memclnt_vlib.c:memclnt_process()
474  */
475 #define vl_msg_name_crc_list
476 #include <vnet/vnet_all_api_h.h>
477 #undef vl_msg_name_crc_list
478
479 static void
480 setup_message_id_table (api_main_t * am)
481 {
482 #define _(id,n,crc) vl_msg_api_add_msg_name_crc (am, #n "_" #crc, id);
483   foreach_vl_msg_name_crc_mpls;
484 #undef _
485 }
486
487 static clib_error_t *
488 mpls_api_hookup (vlib_main_t * vm)
489 {
490   api_main_t *am = &api_main;
491
492 #define _(N,n)                                                  \
493     vl_msg_api_set_handlers(VL_API_##N, #n,                     \
494                            vl_api_##n##_t_handler,              \
495                            vl_noop_handler,                     \
496                            vl_api_##n##_t_endian,               \
497                            vl_api_##n##_t_print,                \
498                            sizeof(vl_api_##n##_t), 1);
499   foreach_vpe_api_msg;
500 #undef _
501
502   /*
503    * Trace space for 8 MPLS encap labels
504    */
505   am->api_trace_cfg[VL_API_MPLS_TUNNEL_ADD_DEL].size += 8 * sizeof (u32);
506
507   /*
508    * Set up the (msg_name, crc, message-id) table
509    */
510   setup_message_id_table (am);
511
512   return 0;
513 }
514
515 VLIB_API_INIT_FUNCTION (mpls_api_hookup);
516
517 /*
518  * fd.io coding-style-patch-verification: ON
519  *
520  * Local Variables:
521  * eval: (c-set-style "gnu")
522  * End:
523  */