]> git.proxmox.com Git - mirror_frr.git/blob - zebra/zebra_mpls.c
projects / mirror_frr.git / blob
? search:


c19aeb626068a4dcb5e7029f1864eb6a6bfd6e1a
[mirror_frr.git] / zebra / zebra_mpls.c
1 /* Zebra MPLS code
2 * Copyright (C) 2013 Cumulus Networks, Inc.
3 *
4 * This file is part of GNU Zebra.
5 *
6 * GNU Zebra is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the
8 * Free Software Foundation; either version 2, or (at your option) any
9 * later version.
10 *
11 * GNU Zebra is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; see the file COPYING; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
19 */
20
21 #include <zebra.h>
22
23 #include "prefix.h"
24 #include "table.h"
25 #include "memory.h"
26 #include "command.h"
27 #include "if.h"
28 #include "log.h"
29 #include "sockunion.h"
30 #include "linklist.h"
31 #include "thread.h"
32 #include "workqueue.h"
33 #include "prefix.h"
34 #include "routemap.h"
35 #include "stream.h"
36 #include "nexthop.h"
37 #include "lib/json.h"
38
39 #include "zebra/rib.h"
40 #include "zebra/rt.h"
41 #include "zebra/interface.h"
42 #include "zebra/zserv.h"
43 #include "zebra/redistribute.h"
44 #include "zebra/debug.h"
45 #include "zebra/zebra_memory.h"
46 #include "zebra/zebra_vrf.h"
47 #include "zebra/zebra_mpls.h"
48 #include "zebra/zebra_errors.h"
49
50 DEFINE_MTYPE_STATIC(ZEBRA, LSP, "MPLS LSP object")
51 DEFINE_MTYPE_STATIC(ZEBRA, FEC, "MPLS FEC object")
52 DEFINE_MTYPE_STATIC(ZEBRA, SLSP, "MPLS static LSP config")
53 DEFINE_MTYPE_STATIC(ZEBRA, NHLFE, "MPLS nexthop object")
54 DEFINE_MTYPE_STATIC(ZEBRA, SNHLFE, "MPLS static nexthop object")
55 DEFINE_MTYPE_STATIC(ZEBRA, SNHLFE_IFNAME, "MPLS static nexthop ifname")
56
57 int mpls_enabled;
58
59 /* Default rtm_table for all clients */
60 extern struct zebra_t zebrad;
61
62 /* static function declarations */
63
64 static void fec_evaluate(struct zebra_vrf *zvrf);
65 static uint32_t fec_derive_label_from_index(struct zebra_vrf *vrf,
66 zebra_fec_t *fec);
67 static int lsp_install(struct zebra_vrf *zvrf, mpls_label_t label,
68 struct route_node *rn, struct route_entry *re);
69 static int lsp_uninstall(struct zebra_vrf *zvrf, mpls_label_t label);
70 static int fec_change_update_lsp(struct zebra_vrf *zvrf, zebra_fec_t *fec,
71 mpls_label_t old_label);
72 static int fec_send(zebra_fec_t *fec, struct zserv *client);
73 static void fec_update_clients(zebra_fec_t *fec);
74 static void fec_print(zebra_fec_t *fec, struct vty *vty);
75 static zebra_fec_t *fec_find(struct route_table *table, struct prefix *p);
76 static zebra_fec_t *fec_add(struct route_table *table, struct prefix *p,
77 mpls_label_t label, uint32_t flags,
78 uint32_t label_index);
79 static int fec_del(zebra_fec_t *fec);
80
81 static unsigned int label_hash(void *p);
82 static int label_cmp(const void *p1, const void *p2);
83 static int nhlfe_nexthop_active_ipv4(zebra_nhlfe_t *nhlfe,
84 struct nexthop *nexthop);
85 static int nhlfe_nexthop_active_ipv6(zebra_nhlfe_t *nhlfe,
86 struct nexthop *nexthop);
87 static int nhlfe_nexthop_active(zebra_nhlfe_t *nhlfe);
88
89 static void lsp_select_best_nhlfe(zebra_lsp_t *lsp);
90 static void lsp_uninstall_from_kernel(struct hash_backet *backet, void *ctxt);
91 static void lsp_schedule(struct hash_backet *backet, void *ctxt);
92 static wq_item_status lsp_process(struct work_queue *wq, void *data);
93 static void lsp_processq_del(struct work_queue *wq, void *data);
94 static void lsp_processq_complete(struct work_queue *wq);
95 static int lsp_processq_add(zebra_lsp_t *lsp);
96 static void *lsp_alloc(void *p);
97
98 static char *nhlfe2str(zebra_nhlfe_t *nhlfe, char *buf, int size);
99 static int nhlfe_nhop_match(zebra_nhlfe_t *nhlfe, enum nexthop_types_t gtype,
100 union g_addr *gate, ifindex_t ifindex);
101 static zebra_nhlfe_t *nhlfe_find(zebra_lsp_t *lsp, enum lsp_types_t lsp_type,
102 enum nexthop_types_t gtype, union g_addr *gate,
103 ifindex_t ifindex);
104 static zebra_nhlfe_t *nhlfe_add(zebra_lsp_t *lsp, enum lsp_types_t lsp_type,
105 enum nexthop_types_t gtype, union g_addr *gate,
106 ifindex_t ifindex, mpls_label_t out_label);
107 static int nhlfe_del(zebra_nhlfe_t *snhlfe);
108 static void nhlfe_out_label_update(zebra_nhlfe_t *nhlfe,
109 struct mpls_label_stack *nh_label);
110 static int mpls_lsp_uninstall_all(struct hash *lsp_table, zebra_lsp_t *lsp,
111 enum lsp_types_t type);
112 static int mpls_static_lsp_uninstall_all(struct zebra_vrf *zvrf,
113 mpls_label_t in_label);
114 static void nhlfe_print(zebra_nhlfe_t *nhlfe, struct vty *vty);
115 static void lsp_print(zebra_lsp_t *lsp, void *ctxt);
116 static void *slsp_alloc(void *p);
117 static int snhlfe_match(zebra_snhlfe_t *snhlfe, enum nexthop_types_t gtype,
118 union g_addr *gate, ifindex_t ifindex);
119 static zebra_snhlfe_t *snhlfe_find(zebra_slsp_t *slsp,
120 enum nexthop_types_t gtype,
121 union g_addr *gate, ifindex_t ifindex);
122 static zebra_snhlfe_t *snhlfe_add(zebra_slsp_t *slsp,
123 enum nexthop_types_t gtype,
124 union g_addr *gate, ifindex_t ifindex,
125 mpls_label_t out_label);
126 static int snhlfe_del(zebra_snhlfe_t *snhlfe);
127 static int snhlfe_del_all(zebra_slsp_t *slsp);
128 static char *snhlfe2str(zebra_snhlfe_t *snhlfe, char *buf, int size);
129 static int mpls_processq_init(struct zebra_t *zebra);
130
131
132 /* Static functions */
133
134 /*
135 * Handle failure in LSP install, clear flags for NHLFE.
136 */
137 static void clear_nhlfe_installed(zebra_lsp_t *lsp)
138 {
139 zebra_nhlfe_t *nhlfe;
140 struct nexthop *nexthop;
141
142 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next) {
143 nexthop = nhlfe->nexthop;
144 if (!nexthop)
145 continue;
146
147 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
148 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB);
149 }
150 }
151
152 /*
153 * Install label forwarding entry based on labeled-route entry.
154 */
155 static int lsp_install(struct zebra_vrf *zvrf, mpls_label_t label,
156 struct route_node *rn, struct route_entry *re)
157 {
158 struct hash *lsp_table;
159 zebra_ile_t tmp_ile;
160 zebra_lsp_t *lsp;
161 zebra_nhlfe_t *nhlfe;
162 struct nexthop *nexthop;
163 enum lsp_types_t lsp_type;
164 char buf[BUFSIZ];
165 int added, changed;
166
167 /* Lookup table. */
168 lsp_table = zvrf->lsp_table;
169 if (!lsp_table)
170 return -1;
171
172 lsp_type = lsp_type_from_re_type(re->type);
173 added = changed = 0;
174
175 /* Locate or allocate LSP entry. */
176 tmp_ile.in_label = label;
177 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
178 if (!lsp)
179 return -1;
180
181 /* For each active nexthop, create NHLFE. Note that we deliberately skip
182 * recursive nexthops right now, because intermediate hops won't
183 * understand
184 * the label advertised by the recursive nexthop (plus we don't have the
185 * logic yet to push multiple labels).
186 */
187 for (nexthop = re->ng.nexthop; nexthop; nexthop = nexthop->next) {
188 /* Skip inactive and recursive entries. */
189 if (!CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE))
190 continue;
191 if (CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_RECURSIVE))
192 continue;
193
194 nhlfe = nhlfe_find(lsp, lsp_type, nexthop->type, &nexthop->gate,
195 nexthop->ifindex);
196 if (nhlfe) {
197 /* Clear deleted flag (in case it was set) */
198 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
199 if (nexthop_labels_match(nhlfe->nexthop, nexthop))
200 /* No change */
201 continue;
202
203
204 if (IS_ZEBRA_DEBUG_MPLS) {
205 nhlfe2str(nhlfe, buf, BUFSIZ);
206 zlog_debug(
207 "LSP in-label %u type %d nexthop %s "
208 "out-label changed",
209 lsp->ile.in_label, lsp_type, buf);
210 }
211
212 /* Update out label, trigger processing. */
213 nhlfe_out_label_update(nhlfe, nexthop->nh_label);
214 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
215 changed++;
216 } else {
217 /* Add LSP entry to this nexthop */
218 nhlfe = nhlfe_add(lsp, lsp_type, nexthop->type,
219 &nexthop->gate, nexthop->ifindex,
220 nexthop->nh_label->label[0]);
221 if (!nhlfe)
222 return -1;
223
224 if (IS_ZEBRA_DEBUG_MPLS) {
225 nhlfe2str(nhlfe, buf, BUFSIZ);
226 zlog_debug(
227 "Add LSP in-label %u type %d nexthop %s "
228 "out-label %u",
229 lsp->ile.in_label, lsp_type, buf,
230 nexthop->nh_label->label[0]);
231 }
232
233 lsp->addr_family = NHLFE_FAMILY(nhlfe);
234
235 /* Mark NHLFE as changed. */
236 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
237 added++;
238 }
239 }
240
241 /* Queue LSP for processing if necessary. If no NHLFE got added (special
242 * case), delete the LSP entry; this case results in somewhat ugly
243 * logging.
244 */
245 if (added || changed) {
246 if (lsp_processq_add(lsp))
247 return -1;
248 } else if (!lsp->nhlfe_list
249 && !CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED)) {
250 if (IS_ZEBRA_DEBUG_MPLS)
251 zlog_debug("Free LSP in-label %u flags 0x%x",
252 lsp->ile.in_label, lsp->flags);
253
254 lsp = hash_release(lsp_table, &lsp->ile);
255 if (lsp)
256 XFREE(MTYPE_LSP, lsp);
257 }
258
259 return 0;
260 }
261
262 /*
263 * Uninstall all non-static NHLFEs of a label forwarding entry. If all
264 * NHLFEs are removed, the entire entry is deleted.
265 */
266 static int lsp_uninstall(struct zebra_vrf *zvrf, mpls_label_t label)
267 {
268 struct hash *lsp_table;
269 zebra_ile_t tmp_ile;
270 zebra_lsp_t *lsp;
271 zebra_nhlfe_t *nhlfe, *nhlfe_next;
272 char buf[BUFSIZ];
273
274 /* Lookup table. */
275 lsp_table = zvrf->lsp_table;
276 if (!lsp_table)
277 return -1;
278
279 /* If entry is not present, exit. */
280 tmp_ile.in_label = label;
281 lsp = hash_lookup(lsp_table, &tmp_ile);
282 if (!lsp || !lsp->nhlfe_list)
283 return 0;
284
285 /* Mark NHLFEs for delete or directly delete, as appropriate. */
286 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe_next) {
287 nhlfe_next = nhlfe->next;
288
289 /* Skip static NHLFEs */
290 if (nhlfe->type == ZEBRA_LSP_STATIC)
291 continue;
292
293 if (IS_ZEBRA_DEBUG_MPLS) {
294 nhlfe2str(nhlfe, buf, BUFSIZ);
295 zlog_debug(
296 "Del LSP in-label %u type %d nexthop %s flags 0x%x",
297 label, nhlfe->type, buf, nhlfe->flags);
298 }
299
300 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED)) {
301 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
302 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
303 } else {
304 nhlfe_del(nhlfe);
305 }
306 }
307
308 /* Queue LSP for processing, if needed, else delete. */
309 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED)) {
310 if (lsp_processq_add(lsp))
311 return -1;
312 } else if (!lsp->nhlfe_list
313 && !CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED)) {
314 if (IS_ZEBRA_DEBUG_MPLS)
315 zlog_debug("Del LSP in-label %u flags 0x%x",
316 lsp->ile.in_label, lsp->flags);
317
318 lsp = hash_release(lsp_table, &lsp->ile);
319 if (lsp)
320 XFREE(MTYPE_LSP, lsp);
321 }
322
323 return 0;
324 }
325
326 /*
327 * This function is invoked upon change to label block configuration; it
328 * will walk all registered FECs with label-index and appropriately update
329 * their local labels and trigger client updates.
330 */
331 static void fec_evaluate(struct zebra_vrf *zvrf)
332 {
333 struct route_node *rn;
334 zebra_fec_t *fec;
335 uint32_t old_label, new_label;
336 int af;
337 char buf[BUFSIZ];
338
339 for (af = AFI_IP; af < AFI_MAX; af++) {
340 if (zvrf->fec_table[af] == NULL)
341 continue;
342
343 for (rn = route_top(zvrf->fec_table[af]); rn;
344 rn = route_next(rn)) {
345 if ((fec = rn->info) == NULL)
346 continue;
347
348 /* Skip configured FECs and those without a label index.
349 */
350 if (fec->flags & FEC_FLAG_CONFIGURED
351 || fec->label_index == MPLS_INVALID_LABEL_INDEX)
352 continue;
353
354 if (IS_ZEBRA_DEBUG_MPLS)
355 prefix2str(&rn->p, buf, BUFSIZ);
356
357 /* Save old label, determine new label. */
358 old_label = fec->label;
359 new_label =
360 zvrf->mpls_srgb.start_label + fec->label_index;
361 if (new_label >= zvrf->mpls_srgb.end_label)
362 new_label = MPLS_INVALID_LABEL;
363
364 /* If label has changed, update FEC and clients. */
365 if (new_label == old_label)
366 continue;
367
368 if (IS_ZEBRA_DEBUG_MPLS)
369 zlog_debug(
370 "Update fec %s new label %u upon label block",
371 buf, new_label);
372
373 fec->label = new_label;
374 fec_update_clients(fec);
375
376 /* Update label forwarding entries appropriately */
377 fec_change_update_lsp(zvrf, fec, old_label);
378 }
379 }
380 }
381
382 /*
383 * Derive (if possible) and update the local label for the FEC based on
384 * its label index. The index is "acceptable" if it falls within the
385 * globally configured label block (SRGB).
386 */
387 static uint32_t fec_derive_label_from_index(struct zebra_vrf *zvrf,
388 zebra_fec_t *fec)
389 {
390 uint32_t label;
391
392 if (fec->label_index != MPLS_INVALID_LABEL_INDEX
393 && zvrf->mpls_srgb.start_label
394 && ((label = zvrf->mpls_srgb.start_label + fec->label_index)
395 < zvrf->mpls_srgb.end_label))
396 fec->label = label;
397 else
398 fec->label = MPLS_INVALID_LABEL;
399
400 return fec->label;
401 }
402
403 /*
404 * There is a change for this FEC. Install or uninstall label forwarding
405 * entries, as appropriate.
406 */
407 static int fec_change_update_lsp(struct zebra_vrf *zvrf, zebra_fec_t *fec,
408 mpls_label_t old_label)
409 {
410 struct route_table *table;
411 struct route_node *rn;
412 struct route_entry *re;
413 afi_t afi;
414
415 /* Uninstall label forwarding entry, if previously installed. */
416 if (old_label != MPLS_INVALID_LABEL
417 && old_label != MPLS_LABEL_IMPLICIT_NULL)
418 lsp_uninstall(zvrf, old_label);
419
420 /* Install label forwarding entry corr. to new label, if needed. */
421 if (fec->label == MPLS_INVALID_LABEL
422 || fec->label == MPLS_LABEL_IMPLICIT_NULL)
423 return 0;
424
425 afi = family2afi(PREFIX_FAMILY(&fec->rn->p));
426 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
427 if (!table)
428 return 0;
429
430 /* See if labeled route exists. */
431 rn = route_node_lookup(table, &fec->rn->p);
432 if (!rn)
433 return 0;
434
435 RNODE_FOREACH_RE (rn, re) {
436 if (CHECK_FLAG(re->flags, ZEBRA_FLAG_SELECTED))
437 break;
438 }
439
440 if (!re || !zebra_rib_labeled_unicast(re))
441 return 0;
442
443 if (lsp_install(zvrf, fec->label, rn, re))
444 return -1;
445
446 return 0;
447 }
448
449 /*
450 * Inform about FEC to a registered client.
451 */
452 static int fec_send(zebra_fec_t *fec, struct zserv *client)
453 {
454 struct stream *s;
455 struct route_node *rn;
456
457 rn = fec->rn;
458
459 /* Get output stream. */
460 s = stream_new(ZEBRA_MAX_PACKET_SIZ);
461
462 zclient_create_header(s, ZEBRA_FEC_UPDATE, VRF_DEFAULT);
463
464 stream_putw(s, rn->p.family);
465 stream_put_prefix(s, &rn->p);
466 stream_putl(s, fec->label);
467 stream_putw_at(s, 0, stream_get_endp(s));
468 return zserv_send_message(client, s);
469 }
470
471 /*
472 * Update all registered clients about this FEC. Caller should've updated
473 * FEC and ensure no duplicate updates.
474 */
475 static void fec_update_clients(zebra_fec_t *fec)
476 {
477 struct listnode *node;
478 struct zserv *client;
479
480 for (ALL_LIST_ELEMENTS_RO(fec->client_list, node, client)) {
481 if (IS_ZEBRA_DEBUG_MPLS)
482 zlog_debug("Update client %s",
483 zebra_route_string(client->proto));
484 fec_send(fec, client);
485 }
486 }
487
488
489 /*
490 * Print a FEC-label binding entry.
491 */
492 static void fec_print(zebra_fec_t *fec, struct vty *vty)
493 {
494 struct route_node *rn;
495 struct listnode *node;
496 struct zserv *client;
497 char buf[BUFSIZ];
498
499 rn = fec->rn;
500 prefix2str(&rn->p, buf, BUFSIZ);
501 vty_out(vty, "%s\n", buf);
502 vty_out(vty, " Label: %s", label2str(fec->label, buf, BUFSIZ));
503 if (fec->label_index != MPLS_INVALID_LABEL_INDEX)
504 vty_out(vty, ", Label Index: %u", fec->label_index);
505 vty_out(vty, "\n");
506 if (!list_isempty(fec->client_list)) {
507 vty_out(vty, " Client list:");
508 for (ALL_LIST_ELEMENTS_RO(fec->client_list, node, client))
509 vty_out(vty, " %s(fd %d)",
510 zebra_route_string(client->proto),
511 client->sock);
512 vty_out(vty, "\n");
513 }
514 }
515
516 /*
517 * Locate FEC-label binding that matches with passed info.
518 */
519 static zebra_fec_t *fec_find(struct route_table *table, struct prefix *p)
520 {
521 struct route_node *rn;
522
523 apply_mask(p);
524 rn = route_node_lookup(table, p);
525 if (!rn)
526 return NULL;
527
528 route_unlock_node(rn);
529 return (rn->info);
530 }
531
532 /*
533 * Add a FEC. This may be upon a client registering for a binding
534 * or when a binding is configured.
535 */
536 static zebra_fec_t *fec_add(struct route_table *table, struct prefix *p,
537 mpls_label_t label, uint32_t flags,
538 uint32_t label_index)
539 {
540 struct route_node *rn;
541 zebra_fec_t *fec;
542
543 apply_mask(p);
544
545 /* Lookup (or add) route node.*/
546 rn = route_node_get(table, p);
547 if (!rn)
548 return NULL;
549
550 fec = rn->info;
551
552 if (!fec) {
553 fec = XCALLOC(MTYPE_FEC, sizeof(zebra_fec_t));
554
555 rn->info = fec;
556 fec->rn = rn;
557 fec->label = label;
558 fec->client_list = list_new();
559 } else
560 route_unlock_node(rn); /* for the route_node_get */
561
562 fec->label_index = label_index;
563 fec->flags = flags;
564
565 return fec;
566 }
567
568 /*
569 * Delete a FEC. This may be upon the last client deregistering for
570 * a FEC and no binding exists or when the binding is deleted and there
571 * are no registered clients.
572 */
573 static int fec_del(zebra_fec_t *fec)
574 {
575 list_delete_and_null(&fec->client_list);
576 fec->rn->info = NULL;
577 route_unlock_node(fec->rn);
578 XFREE(MTYPE_FEC, fec);
579 return 0;
580 }
581
582 /*
583 * Hash function for label.
584 */
585 static unsigned int label_hash(void *p)
586 {
587 const zebra_ile_t *ile = p;
588
589 return (jhash_1word(ile->in_label, 0));
590 }
591
592 /*
593 * Compare 2 LSP hash entries based on in-label.
594 */
595 static int label_cmp(const void *p1, const void *p2)
596 {
597 const zebra_ile_t *ile1 = p1;
598 const zebra_ile_t *ile2 = p2;
599
600 return (ile1->in_label == ile2->in_label);
601 }
602
603 /*
604 * Check if an IPv4 nexthop for a NHLFE is active. Update nexthop based on
605 * the passed flag.
606 * NOTE: Looking only for connected routes right now.
607 */
608 static int nhlfe_nexthop_active_ipv4(zebra_nhlfe_t *nhlfe,
609 struct nexthop *nexthop)
610 {
611 struct route_table *table;
612 struct prefix_ipv4 p;
613 struct route_node *rn;
614 struct route_entry *match;
615 struct nexthop *match_nh;
616
617 table = zebra_vrf_table(AFI_IP, SAFI_UNICAST, nexthop->vrf_id);
618 if (!table)
619 return 0;
620
621 /* Lookup nexthop in IPv4 routing table. */
622 memset(&p, 0, sizeof(struct prefix_ipv4));
623 p.family = AF_INET;
624 p.prefixlen = IPV4_MAX_PREFIXLEN;
625 p.prefix = nexthop->gate.ipv4;
626
627 rn = route_node_match(table, (struct prefix *)&p);
628 if (!rn)
629 return 0;
630
631 route_unlock_node(rn);
632
633 /* Locate a valid connected route. */
634 RNODE_FOREACH_RE (rn, match) {
635 if (CHECK_FLAG(match->status, ROUTE_ENTRY_REMOVED)
636 || !CHECK_FLAG(match->flags, ZEBRA_FLAG_SELECTED))
637 continue;
638
639 for (match_nh = match->ng.nexthop; match_nh;
640 match_nh = match_nh->next) {
641 if (match->type == ZEBRA_ROUTE_CONNECT
642 || nexthop->ifindex == match_nh->ifindex) {
643 nexthop->ifindex = match_nh->ifindex;
644 return 1;
645 }
646 }
647 }
648
649 return 0;
650 }
651
652
653 /*
654 * Check if an IPv6 nexthop for a NHLFE is active. Update nexthop based on
655 * the passed flag.
656 * NOTE: Looking only for connected routes right now.
657 */
658 static int nhlfe_nexthop_active_ipv6(zebra_nhlfe_t *nhlfe,
659 struct nexthop *nexthop)
660 {
661 struct route_table *table;
662 struct prefix_ipv6 p;
663 struct route_node *rn;
664 struct route_entry *match;
665
666 table = zebra_vrf_table(AFI_IP6, SAFI_UNICAST, nexthop->vrf_id);
667 if (!table)
668 return 0;
669
670 /* Lookup nexthop in IPv6 routing table. */
671 memset(&p, 0, sizeof(struct prefix_ipv6));
672 p.family = AF_INET6;
673 p.prefixlen = IPV6_MAX_PREFIXLEN;
674 p.prefix = nexthop->gate.ipv6;
675
676 rn = route_node_match(table, (struct prefix *)&p);
677 if (!rn)
678 return 0;
679
680 route_unlock_node(rn);
681
682 /* Locate a valid connected route. */
683 RNODE_FOREACH_RE (rn, match) {
684 if ((match->type == ZEBRA_ROUTE_CONNECT)
685 && !CHECK_FLAG(match->status, ROUTE_ENTRY_REMOVED)
686 && CHECK_FLAG(match->flags, ZEBRA_FLAG_SELECTED))
687 break;
688 }
689
690 if (!match || !match->ng.nexthop)
691 return 0;
692
693 nexthop->ifindex = match->ng.nexthop->ifindex;
694 return 1;
695 }
696
697
698 /*
699 * Check the nexthop reachability for a NHLFE and return if valid (reachable)
700 * or not.
701 * NOTE: Each NHLFE points to only 1 nexthop.
702 */
703 static int nhlfe_nexthop_active(zebra_nhlfe_t *nhlfe)
704 {
705 struct nexthop *nexthop;
706 struct interface *ifp;
707 struct zebra_ns *zns;
708
709 nexthop = nhlfe->nexthop;
710 if (!nexthop) // unexpected
711 return 0;
712
713 /* Check on nexthop based on type. */
714 switch (nexthop->type) {
715 case NEXTHOP_TYPE_IFINDEX:
716 /*
717 * Lookup if this type is special. The
718 * NEXTHOP_TYPE_IFINDEX is a pop and
719 * forward into a different table for
720 * processing. As such this ifindex
721 * passed to us may be a VRF device
722 * which will not be in the default
723 * VRF. So let's look in all of them
724 */
725 zns = zebra_ns_lookup(NS_DEFAULT);
726 ifp = if_lookup_by_index_per_ns(zns, nexthop->ifindex);
727 if (ifp && if_is_operative(ifp))
728 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
729 else
730 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
731 break;
732 case NEXTHOP_TYPE_IPV4:
733 case NEXTHOP_TYPE_IPV4_IFINDEX:
734 if (nhlfe_nexthop_active_ipv4(nhlfe, nexthop))
735 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
736 else
737 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
738 break;
739
740 case NEXTHOP_TYPE_IPV6:
741 if (nhlfe_nexthop_active_ipv6(nhlfe, nexthop))
742 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
743 else
744 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
745 break;
746
747 case NEXTHOP_TYPE_IPV6_IFINDEX:
748 if (IN6_IS_ADDR_LINKLOCAL(&nexthop->gate.ipv6)) {
749 ifp = if_lookup_by_index(nexthop->ifindex,
750 nexthop->vrf_id);
751 if (ifp && if_is_operative(ifp))
752 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
753 else
754 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
755 } else {
756 if (nhlfe_nexthop_active_ipv6(nhlfe, nexthop))
757 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
758 else
759 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
760 }
761 break;
762
763 default:
764 break;
765 }
766
767 return CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
768 }
769
770 /*
771 * Walk through NHLFEs for a LSP forwarding entry, verify nexthop
772 * reachability and select the best. Multipath entries are also
773 * marked. This is invoked when an LSP scheduled for processing (due
774 * to some change) is examined.
775 */
776 static void lsp_select_best_nhlfe(zebra_lsp_t *lsp)
777 {
778 zebra_nhlfe_t *nhlfe;
779 zebra_nhlfe_t *best;
780 struct nexthop *nexthop;
781 int changed = 0;
782
783 if (!lsp)
784 return;
785
786 best = NULL;
787 lsp->num_ecmp = 0;
788 UNSET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
789
790 /*
791 * First compute the best path, after checking nexthop status. We are
792 * only
793 * concerned with non-deleted NHLFEs.
794 */
795 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next) {
796 /* Clear selection flags. */
797 UNSET_FLAG(nhlfe->flags,
798 (NHLFE_FLAG_SELECTED | NHLFE_FLAG_MULTIPATH));
799
800 if (!CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED)
801 && nhlfe_nexthop_active(nhlfe)) {
802 if (!best || (nhlfe->distance < best->distance))
803 best = nhlfe;
804 }
805 }
806
807 lsp->best_nhlfe = best;
808 if (!lsp->best_nhlfe)
809 return;
810
811 /* Mark best NHLFE as selected. */
812 SET_FLAG(lsp->best_nhlfe->flags, NHLFE_FLAG_SELECTED);
813
814 /*
815 * If best path exists, see if there is ECMP. While doing this, note if
816 * a
817 * new (uninstalled) NHLFE has been selected, an installed entry that is
818 * still selected has a change or an installed entry is to be removed.
819 */
820 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next) {
821 int nh_chg, nh_sel, nh_inst;
822
823 nexthop = nhlfe->nexthop;
824 if (!nexthop) // unexpected
825 continue;
826
827 if (!CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED)
828 && CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE)
829 && (nhlfe->distance == lsp->best_nhlfe->distance)) {
830 SET_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED);
831 SET_FLAG(nhlfe->flags, NHLFE_FLAG_MULTIPATH);
832 lsp->num_ecmp++;
833 }
834
835 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED) && !changed) {
836 nh_chg = CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
837 nh_sel = CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED);
838 nh_inst =
839 CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
840
841 if ((nh_sel && !nh_inst)
842 || (nh_sel && nh_inst && nh_chg)
843 || (nh_inst && !nh_sel))
844 changed = 1;
845 }
846
847 /* We have finished examining, clear changed flag. */
848 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
849 }
850
851 if (changed)
852 SET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
853 }
854
855 /*
856 * Delete LSP forwarding entry from kernel, if installed. Called upon
857 * process exit.
858 */
859 static void lsp_uninstall_from_kernel(struct hash_backet *backet, void *ctxt)
860 {
861 zebra_lsp_t *lsp;
862
863 lsp = (zebra_lsp_t *)backet->data;
864 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED))
865 (void)kernel_del_lsp(lsp);
866 }
867
868 /*
869 * Schedule LSP forwarding entry for processing. Called upon changes
870 * that may impact LSPs such as nexthop / connected route changes.
871 */
872 static void lsp_schedule(struct hash_backet *backet, void *ctxt)
873 {
874 zebra_lsp_t *lsp;
875
876 lsp = (zebra_lsp_t *)backet->data;
877 (void)lsp_processq_add(lsp);
878 }
879
880 /*
881 * Process a LSP entry that is in the queue. Recalculate best NHLFE and
882 * any multipaths and update or delete from the kernel, as needed.
883 */
884 static wq_item_status lsp_process(struct work_queue *wq, void *data)
885 {
886 zebra_lsp_t *lsp;
887 zebra_nhlfe_t *oldbest, *newbest;
888 char buf[BUFSIZ], buf2[BUFSIZ];
889 struct zebra_vrf *zvrf = vrf_info_lookup(VRF_DEFAULT);
890
891 lsp = (zebra_lsp_t *)data;
892 if (!lsp) // unexpected
893 return WQ_SUCCESS;
894
895 oldbest = lsp->best_nhlfe;
896
897 /* Select best NHLFE(s) */
898 lsp_select_best_nhlfe(lsp);
899
900 newbest = lsp->best_nhlfe;
901
902 if (IS_ZEBRA_DEBUG_MPLS) {
903 if (oldbest)
904 nhlfe2str(oldbest, buf, BUFSIZ);
905 if (newbest)
906 nhlfe2str(newbest, buf2, BUFSIZ);
907 zlog_debug(
908 "Process LSP in-label %u oldbest %s newbest %s "
909 "flags 0x%x ecmp# %d",
910 lsp->ile.in_label, oldbest ? buf : "NULL",
911 newbest ? buf2 : "NULL", lsp->flags, lsp->num_ecmp);
912 }
913
914 if (!CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED)) {
915 /* Not already installed */
916 if (newbest) {
917
918 UNSET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
919 switch (kernel_add_lsp(lsp)) {
920 case DP_REQUEST_QUEUED:
921 flog_err(
922 EC_ZEBRA_DP_INVALID_RC,
923 "No current DataPlane interfaces can return this, please fix");
924 break;
925 case DP_REQUEST_FAILURE:
926 break;
927 case DP_REQUEST_SUCCESS:
928 zvrf->lsp_installs++;
929 break;
930 }
931 }
932 } else {
933 /* Installed, may need an update and/or delete. */
934 if (!newbest) {
935
936 switch (kernel_del_lsp(lsp)) {
937 case DP_REQUEST_QUEUED:
938 flog_err(
939 EC_ZEBRA_DP_INVALID_RC,
940 "No current DataPlane interfaces can return this, please fix");
941 break;
942 case DP_REQUEST_FAILURE:
943 break;
944 case DP_REQUEST_SUCCESS:
945 zvrf->lsp_removals++;
946 break;
947 }
948 } else if (CHECK_FLAG(lsp->flags, LSP_FLAG_CHANGED)) {
949 zebra_nhlfe_t *nhlfe;
950 struct nexthop *nexthop;
951
952 UNSET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
953 UNSET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
954
955 /*
956 * Any NHLFE that was installed but is not
957 * selected now needs to have its flags updated.
958 */
959 for (nhlfe = lsp->nhlfe_list; nhlfe;
960 nhlfe = nhlfe->next) {
961 nexthop = nhlfe->nexthop;
962 if (!nexthop)
963 continue;
964
965 if (CHECK_FLAG(nhlfe->flags,
966 NHLFE_FLAG_INSTALLED)
967 && !CHECK_FLAG(nhlfe->flags,
968 NHLFE_FLAG_SELECTED)) {
969 UNSET_FLAG(nhlfe->flags,
970 NHLFE_FLAG_INSTALLED);
971 UNSET_FLAG(nexthop->flags,
972 NEXTHOP_FLAG_FIB);
973 }
974 }
975
976 switch (kernel_upd_lsp(lsp)) {
977 case DP_REQUEST_QUEUED:
978 flog_err(
979 EC_ZEBRA_DP_INVALID_RC,
980 "No current DataPlane interfaces can return this, please fix");
981 break;
982 case DP_REQUEST_FAILURE:
983 break;
984 case DP_REQUEST_SUCCESS:
985 zvrf->lsp_installs++;
986 break;
987 }
988 }
989 }
990
991 return WQ_SUCCESS;
992 }
993
994
995 /*
996 * Callback upon processing completion of a LSP forwarding entry.
997 */
998 static void lsp_processq_del(struct work_queue *wq, void *data)
999 {
1000 struct zebra_vrf *zvrf;
1001 zebra_lsp_t *lsp;
1002 struct hash *lsp_table;
1003 zebra_nhlfe_t *nhlfe, *nhlfe_next;
1004
1005 zvrf = vrf_info_lookup(VRF_DEFAULT);
1006 assert(zvrf);
1007
1008 lsp_table = zvrf->lsp_table;
1009 if (!lsp_table) // unexpected
1010 return;
1011
1012 lsp = (zebra_lsp_t *)data;
1013 if (!lsp) // unexpected
1014 return;
1015
1016 /* Clear flag, remove any NHLFEs marked for deletion. If no NHLFEs
1017 * exist,
1018 * delete LSP entry also.
1019 */
1020 UNSET_FLAG(lsp->flags, LSP_FLAG_SCHEDULED);
1021
1022 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe_next) {
1023 nhlfe_next = nhlfe->next;
1024 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED))
1025 nhlfe_del(nhlfe);
1026 }
1027
1028 if (!lsp->nhlfe_list) {
1029 if (IS_ZEBRA_DEBUG_MPLS)
1030 zlog_debug("Free LSP in-label %u flags 0x%x",
1031 lsp->ile.in_label, lsp->flags);
1032
1033 lsp = hash_release(lsp_table, &lsp->ile);
1034 if (lsp)
1035 XFREE(MTYPE_LSP, lsp);
1036 }
1037 }
1038
1039 /*
1040 * Callback upon finishing the processing of all scheduled
1041 * LSP forwarding entries.
1042 */
1043 static void lsp_processq_complete(struct work_queue *wq)
1044 {
1045 /* Nothing to do for now. */
1046 }
1047
1048 /*
1049 * Add LSP forwarding entry to queue for subsequent processing.
1050 */
1051 static int lsp_processq_add(zebra_lsp_t *lsp)
1052 {
1053 /* If already scheduled, exit. */
1054 if (CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED))
1055 return 0;
1056
1057 if (zebrad.lsp_process_q == NULL) {
1058 flog_err(EC_ZEBRA_WQ_NONEXISTENT,
1059 "%s: work_queue does not exist!", __func__);
1060 return -1;
1061 }
1062
1063 work_queue_add(zebrad.lsp_process_q, lsp);
1064 SET_FLAG(lsp->flags, LSP_FLAG_SCHEDULED);
1065 return 0;
1066 }
1067
1068 /*
1069 * Callback to allocate LSP forwarding table entry.
1070 */
1071 static void *lsp_alloc(void *p)
1072 {
1073 const zebra_ile_t *ile = p;
1074 zebra_lsp_t *lsp;
1075
1076 lsp = XCALLOC(MTYPE_LSP, sizeof(zebra_lsp_t));
1077 lsp->ile = *ile;
1078
1079 if (IS_ZEBRA_DEBUG_MPLS)
1080 zlog_debug("Alloc LSP in-label %u", lsp->ile.in_label);
1081
1082 return ((void *)lsp);
1083 }
1084
1085 /*
1086 * Create printable string for NHLFE entry.
1087 */
1088 static char *nhlfe2str(zebra_nhlfe_t *nhlfe, char *buf, int size)
1089 {
1090 struct nexthop *nexthop;
1091
1092 buf[0] = '\0';
1093 nexthop = nhlfe->nexthop;
1094 switch (nexthop->type) {
1095 case NEXTHOP_TYPE_IPV4:
1096 case NEXTHOP_TYPE_IPV4_IFINDEX:
1097 inet_ntop(AF_INET, &nexthop->gate.ipv4, buf, size);
1098 break;
1099 case NEXTHOP_TYPE_IPV6:
1100 inet_ntop(AF_INET6, &nexthop->gate.ipv6, buf, size);
1101 break;
1102 case NEXTHOP_TYPE_IFINDEX:
1103 snprintf(buf, size, "Ifindex: %u", nexthop->ifindex);
1104 default:
1105 break;
1106 }
1107
1108 return buf;
1109 }
1110
1111 /*
1112 * Check if NHLFE matches with search info passed.
1113 */
1114 static int nhlfe_nhop_match(zebra_nhlfe_t *nhlfe, enum nexthop_types_t gtype,
1115 union g_addr *gate, ifindex_t ifindex)
1116 {
1117 struct nexthop *nhop;
1118 int cmp = 1;
1119
1120 nhop = nhlfe->nexthop;
1121 if (!nhop)
1122 return 1;
1123
1124 if (nhop->type != gtype)
1125 return 1;
1126
1127 switch (nhop->type) {
1128 case NEXTHOP_TYPE_IPV4:
1129 case NEXTHOP_TYPE_IPV4_IFINDEX:
1130 cmp = memcmp(&(nhop->gate.ipv4), &(gate->ipv4),
1131 sizeof(struct in_addr));
1132 if (!cmp && nhop->type == NEXTHOP_TYPE_IPV4_IFINDEX)
1133 cmp = !(nhop->ifindex == ifindex);
1134 break;
1135 case NEXTHOP_TYPE_IPV6:
1136 case NEXTHOP_TYPE_IPV6_IFINDEX:
1137 cmp = memcmp(&(nhop->gate.ipv6), &(gate->ipv6),
1138 sizeof(struct in6_addr));
1139 if (!cmp && nhop->type == NEXTHOP_TYPE_IPV6_IFINDEX)
1140 cmp = !(nhop->ifindex == ifindex);
1141 break;
1142 case NEXTHOP_TYPE_IFINDEX:
1143 cmp = !(nhop->ifindex == ifindex);
1144 break;
1145 default:
1146 break;
1147 }
1148
1149 return cmp;
1150 }
1151
1152
1153 /*
1154 * Locate NHLFE that matches with passed info.
1155 */
1156 static zebra_nhlfe_t *nhlfe_find(zebra_lsp_t *lsp, enum lsp_types_t lsp_type,
1157 enum nexthop_types_t gtype, union g_addr *gate,
1158 ifindex_t ifindex)
1159 {
1160 zebra_nhlfe_t *nhlfe;
1161
1162 if (!lsp)
1163 return NULL;
1164
1165 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next) {
1166 if (nhlfe->type != lsp_type)
1167 continue;
1168 if (!nhlfe_nhop_match(nhlfe, gtype, gate, ifindex))
1169 break;
1170 }
1171
1172 return nhlfe;
1173 }
1174
1175 /*
1176 * Add NHLFE. Base entry must have been created and duplicate
1177 * check done.
1178 */
1179 static zebra_nhlfe_t *nhlfe_add(zebra_lsp_t *lsp, enum lsp_types_t lsp_type,
1180 enum nexthop_types_t gtype, union g_addr *gate,
1181 ifindex_t ifindex, mpls_label_t out_label)
1182 {
1183 zebra_nhlfe_t *nhlfe;
1184 struct nexthop *nexthop;
1185
1186 if (!lsp)
1187 return NULL;
1188
1189 nhlfe = XCALLOC(MTYPE_NHLFE, sizeof(zebra_nhlfe_t));
1190
1191 nhlfe->lsp = lsp;
1192 nhlfe->type = lsp_type;
1193 nhlfe->distance = lsp_distance(lsp_type);
1194
1195 nexthop = nexthop_new();
1196 if (!nexthop) {
1197 XFREE(MTYPE_NHLFE, nhlfe);
1198 return NULL;
1199 }
1200 nexthop_add_labels(nexthop, lsp_type, 1, &out_label);
1201
1202 nexthop->vrf_id = VRF_DEFAULT;
1203 nexthop->type = gtype;
1204 switch (nexthop->type) {
1205 case NEXTHOP_TYPE_IPV4:
1206 case NEXTHOP_TYPE_IPV4_IFINDEX:
1207 nexthop->gate.ipv4 = gate->ipv4;
1208 if (ifindex)
1209 nexthop->ifindex = ifindex;
1210 break;
1211 case NEXTHOP_TYPE_IPV6:
1212 case NEXTHOP_TYPE_IPV6_IFINDEX:
1213 nexthop->gate.ipv6 = gate->ipv6;
1214 if (ifindex)
1215 nexthop->ifindex = ifindex;
1216 break;
1217 case NEXTHOP_TYPE_IFINDEX:
1218 nexthop->ifindex = ifindex;
1219 break;
1220 default:
1221 nexthop_free(nexthop);
1222 XFREE(MTYPE_NHLFE, nhlfe);
1223 return NULL;
1224 break;
1225 }
1226
1227 nhlfe->nexthop = nexthop;
1228 if (lsp->nhlfe_list)
1229 lsp->nhlfe_list->prev = nhlfe;
1230 nhlfe->next = lsp->nhlfe_list;
1231 lsp->nhlfe_list = nhlfe;
1232
1233 return nhlfe;
1234 }
1235
1236 /*
1237 * Delete NHLFE. Entry must be present on list.
1238 */
1239 static int nhlfe_del(zebra_nhlfe_t *nhlfe)
1240 {
1241 zebra_lsp_t *lsp;
1242
1243 if (!nhlfe)
1244 return -1;
1245
1246 lsp = nhlfe->lsp;
1247 if (!lsp)
1248 return -1;
1249
1250 /* Free nexthop. */
1251 if (nhlfe->nexthop)
1252 nexthop_free(nhlfe->nexthop);
1253
1254 /* Unlink from LSP */
1255 if (nhlfe->next)
1256 nhlfe->next->prev = nhlfe->prev;
1257 if (nhlfe->prev)
1258 nhlfe->prev->next = nhlfe->next;
1259 else
1260 lsp->nhlfe_list = nhlfe->next;
1261
1262 if (nhlfe == lsp->best_nhlfe)
1263 lsp->best_nhlfe = NULL;
1264
1265 XFREE(MTYPE_NHLFE, nhlfe);
1266
1267 return 0;
1268 }
1269
1270 /*
1271 * Update label for NHLFE entry.
1272 */
1273 static void nhlfe_out_label_update(zebra_nhlfe_t *nhlfe,
1274 struct mpls_label_stack *nh_label)
1275 {
1276 nhlfe->nexthop->nh_label->label[0] = nh_label->label[0];
1277 }
1278
1279 static int mpls_lsp_uninstall_all(struct hash *lsp_table, zebra_lsp_t *lsp,
1280 enum lsp_types_t type)
1281 {
1282 zebra_nhlfe_t *nhlfe, *nhlfe_next;
1283 int schedule_lsp = 0;
1284 char buf[BUFSIZ];
1285
1286 /* Mark NHLFEs for delete or directly delete, as appropriate. */
1287 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe_next) {
1288 nhlfe_next = nhlfe->next;
1289
1290 /* Skip non-static NHLFEs */
1291 if (nhlfe->type != type)
1292 continue;
1293
1294 if (IS_ZEBRA_DEBUG_MPLS) {
1295 nhlfe2str(nhlfe, buf, BUFSIZ);
1296 zlog_debug(
1297 "Del LSP in-label %u type %d nexthop %s flags 0x%x",
1298 lsp->ile.in_label, type, buf, nhlfe->flags);
1299 }
1300
1301 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED)) {
1302 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
1303 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
1304 schedule_lsp = 1;
1305 } else {
1306 nhlfe_del(nhlfe);
1307 }
1308 }
1309
1310 /* Queue LSP for processing, if needed, else delete. */
1311 if (schedule_lsp) {
1312 if (lsp_processq_add(lsp))
1313 return -1;
1314 } else if (!lsp->nhlfe_list
1315 && !CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED)) {
1316 if (IS_ZEBRA_DEBUG_MPLS)
1317 zlog_debug("Free LSP in-label %u flags 0x%x",
1318 lsp->ile.in_label, lsp->flags);
1319
1320 lsp = hash_release(lsp_table, &lsp->ile);
1321 if (lsp)
1322 XFREE(MTYPE_LSP, lsp);
1323 }
1324
1325 return 0;
1326 }
1327
1328 /*
1329 * Uninstall all static NHLFEs for a particular LSP forwarding entry.
1330 * If no other NHLFEs exist, the entry would be deleted.
1331 */
1332 static int mpls_static_lsp_uninstall_all(struct zebra_vrf *zvrf,
1333 mpls_label_t in_label)
1334 {
1335 struct hash *lsp_table;
1336 zebra_ile_t tmp_ile;
1337 zebra_lsp_t *lsp;
1338
1339 /* Lookup table. */
1340 lsp_table = zvrf->lsp_table;
1341 if (!lsp_table)
1342 return -1;
1343
1344 /* If entry is not present, exit. */
1345 tmp_ile.in_label = in_label;
1346 lsp = hash_lookup(lsp_table, &tmp_ile);
1347 if (!lsp || !lsp->nhlfe_list)
1348 return 0;
1349
1350 return mpls_lsp_uninstall_all(lsp_table, lsp, ZEBRA_LSP_STATIC);
1351 }
1352
1353 static json_object *nhlfe_json(zebra_nhlfe_t *nhlfe)
1354 {
1355 char buf[BUFSIZ];
1356 json_object *json_nhlfe = NULL;
1357 struct nexthop *nexthop = nhlfe->nexthop;
1358
1359 json_nhlfe = json_object_new_object();
1360 json_object_string_add(json_nhlfe, "type", nhlfe_type2str(nhlfe->type));
1361 json_object_int_add(json_nhlfe, "outLabel",
1362 nexthop->nh_label->label[0]);
1363 json_object_int_add(json_nhlfe, "distance", nhlfe->distance);
1364
1365 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED))
1366 json_object_boolean_true_add(json_nhlfe, "installed");
1367
1368 switch (nexthop->type) {
1369 case NEXTHOP_TYPE_IPV4:
1370 case NEXTHOP_TYPE_IPV4_IFINDEX:
1371 json_object_string_add(json_nhlfe, "nexthop",
1372 inet_ntoa(nexthop->gate.ipv4));
1373 break;
1374 case NEXTHOP_TYPE_IPV6:
1375 case NEXTHOP_TYPE_IPV6_IFINDEX:
1376 json_object_string_add(
1377 json_nhlfe, "nexthop",
1378 inet_ntop(AF_INET6, &nexthop->gate.ipv6, buf, BUFSIZ));
1379
1380 if (nexthop->ifindex)
1381 json_object_string_add(json_nhlfe, "interface",
1382 ifindex2ifname(nexthop->ifindex,
1383 nexthop->vrf_id));
1384 break;
1385 default:
1386 break;
1387 }
1388 return json_nhlfe;
1389 }
1390
1391 /*
1392 * Print the NHLFE for a LSP forwarding entry.
1393 */
1394 static void nhlfe_print(zebra_nhlfe_t *nhlfe, struct vty *vty)
1395 {
1396 struct nexthop *nexthop;
1397 char buf[BUFSIZ];
1398
1399 nexthop = nhlfe->nexthop;
1400 if (!nexthop || !nexthop->nh_label) // unexpected
1401 return;
1402
1403 vty_out(vty, " type: %s remote label: %s distance: %d\n",
1404 nhlfe_type2str(nhlfe->type),
1405 label2str(nexthop->nh_label->label[0], buf, BUFSIZ),
1406 nhlfe->distance);
1407 switch (nexthop->type) {
1408 case NEXTHOP_TYPE_IPV4:
1409 case NEXTHOP_TYPE_IPV4_IFINDEX:
1410 vty_out(vty, " via %s", inet_ntoa(nexthop->gate.ipv4));
1411 if (nexthop->ifindex)
1412 vty_out(vty, " dev %s",
1413 ifindex2ifname(nexthop->ifindex,
1414 nexthop->vrf_id));
1415 break;
1416 case NEXTHOP_TYPE_IPV6:
1417 case NEXTHOP_TYPE_IPV6_IFINDEX:
1418 vty_out(vty, " via %s",
1419 inet_ntop(AF_INET6, &nexthop->gate.ipv6, buf, BUFSIZ));
1420 if (nexthop->ifindex)
1421 vty_out(vty, " dev %s",
1422 ifindex2ifname(nexthop->ifindex,
1423 nexthop->vrf_id));
1424 break;
1425 default:
1426 break;
1427 }
1428 vty_out(vty, "%s",
1429 CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED) ? " (installed)"
1430 : "");
1431 vty_out(vty, "\n");
1432 }
1433
1434 /*
1435 * Print an LSP forwarding entry.
1436 */
1437 static void lsp_print(zebra_lsp_t *lsp, void *ctxt)
1438 {
1439 zebra_nhlfe_t *nhlfe;
1440 struct vty *vty;
1441
1442 vty = (struct vty *)ctxt;
1443
1444 vty_out(vty, "Local label: %u%s\n", lsp->ile.in_label,
1445 CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED) ? " (installed)"
1446 : "");
1447
1448 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next)
1449 nhlfe_print(nhlfe, vty);
1450 }
1451
1452 /*
1453 * JSON objects for an LSP forwarding entry.
1454 */
1455 static json_object *lsp_json(zebra_lsp_t *lsp)
1456 {
1457 zebra_nhlfe_t *nhlfe = NULL;
1458 json_object *json = json_object_new_object();
1459 json_object *json_nhlfe_list = json_object_new_array();
1460
1461 json_object_int_add(json, "inLabel", lsp->ile.in_label);
1462
1463 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED))
1464 json_object_boolean_true_add(json, "installed");
1465
1466 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next)
1467 json_object_array_add(json_nhlfe_list, nhlfe_json(nhlfe));
1468
1469 json_object_object_add(json, "nexthops", json_nhlfe_list);
1470 return json;
1471 }
1472
1473
1474 /* Return a sorted linked list of the hash contents */
1475 static struct list *hash_get_sorted_list(struct hash *hash, void *cmp)
1476 {
1477 unsigned int i;
1478 struct hash_backet *hb;
1479 struct list *sorted_list = list_new();
1480
1481 sorted_list->cmp = (int (*)(void *, void *))cmp;
1482
1483 for (i = 0; i < hash->size; i++)
1484 for (hb = hash->index[i]; hb; hb = hb->next)
1485 listnode_add_sort(sorted_list, hb->data);
1486
1487 return sorted_list;
1488 }
1489
1490 /*
1491 * Compare two LSPs based on their label values.
1492 */
1493 static int lsp_cmp(zebra_lsp_t *lsp1, zebra_lsp_t *lsp2)
1494 {
1495 if (lsp1->ile.in_label < lsp2->ile.in_label)
1496 return -1;
1497
1498 if (lsp1->ile.in_label > lsp2->ile.in_label)
1499 return 1;
1500
1501 return 0;
1502 }
1503
1504 /*
1505 * Callback to allocate static LSP.
1506 */
1507 static void *slsp_alloc(void *p)
1508 {
1509 const zebra_ile_t *ile = p;
1510 zebra_slsp_t *slsp;
1511
1512 slsp = XCALLOC(MTYPE_SLSP, sizeof(zebra_slsp_t));
1513 slsp->ile = *ile;
1514 return ((void *)slsp);
1515 }
1516
1517 /*
1518 * Compare two static LSPs based on their label values.
1519 */
1520 static int slsp_cmp(zebra_slsp_t *slsp1, zebra_slsp_t *slsp2)
1521 {
1522 if (slsp1->ile.in_label < slsp2->ile.in_label)
1523 return -1;
1524
1525 if (slsp1->ile.in_label > slsp2->ile.in_label)
1526 return 1;
1527
1528 return 0;
1529 }
1530
1531 /*
1532 * Check if static NHLFE matches with search info passed.
1533 */
1534 static int snhlfe_match(zebra_snhlfe_t *snhlfe, enum nexthop_types_t gtype,
1535 union g_addr *gate, ifindex_t ifindex)
1536 {
1537 int cmp = 1;
1538
1539 if (snhlfe->gtype != gtype)
1540 return 1;
1541
1542 switch (snhlfe->gtype) {
1543 case NEXTHOP_TYPE_IPV4:
1544 cmp = memcmp(&(snhlfe->gate.ipv4), &(gate->ipv4),
1545 sizeof(struct in_addr));
1546 break;
1547 case NEXTHOP_TYPE_IPV6:
1548 case NEXTHOP_TYPE_IPV6_IFINDEX:
1549 cmp = memcmp(&(snhlfe->gate.ipv6), &(gate->ipv6),
1550 sizeof(struct in6_addr));
1551 if (!cmp && snhlfe->gtype == NEXTHOP_TYPE_IPV6_IFINDEX)
1552 cmp = !(snhlfe->ifindex == ifindex);
1553 break;
1554 default:
1555 break;
1556 }
1557
1558 return cmp;
1559 }
1560
1561 /*
1562 * Locate static NHLFE that matches with passed info.
1563 */
1564 static zebra_snhlfe_t *snhlfe_find(zebra_slsp_t *slsp,
1565 enum nexthop_types_t gtype,
1566 union g_addr *gate, ifindex_t ifindex)
1567 {
1568 zebra_snhlfe_t *snhlfe;
1569
1570 if (!slsp)
1571 return NULL;
1572
1573 for (snhlfe = slsp->snhlfe_list; snhlfe; snhlfe = snhlfe->next) {
1574 if (!snhlfe_match(snhlfe, gtype, gate, ifindex))
1575 break;
1576 }
1577
1578 return snhlfe;
1579 }
1580
1581
1582 /*
1583 * Add static NHLFE. Base LSP config entry must have been created
1584 * and duplicate check done.
1585 */
1586 static zebra_snhlfe_t *snhlfe_add(zebra_slsp_t *slsp,
1587 enum nexthop_types_t gtype,
1588 union g_addr *gate, ifindex_t ifindex,
1589 mpls_label_t out_label)
1590 {
1591 zebra_snhlfe_t *snhlfe;
1592
1593 if (!slsp)
1594 return NULL;
1595
1596 snhlfe = XCALLOC(MTYPE_SNHLFE, sizeof(zebra_snhlfe_t));
1597 snhlfe->slsp = slsp;
1598 snhlfe->out_label = out_label;
1599 snhlfe->gtype = gtype;
1600 switch (gtype) {
1601 case NEXTHOP_TYPE_IPV4:
1602 snhlfe->gate.ipv4 = gate->ipv4;
1603 break;
1604 case NEXTHOP_TYPE_IPV6:
1605 case NEXTHOP_TYPE_IPV6_IFINDEX:
1606 snhlfe->gate.ipv6 = gate->ipv6;
1607 if (ifindex)
1608 snhlfe->ifindex = ifindex;
1609 break;
1610 default:
1611 XFREE(MTYPE_SNHLFE, snhlfe);
1612 return NULL;
1613 }
1614
1615 if (slsp->snhlfe_list)
1616 slsp->snhlfe_list->prev = snhlfe;
1617 snhlfe->next = slsp->snhlfe_list;
1618 slsp->snhlfe_list = snhlfe;
1619
1620 return snhlfe;
1621 }
1622
1623 /*
1624 * Delete static NHLFE. Entry must be present on list.
1625 */
1626 static int snhlfe_del(zebra_snhlfe_t *snhlfe)
1627 {
1628 zebra_slsp_t *slsp;
1629
1630 if (!snhlfe)
1631 return -1;
1632
1633 slsp = snhlfe->slsp;
1634 if (!slsp)
1635 return -1;
1636
1637 if (snhlfe->next)
1638 snhlfe->next->prev = snhlfe->prev;
1639 if (snhlfe->prev)
1640 snhlfe->prev->next = snhlfe->next;
1641 else
1642 slsp->snhlfe_list = snhlfe->next;
1643
1644 snhlfe->prev = snhlfe->next = NULL;
1645 if (snhlfe->ifname)
1646 XFREE(MTYPE_SNHLFE_IFNAME, snhlfe->ifname);
1647 XFREE(MTYPE_SNHLFE, snhlfe);
1648
1649 return 0;
1650 }
1651
1652 /*
1653 * Delete all static NHLFE entries for this LSP (in label).
1654 */
1655 static int snhlfe_del_all(zebra_slsp_t *slsp)
1656 {
1657 zebra_snhlfe_t *snhlfe, *snhlfe_next;
1658
1659 if (!slsp)
1660 return -1;
1661
1662 for (snhlfe = slsp->snhlfe_list; snhlfe; snhlfe = snhlfe_next) {
1663 snhlfe_next = snhlfe->next;
1664 snhlfe_del(snhlfe);
1665 }
1666
1667 return 0;
1668 }
1669
1670 /*
1671 * Create printable string for NHLFE configuration.
1672 */
1673 static char *snhlfe2str(zebra_snhlfe_t *snhlfe, char *buf, int size)
1674 {
1675 buf[0] = '\0';
1676 switch (snhlfe->gtype) {
1677 case NEXTHOP_TYPE_IPV4:
1678 inet_ntop(AF_INET, &snhlfe->gate.ipv4, buf, size);
1679 break;
1680 case NEXTHOP_TYPE_IPV6:
1681 case NEXTHOP_TYPE_IPV6_IFINDEX:
1682 inet_ntop(AF_INET6, &snhlfe->gate.ipv6, buf, size);
1683 if (snhlfe->ifindex)
1684 strcat(buf,
1685 ifindex2ifname(snhlfe->ifindex, VRF_DEFAULT));
1686 break;
1687 default:
1688 break;
1689 }
1690
1691 return buf;
1692 }
1693
1694 /*
1695 * Initialize work queue for processing changed LSPs.
1696 */
1697 static int mpls_processq_init(struct zebra_t *zebra)
1698 {
1699 zebra->lsp_process_q = work_queue_new(zebra->master, "LSP processing");
1700 if (!zebra->lsp_process_q) {
1701 flog_err(EC_ZEBRA_WQ_NONEXISTENT,
1702 "%s: could not initialise work queue!", __func__);
1703 return -1;
1704 }
1705
1706 zebra->lsp_process_q->spec.workfunc = &lsp_process;
1707 zebra->lsp_process_q->spec.del_item_data = &lsp_processq_del;
1708 zebra->lsp_process_q->spec.errorfunc = NULL;
1709 zebra->lsp_process_q->spec.completion_func = &lsp_processq_complete;
1710 zebra->lsp_process_q->spec.max_retries = 0;
1711 zebra->lsp_process_q->spec.hold = 10;
1712
1713 return 0;
1714 }
1715
1716
1717 /* Public functions */
1718
1719 void kernel_lsp_pass_fail(zebra_lsp_t *lsp, enum dp_results res)
1720 {
1721 struct nexthop *nexthop;
1722 zebra_nhlfe_t *nhlfe;
1723
1724 if (!lsp)
1725 return;
1726
1727 switch (res) {
1728 case DP_INSTALL_FAILURE:
1729 UNSET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
1730 clear_nhlfe_installed(lsp);
1731 flog_warn(EC_ZEBRA_LSP_INSTALL_FAILURE,
1732 "LSP Install Failure: %u", lsp->ile.in_label);
1733 break;
1734 case DP_INSTALL_SUCCESS:
1735 SET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
1736 for (nhlfe = lsp->nhlfe_list; nhlfe; nhlfe = nhlfe->next) {
1737 nexthop = nhlfe->nexthop;
1738 if (!nexthop)
1739 continue;
1740
1741 SET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
1742 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB);
1743 }
1744 break;
1745 case DP_DELETE_SUCCESS:
1746 UNSET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
1747 clear_nhlfe_installed(lsp);
1748 break;
1749 case DP_DELETE_FAILURE:
1750 flog_warn(EC_ZEBRA_LSP_DELETE_FAILURE,
1751 "LSP Deletion Failure: %u", lsp->ile.in_label);
1752 break;
1753 }
1754 }
1755
1756 /*
1757 * Install dynamic LSP entry.
1758 */
1759 int zebra_mpls_lsp_install(struct zebra_vrf *zvrf, struct route_node *rn,
1760 struct route_entry *re)
1761 {
1762 struct route_table *table;
1763 zebra_fec_t *fec;
1764
1765 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(&rn->p))];
1766 if (!table)
1767 return -1;
1768
1769 /* See if there is a configured label binding for this FEC. */
1770 fec = fec_find(table, &rn->p);
1771 if (!fec || fec->label == MPLS_INVALID_LABEL)
1772 return 0;
1773
1774 /* We cannot install a label forwarding entry if local label is the
1775 * implicit-null label.
1776 */
1777 if (fec->label == MPLS_LABEL_IMPLICIT_NULL)
1778 return 0;
1779
1780 if (lsp_install(zvrf, fec->label, rn, re))
1781 return -1;
1782
1783 return 0;
1784 }
1785
1786 /*
1787 * Uninstall dynamic LSP entry, if any.
1788 */
1789 int zebra_mpls_lsp_uninstall(struct zebra_vrf *zvrf, struct route_node *rn,
1790 struct route_entry *re)
1791 {
1792 struct route_table *table;
1793 zebra_fec_t *fec;
1794
1795 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(&rn->p))];
1796 if (!table)
1797 return -1;
1798
1799 /* See if there is a configured label binding for this FEC. */
1800 fec = fec_find(table, &rn->p);
1801 if (!fec || fec->label == MPLS_INVALID_LABEL)
1802 return 0;
1803
1804 /* Uninstall always removes all dynamic NHLFEs. */
1805 return lsp_uninstall(zvrf, fec->label);
1806 }
1807
1808 /*
1809 * Registration from a client for the label binding for a FEC. If a binding
1810 * already exists, it is informed to the client.
1811 * NOTE: If there is a manually configured label binding, that is used.
1812 * Otherwise, if a label index is specified, it means we have to allocate the
1813 * label from a locally configured label block (SRGB), if one exists and index
1814 * is acceptable.
1815 */
1816 int zebra_mpls_fec_register(struct zebra_vrf *zvrf, struct prefix *p,
1817 uint32_t label_index, struct zserv *client)
1818 {
1819 struct route_table *table;
1820 zebra_fec_t *fec;
1821 char buf[BUFSIZ];
1822 int new_client;
1823 int label_change = 0;
1824 uint32_t old_label;
1825
1826 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
1827 if (!table)
1828 return -1;
1829
1830 if (IS_ZEBRA_DEBUG_MPLS)
1831 prefix2str(p, buf, BUFSIZ);
1832
1833 /* Locate FEC */
1834 fec = fec_find(table, p);
1835 if (!fec) {
1836 fec = fec_add(table, p, MPLS_INVALID_LABEL, 0, label_index);
1837 if (!fec) {
1838 prefix2str(p, buf, BUFSIZ);
1839 flog_err(
1840 EC_ZEBRA_FEC_ADD_FAILED,
1841 "Failed to add FEC %s upon register, client %s",
1842 buf, zebra_route_string(client->proto));
1843 return -1;
1844 }
1845
1846 old_label = MPLS_INVALID_LABEL;
1847 new_client = 1;
1848 } else {
1849 /* Client may register same FEC with different label index. */
1850 new_client =
1851 (listnode_lookup(fec->client_list, client) == NULL);
1852 if (!new_client && fec->label_index == label_index)
1853 /* Duplicate register */
1854 return 0;
1855
1856 /* Save current label, update label index */
1857 old_label = fec->label;
1858 fec->label_index = label_index;
1859 }
1860
1861 if (new_client)
1862 listnode_add(fec->client_list, client);
1863
1864 if (IS_ZEBRA_DEBUG_MPLS)
1865 zlog_debug("FEC %s Label Index %u %s by client %s", buf,
1866 label_index, new_client ? "registered" : "updated",
1867 zebra_route_string(client->proto));
1868
1869 /* If not a configured FEC, derive the local label (from label index)
1870 * or reset it.
1871 */
1872 if (!(fec->flags & FEC_FLAG_CONFIGURED)) {
1873 fec_derive_label_from_index(zvrf, fec);
1874
1875 /* If no label change, exit. */
1876 if (fec->label == old_label)
1877 return 0;
1878
1879 label_change = 1;
1880 }
1881
1882 /* If new client or label change, update client and install or uninstall
1883 * label forwarding entry as needed.
1884 */
1885 /* Inform client of label, if needed. */
1886 if ((new_client && fec->label != MPLS_INVALID_LABEL) || label_change) {
1887 if (IS_ZEBRA_DEBUG_MPLS)
1888 zlog_debug("Update client label %u", fec->label);
1889 fec_send(fec, client);
1890 }
1891
1892 if (new_client || label_change)
1893 return fec_change_update_lsp(zvrf, fec, old_label);
1894
1895 return 0;
1896 }
1897
1898 /*
1899 * Deregistration from a client for the label binding for a FEC. The FEC
1900 * itself is deleted if no other registered clients exist and there is no
1901 * label bound to the FEC.
1902 */
1903 int zebra_mpls_fec_unregister(struct zebra_vrf *zvrf, struct prefix *p,
1904 struct zserv *client)
1905 {
1906 struct route_table *table;
1907 zebra_fec_t *fec;
1908 char buf[BUFSIZ];
1909
1910 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
1911 if (!table)
1912 return -1;
1913
1914 if (IS_ZEBRA_DEBUG_MPLS)
1915 prefix2str(p, buf, BUFSIZ);
1916
1917 fec = fec_find(table, p);
1918 if (!fec) {
1919 prefix2str(p, buf, BUFSIZ);
1920 flog_err(EC_ZEBRA_FEC_RM_FAILED,
1921 "Failed to find FEC %s upon unregister, client %s",
1922 buf, zebra_route_string(client->proto));
1923 return -1;
1924 }
1925
1926 listnode_delete(fec->client_list, client);
1927
1928 if (IS_ZEBRA_DEBUG_MPLS)
1929 zlog_debug("FEC %s unregistered by client %s", buf,
1930 zebra_route_string(client->proto));
1931
1932 /* If not a configured entry, delete the FEC if no other clients. Before
1933 * deleting, see if any LSP needs to be uninstalled.
1934 */
1935 if (!(fec->flags & FEC_FLAG_CONFIGURED)
1936 && list_isempty(fec->client_list)) {
1937 mpls_label_t old_label = fec->label;
1938 fec->label = MPLS_INVALID_LABEL; /* reset */
1939 fec_change_update_lsp(zvrf, fec, old_label);
1940 fec_del(fec);
1941 }
1942
1943 return 0;
1944 }
1945
1946 /*
1947 * Cleanup any FECs registered by this client.
1948 */
1949 static int zebra_mpls_cleanup_fecs_for_client(struct zserv *client)
1950 {
1951 struct zebra_vrf *zvrf = vrf_info_lookup(VRF_DEFAULT);
1952 struct route_node *rn;
1953 zebra_fec_t *fec;
1954 struct listnode *node;
1955 struct zserv *fec_client;
1956 int af;
1957
1958 for (af = AFI_IP; af < AFI_MAX; af++) {
1959 if (zvrf->fec_table[af] == NULL)
1960 continue;
1961
1962 for (rn = route_top(zvrf->fec_table[af]); rn;
1963 rn = route_next(rn)) {
1964 fec = rn->info;
1965 if (!fec || list_isempty(fec->client_list))
1966 continue;
1967
1968 for (ALL_LIST_ELEMENTS_RO(fec->client_list, node,
1969 fec_client)) {
1970 if (fec_client == client) {
1971 listnode_delete(fec->client_list,
1972 fec_client);
1973 if (!(fec->flags & FEC_FLAG_CONFIGURED)
1974 && list_isempty(fec->client_list))
1975 fec_del(fec);
1976 break;
1977 }
1978 }
1979 }
1980 }
1981
1982 return 0;
1983 }
1984
1985 /*
1986 * Return FEC (if any) to which this label is bound.
1987 * Note: Only works for per-prefix binding and when the label is not
1988 * implicit-null.
1989 * TODO: Currently walks entire table, can optimize later with another
1990 * hash..
1991 */
1992 zebra_fec_t *zebra_mpls_fec_for_label(struct zebra_vrf *zvrf,
1993 mpls_label_t label)
1994 {
1995 struct route_node *rn;
1996 zebra_fec_t *fec;
1997 int af;
1998
1999 for (af = AFI_IP; af < AFI_MAX; af++) {
2000 if (zvrf->fec_table[af] == NULL)
2001 continue;
2002
2003 for (rn = route_top(zvrf->fec_table[af]); rn;
2004 rn = route_next(rn)) {
2005 if (!rn->info)
2006 continue;
2007 fec = rn->info;
2008 if (fec->label == label)
2009 return fec;
2010 }
2011 }
2012
2013 return NULL;
2014 }
2015
2016 /*
2017 * Inform if specified label is currently bound to a FEC or not.
2018 */
2019 int zebra_mpls_label_already_bound(struct zebra_vrf *zvrf, mpls_label_t label)
2020 {
2021 return (zebra_mpls_fec_for_label(zvrf, label) ? 1 : 0);
2022 }
2023
2024 /*
2025 * Add static FEC to label binding. If there are clients registered for this
2026 * FEC, notify them. If there are labeled routes for this FEC, install the
2027 * label forwarding entry.
2028 */
2029 int zebra_mpls_static_fec_add(struct zebra_vrf *zvrf, struct prefix *p,
2030 mpls_label_t in_label)
2031 {
2032 struct route_table *table;
2033 zebra_fec_t *fec;
2034 char buf[BUFSIZ];
2035 mpls_label_t old_label;
2036 int ret = 0;
2037
2038 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2039 if (!table)
2040 return -1;
2041
2042 if (IS_ZEBRA_DEBUG_MPLS)
2043 prefix2str(p, buf, BUFSIZ);
2044
2045 /* Update existing FEC or create a new one. */
2046 fec = fec_find(table, p);
2047 if (!fec) {
2048 fec = fec_add(table, p, in_label, FEC_FLAG_CONFIGURED,
2049 MPLS_INVALID_LABEL_INDEX);
2050 if (!fec) {
2051 prefix2str(p, buf, BUFSIZ);
2052 flog_err(EC_ZEBRA_FEC_ADD_FAILED,
2053 "Failed to add FEC %s upon config", buf);
2054 return -1;
2055 }
2056
2057 if (IS_ZEBRA_DEBUG_MPLS)
2058 zlog_debug("Add fec %s label %u", buf, in_label);
2059 } else {
2060 fec->flags |= FEC_FLAG_CONFIGURED;
2061 if (fec->label == in_label)
2062 /* Duplicate config */
2063 return 0;
2064
2065 /* Label change, update clients. */
2066 old_label = fec->label;
2067 if (IS_ZEBRA_DEBUG_MPLS)
2068 zlog_debug("Update fec %s new label %u", buf, in_label);
2069
2070 fec->label = in_label;
2071 fec_update_clients(fec);
2072
2073 /* Update label forwarding entries appropriately */
2074 ret = fec_change_update_lsp(zvrf, fec, old_label);
2075 }
2076
2077 return ret;
2078 }
2079
2080 /*
2081 * Remove static FEC to label binding. If there are no clients registered
2082 * for this FEC, delete the FEC; else notify clients
2083 * Note: Upon delete of static binding, if label index exists for this FEC,
2084 * client may need to be updated with derived label.
2085 */
2086 int zebra_mpls_static_fec_del(struct zebra_vrf *zvrf, struct prefix *p)
2087 {
2088 struct route_table *table;
2089 zebra_fec_t *fec;
2090 mpls_label_t old_label;
2091 char buf[BUFSIZ];
2092
2093 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2094 if (!table)
2095 return -1;
2096
2097 fec = fec_find(table, p);
2098 if (!fec) {
2099 prefix2str(p, buf, BUFSIZ);
2100 flog_err(EC_ZEBRA_FEC_RM_FAILED,
2101 "Failed to find FEC %s upon delete", buf);
2102 return -1;
2103 }
2104
2105 if (IS_ZEBRA_DEBUG_MPLS) {
2106 prefix2str(p, buf, BUFSIZ);
2107 zlog_debug("Delete fec %s label index %u", buf,
2108 fec->label_index);
2109 }
2110
2111 old_label = fec->label;
2112 fec->flags &= ~FEC_FLAG_CONFIGURED;
2113 fec->label = MPLS_INVALID_LABEL;
2114
2115 /* If no client exists, just delete the FEC. */
2116 if (list_isempty(fec->client_list)) {
2117 fec_del(fec);
2118 return 0;
2119 }
2120
2121 /* Derive the local label (from label index) or reset it. */
2122 fec_derive_label_from_index(zvrf, fec);
2123
2124 /* If there is a label change, update clients. */
2125 if (fec->label == old_label)
2126 return 0;
2127 fec_update_clients(fec);
2128
2129 /* Update label forwarding entries appropriately */
2130 return fec_change_update_lsp(zvrf, fec, old_label);
2131 }
2132
2133 /*
2134 * Display MPLS FEC to label binding configuration (VTY command handler).
2135 */
2136 int zebra_mpls_write_fec_config(struct vty *vty, struct zebra_vrf *zvrf)
2137 {
2138 struct route_node *rn;
2139 int af;
2140 zebra_fec_t *fec;
2141 char buf[BUFSIZ];
2142 int write = 0;
2143
2144 for (af = AFI_IP; af < AFI_MAX; af++) {
2145 if (zvrf->fec_table[af] == NULL)
2146 continue;
2147
2148 for (rn = route_top(zvrf->fec_table[af]); rn;
2149 rn = route_next(rn)) {
2150 if (!rn->info)
2151 continue;
2152
2153 char lstr[BUFSIZ];
2154 fec = rn->info;
2155
2156 if (!(fec->flags & FEC_FLAG_CONFIGURED))
2157 continue;
2158
2159 write = 1;
2160 prefix2str(&rn->p, buf, BUFSIZ);
2161 vty_out(vty, "mpls label bind %s %s\n", buf,
2162 label2str(fec->label, lstr, BUFSIZ));
2163 }
2164 }
2165
2166 return write;
2167 }
2168
2169 /*
2170 * Display MPLS FEC to label binding (VTY command handler).
2171 */
2172 void zebra_mpls_print_fec_table(struct vty *vty, struct zebra_vrf *zvrf)
2173 {
2174 struct route_node *rn;
2175 int af;
2176
2177 for (af = AFI_IP; af < AFI_MAX; af++) {
2178 if (zvrf->fec_table[af] == NULL)
2179 continue;
2180
2181 for (rn = route_top(zvrf->fec_table[af]); rn;
2182 rn = route_next(rn)) {
2183 if (!rn->info)
2184 continue;
2185 fec_print(rn->info, vty);
2186 }
2187 }
2188 }
2189
2190 /*
2191 * Display MPLS FEC to label binding for a specific FEC (VTY command handler).
2192 */
2193 void zebra_mpls_print_fec(struct vty *vty, struct zebra_vrf *zvrf,
2194 struct prefix *p)
2195 {
2196 struct route_table *table;
2197 struct route_node *rn;
2198
2199 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2200 if (!table)
2201 return;
2202
2203 apply_mask(p);
2204 rn = route_node_lookup(table, p);
2205 if (!rn)
2206 return;
2207
2208 route_unlock_node(rn);
2209 if (!rn->info)
2210 return;
2211
2212 fec_print(rn->info, vty);
2213 }
2214
2215 static bool mpls_ftn_update_nexthop(int add, struct nexthop *nexthop,
2216 enum lsp_types_t type, mpls_label_t label)
2217 {
2218 if (add && nexthop->nh_label_type == ZEBRA_LSP_NONE)
2219 nexthop_add_labels(nexthop, type, 1, &label);
2220 else if (!add && nexthop->nh_label_type == type)
2221 nexthop_del_labels(nexthop);
2222 else
2223 return false;
2224
2225 return true;
2226 }
2227
2228 /*
2229 * Install/uninstall a FEC-To-NHLFE (FTN) binding.
2230 */
2231 int mpls_ftn_update(int add, struct zebra_vrf *zvrf, enum lsp_types_t type,
2232 struct prefix *prefix, enum nexthop_types_t gtype,
2233 union g_addr *gate, ifindex_t ifindex, uint8_t distance,
2234 mpls_label_t out_label)
2235 {
2236 struct route_table *table;
2237 struct route_node *rn;
2238 struct route_entry *re;
2239 struct nexthop *nexthop;
2240 bool found;
2241
2242 /* Lookup table. */
2243 table = zebra_vrf_table(family2afi(prefix->family), SAFI_UNICAST,
2244 zvrf_id(zvrf));
2245 if (!table)
2246 return -1;
2247
2248 /* Lookup existing route */
2249 rn = route_node_get(table, prefix);
2250 RNODE_FOREACH_RE (rn, re) {
2251 if (CHECK_FLAG(re->status, ROUTE_ENTRY_REMOVED))
2252 continue;
2253 if (re->distance == distance)
2254 break;
2255 }
2256
2257 if (re == NULL)
2258 return -1;
2259
2260 found = false;
2261 for (nexthop = re->ng.nexthop; nexthop; nexthop = nexthop->next) {
2262 switch (nexthop->type) {
2263 case NEXTHOP_TYPE_IPV4:
2264 case NEXTHOP_TYPE_IPV4_IFINDEX:
2265 if (gtype != NEXTHOP_TYPE_IPV4
2266 && gtype != NEXTHOP_TYPE_IPV4_IFINDEX)
2267 continue;
2268 if (!IPV4_ADDR_SAME(&nexthop->gate.ipv4, &gate->ipv4))
2269 continue;
2270 if (nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX
2271 && nexthop->ifindex != ifindex)
2272 continue;
2273 if (!mpls_ftn_update_nexthop(add, nexthop, type,
2274 out_label))
2275 return 0;
2276 found = true;
2277 break;
2278 case NEXTHOP_TYPE_IPV6:
2279 case NEXTHOP_TYPE_IPV6_IFINDEX:
2280 if (gtype != NEXTHOP_TYPE_IPV6
2281 && gtype != NEXTHOP_TYPE_IPV6_IFINDEX)
2282 continue;
2283 if (!IPV6_ADDR_SAME(&nexthop->gate.ipv6, &gate->ipv6))
2284 continue;
2285 if (nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX
2286 && nexthop->ifindex != ifindex)
2287 continue;
2288 if (!mpls_ftn_update_nexthop(add, nexthop, type,
2289 out_label))
2290 return 0;
2291 found = true;
2292 break;
2293 default:
2294 break;
2295 }
2296 }
2297
2298 if (!found)
2299 return -1;
2300
2301 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
2302 SET_FLAG(re->status, ROUTE_ENTRY_LABELS_CHANGED);
2303 rib_queue_add(rn);
2304
2305 return 0;
2306 }
2307
2308 /*
2309 * Install/update a NHLFE for an LSP in the forwarding table. This may be
2310 * a new LSP entry or a new NHLFE for an existing in-label or an update of
2311 * the out-label for an existing NHLFE (update case).
2312 */
2313 int mpls_lsp_install(struct zebra_vrf *zvrf, enum lsp_types_t type,
2314 mpls_label_t in_label, mpls_label_t out_label,
2315 enum nexthop_types_t gtype, union g_addr *gate,
2316 ifindex_t ifindex)
2317 {
2318 struct hash *lsp_table;
2319 zebra_ile_t tmp_ile;
2320 zebra_lsp_t *lsp;
2321 zebra_nhlfe_t *nhlfe;
2322 char buf[BUFSIZ];
2323
2324 /* Lookup table. */
2325 lsp_table = zvrf->lsp_table;
2326 if (!lsp_table)
2327 return -1;
2328
2329 /* If entry is present, exit. */
2330 tmp_ile.in_label = in_label;
2331 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
2332 if (!lsp)
2333 return -1;
2334 nhlfe = nhlfe_find(lsp, type, gtype, gate, ifindex);
2335 if (nhlfe) {
2336 struct nexthop *nh = nhlfe->nexthop;
2337
2338 assert(nh);
2339 assert(nh->nh_label);
2340
2341 /* Clear deleted flag (in case it was set) */
2342 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
2343 if (nh->nh_label->label[0] == out_label)
2344 /* No change */
2345 return 0;
2346
2347 if (IS_ZEBRA_DEBUG_MPLS) {
2348 nhlfe2str(nhlfe, buf, BUFSIZ);
2349 zlog_debug(
2350 "LSP in-label %u type %d nexthop %s "
2351 "out-label changed to %u (old %u)",
2352 in_label, type, buf, out_label,
2353 nh->nh_label->label[0]);
2354 }
2355
2356 /* Update out label, trigger processing. */
2357 nh->nh_label->label[0] = out_label;
2358 } else {
2359 /* Add LSP entry to this nexthop */
2360 nhlfe = nhlfe_add(lsp, type, gtype, gate, ifindex, out_label);
2361 if (!nhlfe)
2362 return -1;
2363
2364 if (IS_ZEBRA_DEBUG_MPLS) {
2365 nhlfe2str(nhlfe, buf, BUFSIZ);
2366 zlog_debug(
2367 "Add LSP in-label %u type %d nexthop %s "
2368 "out-label %u",
2369 in_label, type, buf, out_label);
2370 }
2371
2372 lsp->addr_family = NHLFE_FAMILY(nhlfe);
2373 }
2374
2375 /* Mark NHLFE, queue LSP for processing. */
2376 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
2377 if (lsp_processq_add(lsp))
2378 return -1;
2379
2380 return 0;
2381 }
2382
2383 /*
2384 * Uninstall a particular NHLFE in the forwarding table. If this is
2385 * the only NHLFE, the entire LSP forwarding entry has to be deleted.
2386 */
2387 int mpls_lsp_uninstall(struct zebra_vrf *zvrf, enum lsp_types_t type,
2388 mpls_label_t in_label, enum nexthop_types_t gtype,
2389 union g_addr *gate, ifindex_t ifindex)
2390 {
2391 struct hash *lsp_table;
2392 zebra_ile_t tmp_ile;
2393 zebra_lsp_t *lsp;
2394 zebra_nhlfe_t *nhlfe;
2395 char buf[BUFSIZ];
2396
2397 /* Lookup table. */
2398 lsp_table = zvrf->lsp_table;
2399 if (!lsp_table)
2400 return -1;
2401
2402 /* If entry is not present, exit. */
2403 tmp_ile.in_label = in_label;
2404 lsp = hash_lookup(lsp_table, &tmp_ile);
2405 if (!lsp)
2406 return 0;
2407 nhlfe = nhlfe_find(lsp, type, gtype, gate, ifindex);
2408 if (!nhlfe)
2409 return 0;
2410
2411 if (IS_ZEBRA_DEBUG_MPLS) {
2412 nhlfe2str(nhlfe, buf, BUFSIZ);
2413 zlog_debug("Del LSP in-label %u type %d nexthop %s flags 0x%x",
2414 in_label, type, buf, nhlfe->flags);
2415 }
2416
2417 /* Mark NHLFE for delete or directly delete, as appropriate. */
2418 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED)) {
2419 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
2420 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
2421 if (lsp_processq_add(lsp))
2422 return -1;
2423 } else {
2424 nhlfe_del(nhlfe);
2425
2426 /* Free LSP entry if no other NHLFEs and not scheduled. */
2427 if (!lsp->nhlfe_list
2428 && !CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED)) {
2429 if (IS_ZEBRA_DEBUG_MPLS)
2430 zlog_debug("Free LSP in-label %u flags 0x%x",
2431 lsp->ile.in_label, lsp->flags);
2432
2433 lsp = hash_release(lsp_table, &lsp->ile);
2434 if (lsp)
2435 XFREE(MTYPE_LSP, lsp);
2436 }
2437 }
2438 return 0;
2439 }
2440
2441 /*
2442 * Uninstall all LDP NHLFEs for a particular LSP forwarding entry.
2443 * If no other NHLFEs exist, the entry would be deleted.
2444 */
2445 void mpls_ldp_lsp_uninstall_all(struct hash_backet *backet, void *ctxt)
2446 {
2447 zebra_lsp_t *lsp;
2448 struct hash *lsp_table;
2449
2450 lsp = (zebra_lsp_t *)backet->data;
2451 if (!lsp->nhlfe_list)
2452 return;
2453
2454 lsp_table = ctxt;
2455 if (!lsp_table)
2456 return;
2457
2458 mpls_lsp_uninstall_all(lsp_table, lsp, ZEBRA_LSP_LDP);
2459 }
2460
2461 /*
2462 * Uninstall all LDP FEC-To-NHLFE (FTN) bindings of the given address-family.
2463 */
2464 void mpls_ldp_ftn_uninstall_all(struct zebra_vrf *zvrf, int afi)
2465 {
2466 struct route_table *table;
2467 struct route_node *rn;
2468 struct route_entry *re;
2469 struct nexthop *nexthop;
2470 int update;
2471
2472 /* Process routes of interested address-families. */
2473 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
2474 if (!table)
2475 return;
2476
2477 for (rn = route_top(table); rn; rn = route_next(rn)) {
2478 update = 0;
2479 RNODE_FOREACH_RE (rn, re) {
2480 for (nexthop = re->ng.nexthop; nexthop;
2481 nexthop = nexthop->next) {
2482 if (nexthop->nh_label_type != ZEBRA_LSP_LDP)
2483 continue;
2484
2485 nexthop_del_labels(nexthop);
2486 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
2487 SET_FLAG(re->status,
2488 ROUTE_ENTRY_LABELS_CHANGED);
2489 update = 1;
2490 }
2491 }
2492
2493 if (update)
2494 rib_queue_add(rn);
2495 }
2496 }
2497
2498 #if defined(HAVE_CUMULUS)
2499 /*
2500 * Check that the label values used in LSP creation are consistent. The
2501 * main criteria is that if there is ECMP, the label operation must still
2502 * be consistent - i.e., all paths either do a swap or do PHP. This is due
2503 * to current HW restrictions.
2504 */
2505 int zebra_mpls_lsp_label_consistent(struct zebra_vrf *zvrf,
2506 mpls_label_t in_label,
2507 mpls_label_t out_label,
2508 enum nexthop_types_t gtype,
2509 union g_addr *gate, ifindex_t ifindex)
2510 {
2511 struct hash *slsp_table;
2512 zebra_ile_t tmp_ile;
2513 zebra_slsp_t *slsp;
2514 zebra_snhlfe_t *snhlfe;
2515
2516 /* Lookup table. */
2517 slsp_table = zvrf->slsp_table;
2518 if (!slsp_table)
2519 return 0;
2520
2521 /* If entry is not present, exit. */
2522 tmp_ile.in_label = in_label;
2523 slsp = hash_lookup(slsp_table, &tmp_ile);
2524 if (!slsp)
2525 return 1;
2526
2527 snhlfe = snhlfe_find(slsp, gtype, gate, ifindex);
2528 if (snhlfe) {
2529 if (snhlfe->out_label == out_label)
2530 return 1;
2531
2532 /* If not only NHLFE, cannot allow label change. */
2533 if (snhlfe != slsp->snhlfe_list || snhlfe->next)
2534 return 0;
2535 } else {
2536 /* If other NHLFEs exist, label operation must match. */
2537 if (slsp->snhlfe_list) {
2538 int cur_op, new_op;
2539
2540 cur_op = (slsp->snhlfe_list->out_label
2541 == MPLS_LABEL_IMPLICIT_NULL);
2542 new_op = (out_label == MPLS_LABEL_IMPLICIT_NULL);
2543 if (cur_op != new_op)
2544 return 0;
2545 }
2546 }
2547
2548 /* Label values are good. */
2549 return 1;
2550 }
2551 #endif /* HAVE_CUMULUS */
2552
2553 /*
2554 * Add static LSP entry. This may be the first entry for this incoming label
2555 * or an additional nexthop; an existing entry may also have outgoing label
2556 * changed.
2557 * Note: The label operation (swap or PHP) is common for the LSP entry (all
2558 * NHLFEs).
2559 */
2560 int zebra_mpls_static_lsp_add(struct zebra_vrf *zvrf, mpls_label_t in_label,
2561 mpls_label_t out_label,
2562 enum nexthop_types_t gtype, union g_addr *gate,
2563 ifindex_t ifindex)
2564 {
2565 struct hash *slsp_table;
2566 zebra_ile_t tmp_ile;
2567 zebra_slsp_t *slsp;
2568 zebra_snhlfe_t *snhlfe;
2569 char buf[BUFSIZ];
2570
2571 /* Lookup table. */
2572 slsp_table = zvrf->slsp_table;
2573 if (!slsp_table)
2574 return -1;
2575
2576 /* If entry is present, exit. */
2577 tmp_ile.in_label = in_label;
2578 slsp = hash_get(slsp_table, &tmp_ile, slsp_alloc);
2579 if (!slsp)
2580 return -1;
2581 snhlfe = snhlfe_find(slsp, gtype, gate, ifindex);
2582 if (snhlfe) {
2583 if (snhlfe->out_label == out_label)
2584 /* No change */
2585 return 0;
2586
2587 if (IS_ZEBRA_DEBUG_MPLS) {
2588 snhlfe2str(snhlfe, buf, BUFSIZ);
2589 zlog_debug(
2590 "Upd static LSP in-label %u nexthop %s "
2591 "out-label %u (old %u)",
2592 in_label, buf, out_label, snhlfe->out_label);
2593 }
2594 snhlfe->out_label = out_label;
2595 } else {
2596 /* Add static LSP entry to this nexthop */
2597 snhlfe = snhlfe_add(slsp, gtype, gate, ifindex, out_label);
2598 if (!snhlfe)
2599 return -1;
2600
2601 if (IS_ZEBRA_DEBUG_MPLS) {
2602 snhlfe2str(snhlfe, buf, BUFSIZ);
2603 zlog_debug(
2604 "Add static LSP in-label %u nexthop %s out-label %u",
2605 in_label, buf, out_label);
2606 }
2607 }
2608
2609 /* (Re)Install LSP in the main table. */
2610 if (mpls_lsp_install(zvrf, ZEBRA_LSP_STATIC, in_label, out_label, gtype,
2611 gate, ifindex))
2612 return -1;
2613
2614 return 0;
2615 }
2616
2617 /*
2618 * Delete static LSP entry. This may be the delete of one particular
2619 * NHLFE for this incoming label or the delete of the entire entry (i.e.,
2620 * all NHLFEs).
2621 * NOTE: Delete of the only NHLFE will also end up deleting the entire
2622 * LSP configuration.
2623 */
2624 int zebra_mpls_static_lsp_del(struct zebra_vrf *zvrf, mpls_label_t in_label,
2625 enum nexthop_types_t gtype, union g_addr *gate,
2626 ifindex_t ifindex)
2627 {
2628 struct hash *slsp_table;
2629 zebra_ile_t tmp_ile;
2630 zebra_slsp_t *slsp;
2631 zebra_snhlfe_t *snhlfe;
2632
2633 /* Lookup table. */
2634 slsp_table = zvrf->slsp_table;
2635 if (!slsp_table)
2636 return -1;
2637
2638 /* If entry is not present, exit. */
2639 tmp_ile.in_label = in_label;
2640 slsp = hash_lookup(slsp_table, &tmp_ile);
2641 if (!slsp)
2642 return 0;
2643
2644 /* Is it delete of entire LSP or a specific NHLFE? */
2645 if (gtype == NEXTHOP_TYPE_BLACKHOLE) {
2646 if (IS_ZEBRA_DEBUG_MPLS)
2647 zlog_debug("Del static LSP in-label %u", in_label);
2648
2649 /* Uninstall entire LSP from the main table. */
2650 mpls_static_lsp_uninstall_all(zvrf, in_label);
2651
2652 /* Delete all static NHLFEs */
2653 snhlfe_del_all(slsp);
2654 } else {
2655 /* Find specific NHLFE, exit if not found. */
2656 snhlfe = snhlfe_find(slsp, gtype, gate, ifindex);
2657 if (!snhlfe)
2658 return 0;
2659
2660 if (IS_ZEBRA_DEBUG_MPLS) {
2661 char buf[BUFSIZ];
2662 snhlfe2str(snhlfe, buf, BUFSIZ);
2663 zlog_debug("Del static LSP in-label %u nexthop %s",
2664 in_label, buf);
2665 }
2666
2667 /* Uninstall LSP from the main table. */
2668 mpls_lsp_uninstall(zvrf, ZEBRA_LSP_STATIC, in_label, gtype,
2669 gate, ifindex);
2670
2671 /* Delete static LSP NHLFE */
2672 snhlfe_del(snhlfe);
2673 }
2674
2675 /* Remove entire static LSP entry if no NHLFE - valid in either case
2676 * above. */
2677 if (!slsp->snhlfe_list) {
2678 slsp = hash_release(slsp_table, &tmp_ile);
2679 if (slsp)
2680 XFREE(MTYPE_SLSP, slsp);
2681 }
2682
2683 return 0;
2684 }
2685
2686 /*
2687 * Schedule all MPLS label forwarding entries for processing.
2688 * Called upon changes that may affect one or more of them such as
2689 * interface or nexthop state changes.
2690 */
2691 void zebra_mpls_lsp_schedule(struct zebra_vrf *zvrf)
2692 {
2693 if (!zvrf)
2694 return;
2695 hash_iterate(zvrf->lsp_table, lsp_schedule, NULL);
2696 }
2697
2698 /*
2699 * Display MPLS label forwarding table for a specific LSP
2700 * (VTY command handler).
2701 */
2702 void zebra_mpls_print_lsp(struct vty *vty, struct zebra_vrf *zvrf,
2703 mpls_label_t label, bool use_json)
2704 {
2705 struct hash *lsp_table;
2706 zebra_lsp_t *lsp;
2707 zebra_ile_t tmp_ile;
2708 json_object *json = NULL;
2709
2710 /* Lookup table. */
2711 lsp_table = zvrf->lsp_table;
2712 if (!lsp_table)
2713 return;
2714
2715 /* If entry is not present, exit. */
2716 tmp_ile.in_label = label;
2717 lsp = hash_lookup(lsp_table, &tmp_ile);
2718 if (!lsp)
2719 return;
2720
2721 if (use_json) {
2722 json = lsp_json(lsp);
2723 vty_out(vty, "%s\n", json_object_to_json_string_ext(
2724 json, JSON_C_TO_STRING_PRETTY));
2725 json_object_free(json);
2726 } else
2727 lsp_print(lsp, (void *)vty);
2728 }
2729
2730 /*
2731 * Display MPLS label forwarding table (VTY command handler).
2732 */
2733 void zebra_mpls_print_lsp_table(struct vty *vty, struct zebra_vrf *zvrf,
2734 bool use_json)
2735 {
2736 char buf[BUFSIZ];
2737 json_object *json = NULL;
2738 zebra_lsp_t *lsp = NULL;
2739 zebra_nhlfe_t *nhlfe = NULL;
2740 struct nexthop *nexthop = NULL;
2741 struct listnode *node = NULL;
2742 struct list *lsp_list = hash_get_sorted_list(zvrf->lsp_table, lsp_cmp);
2743
2744 if (use_json) {
2745 json = json_object_new_object();
2746
2747 for (ALL_LIST_ELEMENTS_RO(lsp_list, node, lsp))
2748 json_object_object_add(
2749 json, label2str(lsp->ile.in_label, buf, BUFSIZ),
2750 lsp_json(lsp));
2751
2752 vty_out(vty, "%s\n", json_object_to_json_string_ext(
2753 json, JSON_C_TO_STRING_PRETTY));
2754 json_object_free(json);
2755 } else {
2756 vty_out(vty, " Inbound Outbound\n");
2757 vty_out(vty, " Label Type Nexthop Label\n");
2758 vty_out(vty, "-------- ------- --------------- --------\n");
2759
2760 for (ALL_LIST_ELEMENTS_RO(lsp_list, node, lsp)) {
2761 for (nhlfe = lsp->nhlfe_list; nhlfe;
2762 nhlfe = nhlfe->next) {
2763 vty_out(vty, "%8d %7s ", lsp->ile.in_label,
2764 nhlfe_type2str(nhlfe->type));
2765 nexthop = nhlfe->nexthop;
2766
2767 switch (nexthop->type) {
2768 case NEXTHOP_TYPE_IFINDEX: {
2769 struct zebra_ns *zns;
2770 struct interface *ifp;
2771
2772 zns = zebra_ns_lookup(NS_DEFAULT);
2773 ifp = if_lookup_by_index_per_ns(
2774 zns,
2775 nexthop->ifindex);
2776 vty_out(vty, "%15s", ifp->name);
2777 break;
2778 }
2779 case NEXTHOP_TYPE_IPV4:
2780 case NEXTHOP_TYPE_IPV4_IFINDEX:
2781 vty_out(vty, "%15s",
2782 inet_ntoa(nexthop->gate.ipv4));
2783 break;
2784 case NEXTHOP_TYPE_IPV6:
2785 case NEXTHOP_TYPE_IPV6_IFINDEX:
2786 vty_out(vty, "%15s",
2787 inet_ntop(AF_INET6,
2788 &nexthop->gate.ipv6,
2789 buf, BUFSIZ));
2790 break;
2791 default:
2792 break;
2793 }
2794
2795 if (nexthop->type != NEXTHOP_TYPE_IFINDEX)
2796 vty_out(vty, " %8s\n",
2797 mpls_label2str(
2798 nexthop->nh_label
2799 ->num_labels,
2800 &nexthop->nh_label
2801 ->label[0],
2802 buf, BUFSIZ, 1));
2803 else
2804 vty_out(vty, "\n");
2805 }
2806 }
2807
2808 vty_out(vty, "\n");
2809 }
2810
2811 list_delete_and_null(&lsp_list);
2812 }
2813
2814 /*
2815 * Display MPLS LSP configuration of all static LSPs (VTY command handler).
2816 */
2817 int zebra_mpls_write_lsp_config(struct vty *vty, struct zebra_vrf *zvrf)
2818 {
2819 zebra_slsp_t *slsp;
2820 zebra_snhlfe_t *snhlfe;
2821 struct listnode *node;
2822 struct list *slsp_list =
2823 hash_get_sorted_list(zvrf->slsp_table, slsp_cmp);
2824
2825 for (ALL_LIST_ELEMENTS_RO(slsp_list, node, slsp)) {
2826 for (snhlfe = slsp->snhlfe_list; snhlfe;
2827 snhlfe = snhlfe->next) {
2828 char buf[BUFSIZ];
2829 char lstr[30];
2830
2831 snhlfe2str(snhlfe, buf, sizeof(buf));
2832 switch (snhlfe->out_label) {
2833 case MPLS_LABEL_IPV4_EXPLICIT_NULL:
2834 case MPLS_LABEL_IPV6_EXPLICIT_NULL:
2835 strlcpy(lstr, "explicit-null", sizeof(lstr));
2836 break;
2837 case MPLS_LABEL_IMPLICIT_NULL:
2838 strlcpy(lstr, "implicit-null", sizeof(lstr));
2839 break;
2840 default:
2841 sprintf(lstr, "%u", snhlfe->out_label);
2842 break;
2843 }
2844
2845 vty_out(vty, "mpls lsp %u %s %s\n", slsp->ile.in_label,
2846 buf, lstr);
2847 }
2848 }
2849
2850 list_delete_and_null(&slsp_list);
2851 return (zvrf->slsp_table->count ? 1 : 0);
2852 }
2853
2854 /*
2855 * Add/update global label block.
2856 */
2857 int zebra_mpls_label_block_add(struct zebra_vrf *zvrf, uint32_t start_label,
2858 uint32_t end_label)
2859 {
2860 zvrf->mpls_srgb.start_label = start_label;
2861 zvrf->mpls_srgb.end_label = end_label;
2862
2863 /* Evaluate registered FECs to see if any get a label or not. */
2864 fec_evaluate(zvrf);
2865 return 0;
2866 }
2867
2868 /*
2869 * Delete global label block.
2870 */
2871 int zebra_mpls_label_block_del(struct zebra_vrf *zvrf)
2872 {
2873 zvrf->mpls_srgb.start_label = MPLS_DEFAULT_MIN_SRGB_LABEL;
2874 zvrf->mpls_srgb.end_label = MPLS_DEFAULT_MAX_SRGB_LABEL;
2875
2876 /* Process registered FECs to clear their local label, if needed. */
2877 fec_evaluate(zvrf);
2878 return 0;
2879 }
2880
2881 /*
2882 * Display MPLS global label block configuration (VTY command handler).
2883 */
2884 int zebra_mpls_write_label_block_config(struct vty *vty, struct zebra_vrf *zvrf)
2885 {
2886 if (zvrf->mpls_srgb.start_label == 0)
2887 return 0;
2888
2889 if ((zvrf->mpls_srgb.start_label != MPLS_DEFAULT_MIN_SRGB_LABEL)
2890 || (zvrf->mpls_srgb.end_label != MPLS_DEFAULT_MAX_SRGB_LABEL)) {
2891 vty_out(vty, "mpls label global-block %u %u\n",
2892 zvrf->mpls_srgb.start_label, zvrf->mpls_srgb.end_label);
2893 }
2894
2895 return 1;
2896 }
2897
2898 /*
2899 * Called when VRF becomes inactive, cleans up information but keeps
2900 * the table itself.
2901 * NOTE: Currently supported only for default VRF.
2902 */
2903 void zebra_mpls_cleanup_tables(struct zebra_vrf *zvrf)
2904 {
2905 hash_iterate(zvrf->lsp_table, lsp_uninstall_from_kernel, NULL);
2906 }
2907
2908 /*
2909 * Called upon process exiting, need to delete LSP forwarding
2910 * entries from the kernel.
2911 * NOTE: Currently supported only for default VRF.
2912 */
2913 void zebra_mpls_close_tables(struct zebra_vrf *zvrf)
2914 {
2915 hash_iterate(zvrf->lsp_table, lsp_uninstall_from_kernel, NULL);
2916 hash_clean(zvrf->lsp_table, NULL);
2917 hash_free(zvrf->lsp_table);
2918 hash_clean(zvrf->slsp_table, NULL);
2919 hash_free(zvrf->slsp_table);
2920 route_table_finish(zvrf->fec_table[AFI_IP]);
2921 route_table_finish(zvrf->fec_table[AFI_IP6]);
2922 }
2923
2924 /*
2925 * Allocate MPLS tables for this VRF and do other initialization.
2926 * NOTE: Currently supported only for default VRF.
2927 */
2928 void zebra_mpls_init_tables(struct zebra_vrf *zvrf)
2929 {
2930 if (!zvrf)
2931 return;
2932 zvrf->slsp_table =
2933 hash_create(label_hash, label_cmp, "ZEBRA SLSP table");
2934 zvrf->lsp_table = hash_create(label_hash, label_cmp, "ZEBRA LSP table");
2935 zvrf->fec_table[AFI_IP] = route_table_init();
2936 zvrf->fec_table[AFI_IP6] = route_table_init();
2937 zvrf->mpls_flags = 0;
2938 zvrf->mpls_srgb.start_label = MPLS_DEFAULT_MIN_SRGB_LABEL;
2939 zvrf->mpls_srgb.end_label = MPLS_DEFAULT_MAX_SRGB_LABEL;
2940 }
2941
2942 /*
2943 * Global MPLS initialization.
2944 */
2945 void zebra_mpls_init(void)
2946 {
2947 mpls_enabled = 0;
2948
2949 if (mpls_kernel_init() < 0) {
2950 flog_warn(EC_ZEBRA_MPLS_SUPPORT_DISABLED,
2951 "Disabling MPLS support (no kernel support)");
2952 return;
2953 }
2954
2955 if (!mpls_processq_init(&zebrad))
2956 mpls_enabled = 1;
2957
2958 hook_register(zserv_client_close, zebra_mpls_cleanup_fecs_for_client);
2959 }
FRRouting mirror