]> git.proxmox.com Git - mirror_frr.git/blob - zebra/zebra_mpls.c
projects / mirror_frr.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge pull request #11765 from lyq140/patch-pimDoc
[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 "termtable.h"
38 #include "lib/json.h"
39
40 #include "zebra/rib.h"
41 #include "zebra/rt.h"
42 #include "zebra/interface.h"
43 #include "zebra/zserv.h"
44 #include "zebra/zebra_router.h"
45 #include "zebra/redistribute.h"
46 #include "zebra/debug.h"
47 #include "zebra/zebra_vrf.h"
48 #include "zebra/zebra_mpls.h"
49 #include "zebra/zebra_srte.h"
50 #include "zebra/zebra_errors.h"
51
52 DEFINE_MTYPE_STATIC(ZEBRA, LSP, "MPLS LSP object");
53 DEFINE_MTYPE_STATIC(ZEBRA, FEC, "MPLS FEC object");
54 DEFINE_MTYPE_STATIC(ZEBRA, NHLFE, "MPLS nexthop object");
55
56 bool mpls_enabled;
57 bool mpls_pw_reach_strict; /* Strict reachability checking */
58
59 /* static function declarations */
60
61 static void fec_evaluate(struct zebra_vrf *zvrf);
62 static uint32_t fec_derive_label_from_index(struct zebra_vrf *vrf,
63 struct zebra_fec *fec);
64 static int lsp_install(struct zebra_vrf *zvrf, mpls_label_t label,
65 struct route_node *rn, struct route_entry *re);
66 static int lsp_uninstall(struct zebra_vrf *zvrf, mpls_label_t label);
67 static int fec_change_update_lsp(struct zebra_vrf *zvrf, struct zebra_fec *fec,
68 mpls_label_t old_label);
69 static int fec_send(struct zebra_fec *fec, struct zserv *client);
70 static void fec_update_clients(struct zebra_fec *fec);
71 static void fec_print(struct zebra_fec *fec, struct vty *vty);
72 static struct zebra_fec *fec_find(struct route_table *table, struct prefix *p);
73 static struct zebra_fec *fec_add(struct route_table *table, struct prefix *p,
74 mpls_label_t label, uint32_t flags,
75 uint32_t label_index);
76 static int fec_del(struct zebra_fec *fec);
77
78 static unsigned int label_hash(const void *p);
79 static bool label_cmp(const void *p1, const void *p2);
80 static int nhlfe_nexthop_active_ipv4(struct zebra_nhlfe *nhlfe,
81 struct nexthop *nexthop);
82 static int nhlfe_nexthop_active_ipv6(struct zebra_nhlfe *nhlfe,
83 struct nexthop *nexthop);
84 static int nhlfe_nexthop_active(struct zebra_nhlfe *nhlfe);
85
86 static void lsp_select_best_nhlfe(struct zebra_lsp *lsp);
87 static void lsp_uninstall_from_kernel(struct hash_bucket *bucket, void *ctxt);
88 static void lsp_schedule(struct hash_bucket *bucket, void *ctxt);
89 static wq_item_status lsp_process(struct work_queue *wq, void *data);
90 static void lsp_processq_del(struct work_queue *wq, void *data);
91 static void lsp_processq_complete(struct work_queue *wq);
92 static int lsp_processq_add(struct zebra_lsp *lsp);
93 static void *lsp_alloc(void *p);
94
95 /* Check whether lsp can be freed - no nhlfes, e.g., and call free api */
96 static void lsp_check_free(struct hash *lsp_table, struct zebra_lsp **plsp);
97
98 /* Free lsp; sets caller's pointer to NULL */
99 static void lsp_free(struct hash *lsp_table, struct zebra_lsp **plsp);
100
101 static char *nhlfe2str(const struct zebra_nhlfe *nhlfe, char *buf, int size);
102 static char *nhlfe_config_str(const struct zebra_nhlfe *nhlfe, char *buf,
103 int size);
104 static int nhlfe_nhop_match(struct zebra_nhlfe *nhlfe,
105 enum nexthop_types_t gtype,
106 const union g_addr *gate, ifindex_t ifindex);
107 static struct zebra_nhlfe *nhlfe_find(struct nhlfe_list_head *list,
108 enum lsp_types_t lsp_type,
109 enum nexthop_types_t gtype,
110 const union g_addr *gate,
111 ifindex_t ifindex);
112 static struct zebra_nhlfe *
113 nhlfe_add(struct zebra_lsp *lsp, enum lsp_types_t lsp_type,
114 enum nexthop_types_t gtype, const union g_addr *gate,
115 ifindex_t ifindex, uint8_t num_labels, const mpls_label_t *labels,
116 bool is_backup);
117 static int nhlfe_del(struct zebra_nhlfe *nhlfe);
118 static void nhlfe_free(struct zebra_nhlfe *nhlfe);
119 static void nhlfe_out_label_update(struct zebra_nhlfe *nhlfe,
120 struct mpls_label_stack *nh_label);
121 static int mpls_lsp_uninstall_all(struct hash *lsp_table, struct zebra_lsp *lsp,
122 enum lsp_types_t type);
123 static int mpls_static_lsp_uninstall_all(struct zebra_vrf *zvrf,
124 mpls_label_t in_label);
125 static void nhlfe_print(struct zebra_nhlfe *nhlfe, struct vty *vty,
126 const char *indent);
127 static void lsp_print(struct vty *vty, struct zebra_lsp *lsp);
128 static void mpls_lsp_uninstall_all_type(struct hash_bucket *bucket, void *ctxt);
129 static void mpls_ftn_uninstall_all(struct zebra_vrf *zvrf,
130 int afi, enum lsp_types_t lsp_type);
131 static int lsp_znh_install(struct zebra_lsp *lsp, enum lsp_types_t type,
132 const struct zapi_nexthop *znh);
133 static int lsp_backup_znh_install(struct zebra_lsp *lsp, enum lsp_types_t type,
134 const struct zapi_nexthop *znh);
135
136 /* Static functions */
137
138 /*
139 * Handle failure in LSP install, clear flags for NHLFE.
140 */
141 static void clear_nhlfe_installed(struct zebra_lsp *lsp)
142 {
143 struct zebra_nhlfe *nhlfe;
144 struct nexthop *nexthop;
145
146 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
147 nexthop = nhlfe->nexthop;
148 if (!nexthop)
149 continue;
150
151 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
152 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB);
153 }
154
155 frr_each_safe(nhlfe_list, &lsp->backup_nhlfe_list, nhlfe) {
156 nexthop = nhlfe->nexthop;
157 if (!nexthop)
158 continue;
159
160 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
161 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB);
162 }
163 }
164
165 /*
166 * Install label forwarding entry based on labeled-route entry.
167 */
168 static int lsp_install(struct zebra_vrf *zvrf, mpls_label_t label,
169 struct route_node *rn, struct route_entry *re)
170 {
171 struct hash *lsp_table;
172 struct zebra_ile tmp_ile;
173 struct zebra_lsp *lsp;
174 struct zebra_nhlfe *nhlfe;
175 struct nexthop *nexthop;
176 enum lsp_types_t lsp_type;
177 char buf[BUFSIZ];
178 int added, changed;
179
180 /* Lookup table. */
181 lsp_table = zvrf->lsp_table;
182 if (!lsp_table)
183 return -1;
184
185 lsp_type = lsp_type_from_re_type(re->type);
186 added = changed = 0;
187
188 /* Locate or allocate LSP entry. */
189 tmp_ile.in_label = label;
190 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
191
192 /* For each active nexthop, create NHLFE. Note that we deliberately skip
193 * recursive nexthops right now, because intermediate hops won't
194 * understand
195 * the label advertised by the recursive nexthop (plus we don't have the
196 * logic yet to push multiple labels).
197 */
198 for (nexthop = re->nhe->nhg.nexthop;
199 nexthop; nexthop = nexthop->next) {
200 /* Skip inactive and recursive entries. */
201 if (!CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE))
202 continue;
203 if (CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_RECURSIVE))
204 continue;
205
206 nhlfe = nhlfe_find(&lsp->nhlfe_list, lsp_type,
207 nexthop->type, &nexthop->gate,
208 nexthop->ifindex);
209 if (nhlfe) {
210 /* Clear deleted flag (in case it was set) */
211 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
212 if (nexthop_labels_match(nhlfe->nexthop, nexthop))
213 /* No change */
214 continue;
215
216
217 if (IS_ZEBRA_DEBUG_MPLS) {
218 nhlfe2str(nhlfe, buf, BUFSIZ);
219 zlog_debug(
220 "LSP in-label %u type %d nexthop %s out-label changed",
221 lsp->ile.in_label, lsp_type, buf);
222 }
223
224 /* Update out label, trigger processing. */
225 nhlfe_out_label_update(nhlfe, nexthop->nh_label);
226 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
227 changed++;
228 } else {
229 /* Add LSP entry to this nexthop */
230 nhlfe = nhlfe_add(lsp, lsp_type, nexthop->type,
231 &nexthop->gate, nexthop->ifindex,
232 nexthop->nh_label->num_labels,
233 nexthop->nh_label->label,
234 false /*backup*/);
235 if (!nhlfe)
236 return -1;
237
238 if (IS_ZEBRA_DEBUG_MPLS) {
239 nhlfe2str(nhlfe, buf, BUFSIZ);
240 zlog_debug(
241 "Add LSP in-label %u type %d nexthop %s out-label %u",
242 lsp->ile.in_label, lsp_type, buf,
243 nexthop->nh_label->label[0]);
244 }
245
246 lsp->addr_family = NHLFE_FAMILY(nhlfe);
247
248 /* Mark NHLFE as changed. */
249 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
250 added++;
251 }
252 }
253
254 /* Queue LSP for processing if necessary. If no NHLFE got added (special
255 * case), delete the LSP entry; this case results in somewhat ugly
256 * logging.
257 */
258 if (added || changed) {
259 if (lsp_processq_add(lsp))
260 return -1;
261 } else {
262 lsp_check_free(lsp_table, &lsp);
263 }
264
265 return 0;
266 }
267
268 /*
269 * Uninstall all non-static NHLFEs of a label forwarding entry. If all
270 * NHLFEs are removed, the entire entry is deleted.
271 */
272 static int lsp_uninstall(struct zebra_vrf *zvrf, mpls_label_t label)
273 {
274 struct hash *lsp_table;
275 struct zebra_ile tmp_ile;
276 struct zebra_lsp *lsp;
277 struct zebra_nhlfe *nhlfe;
278 char buf[BUFSIZ];
279
280 /* Lookup table. */
281 lsp_table = zvrf->lsp_table;
282 if (!lsp_table)
283 return -1;
284
285 /* If entry is not present, exit. */
286 tmp_ile.in_label = label;
287 lsp = hash_lookup(lsp_table, &tmp_ile);
288 if (!lsp || (nhlfe_list_first(&lsp->nhlfe_list) == NULL))
289 return 0;
290
291 /* Mark NHLFEs for delete or directly delete, as appropriate. */
292 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
293
294 /* Skip static NHLFEs */
295 if (nhlfe->type == ZEBRA_LSP_STATIC)
296 continue;
297
298 if (IS_ZEBRA_DEBUG_MPLS) {
299 nhlfe2str(nhlfe, buf, BUFSIZ);
300 zlog_debug(
301 "Del LSP in-label %u type %d nexthop %s flags 0x%x",
302 label, nhlfe->type, buf, nhlfe->flags);
303 }
304
305 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED)) {
306 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
307 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
308 } else {
309 nhlfe_del(nhlfe);
310 }
311 }
312
313 /* Queue LSP for processing, if needed, else delete. */
314 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED)) {
315 if (lsp_processq_add(lsp))
316 return -1;
317 } else {
318 lsp_check_free(lsp_table, &lsp);
319 }
320
321 return 0;
322 }
323
324 /*
325 * This function is invoked upon change to label block configuration; it
326 * will walk all registered FECs with label-index and appropriately update
327 * their local labels and trigger client updates.
328 */
329 static void fec_evaluate(struct zebra_vrf *zvrf)
330 {
331 struct route_node *rn;
332 struct zebra_fec *fec;
333 uint32_t old_label, new_label;
334 int af;
335
336 for (af = AFI_IP; af < AFI_MAX; af++) {
337 if (zvrf->fec_table[af] == NULL)
338 continue;
339
340 for (rn = route_top(zvrf->fec_table[af]); rn;
341 rn = route_next(rn)) {
342 if ((fec = rn->info) == NULL)
343 continue;
344
345 /* Skip configured FECs and those without a label index.
346 */
347 if (fec->flags & FEC_FLAG_CONFIGURED
348 || fec->label_index == MPLS_INVALID_LABEL_INDEX)
349 continue;
350
351 /* Save old label, determine new label. */
352 old_label = fec->label;
353 new_label =
354 zvrf->mpls_srgb.start_label + fec->label_index;
355 if (new_label >= zvrf->mpls_srgb.end_label)
356 new_label = MPLS_INVALID_LABEL;
357
358 /* If label has changed, update FEC and clients. */
359 if (new_label == old_label)
360 continue;
361
362 if (IS_ZEBRA_DEBUG_MPLS)
363 zlog_debug(
364 "Update fec %pRN new label %u upon label block",
365 rn, new_label);
366
367 fec->label = new_label;
368 fec_update_clients(fec);
369
370 /* Update label forwarding entries appropriately */
371 fec_change_update_lsp(zvrf, fec, old_label);
372 }
373 }
374 }
375
376 /*
377 * Derive (if possible) and update the local label for the FEC based on
378 * its label index. The index is "acceptable" if it falls within the
379 * globally configured label block (SRGB).
380 */
381 static uint32_t fec_derive_label_from_index(struct zebra_vrf *zvrf,
382 struct zebra_fec *fec)
383 {
384 uint32_t label;
385
386 if (fec->label_index != MPLS_INVALID_LABEL_INDEX
387 && zvrf->mpls_srgb.start_label
388 && ((label = zvrf->mpls_srgb.start_label + fec->label_index)
389 < zvrf->mpls_srgb.end_label))
390 fec->label = label;
391 else
392 fec->label = MPLS_INVALID_LABEL;
393
394 return fec->label;
395 }
396
397 /*
398 * There is a change for this FEC. Install or uninstall label forwarding
399 * entries, as appropriate.
400 */
401 static int fec_change_update_lsp(struct zebra_vrf *zvrf, struct zebra_fec *fec,
402 mpls_label_t old_label)
403 {
404 struct route_table *table;
405 struct route_node *rn;
406 struct route_entry *re;
407 afi_t afi;
408
409 /* Uninstall label forwarding entry, if previously installed. */
410 if (old_label != MPLS_INVALID_LABEL
411 && old_label != MPLS_LABEL_IMPLICIT_NULL)
412 lsp_uninstall(zvrf, old_label);
413
414 /* Install label forwarding entry corr. to new label, if needed. */
415 if (fec->label == MPLS_INVALID_LABEL
416 || fec->label == MPLS_LABEL_IMPLICIT_NULL)
417 return 0;
418
419 afi = family2afi(PREFIX_FAMILY(&fec->rn->p));
420 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
421 if (!table)
422 return 0;
423
424 /* See if labeled route exists. */
425 rn = route_node_lookup(table, &fec->rn->p);
426 if (!rn)
427 return 0;
428
429 RNODE_FOREACH_RE (rn, re) {
430 if (CHECK_FLAG(re->flags, ZEBRA_FLAG_SELECTED))
431 break;
432 }
433
434 if (!re || !zebra_rib_labeled_unicast(re))
435 return 0;
436
437 if (lsp_install(zvrf, fec->label, rn, re))
438 return -1;
439
440 return 0;
441 }
442
443 /*
444 * Inform about FEC to a registered client.
445 */
446 static int fec_send(struct zebra_fec *fec, struct zserv *client)
447 {
448 struct stream *s;
449 struct route_node *rn;
450
451 rn = fec->rn;
452
453 /* Get output stream. */
454 s = stream_new(ZEBRA_MAX_PACKET_SIZ);
455
456 zclient_create_header(s, ZEBRA_FEC_UPDATE, VRF_DEFAULT);
457
458 stream_putw(s, rn->p.family);
459 stream_put_prefix(s, &rn->p);
460 stream_putl(s, fec->label);
461 stream_putw_at(s, 0, stream_get_endp(s));
462 return zserv_send_message(client, s);
463 }
464
465 /*
466 * Update all registered clients about this FEC. Caller should've updated
467 * FEC and ensure no duplicate updates.
468 */
469 static void fec_update_clients(struct zebra_fec *fec)
470 {
471 struct listnode *node;
472 struct zserv *client;
473
474 for (ALL_LIST_ELEMENTS_RO(fec->client_list, node, client)) {
475 if (IS_ZEBRA_DEBUG_MPLS)
476 zlog_debug("Update client %s",
477 zebra_route_string(client->proto));
478 fec_send(fec, client);
479 }
480 }
481
482
483 /*
484 * Print a FEC-label binding entry.
485 */
486 static void fec_print(struct zebra_fec *fec, struct vty *vty)
487 {
488 struct route_node *rn;
489 struct listnode *node;
490 struct zserv *client;
491 char buf[BUFSIZ];
492
493 rn = fec->rn;
494 vty_out(vty, "%pRN\n", rn);
495 vty_out(vty, " Label: %s", label2str(fec->label, buf, BUFSIZ));
496 if (fec->label_index != MPLS_INVALID_LABEL_INDEX)
497 vty_out(vty, ", Label Index: %u", fec->label_index);
498 vty_out(vty, "\n");
499 if (!list_isempty(fec->client_list)) {
500 vty_out(vty, " Client list:");
501 for (ALL_LIST_ELEMENTS_RO(fec->client_list, node, client))
502 vty_out(vty, " %s(fd %d)",
503 zebra_route_string(client->proto),
504 client->sock);
505 vty_out(vty, "\n");
506 }
507 }
508
509 /*
510 * Locate FEC-label binding that matches with passed info.
511 */
512 static struct zebra_fec *fec_find(struct route_table *table, struct prefix *p)
513 {
514 struct route_node *rn;
515
516 apply_mask(p);
517 rn = route_node_lookup(table, p);
518 if (!rn)
519 return NULL;
520
521 route_unlock_node(rn);
522 return (rn->info);
523 }
524
525 /*
526 * Add a FEC. This may be upon a client registering for a binding
527 * or when a binding is configured.
528 */
529 static struct zebra_fec *fec_add(struct route_table *table, struct prefix *p,
530 mpls_label_t label, uint32_t flags,
531 uint32_t label_index)
532 {
533 struct route_node *rn;
534 struct zebra_fec *fec;
535
536 apply_mask(p);
537
538 /* Lookup (or add) route node.*/
539 rn = route_node_get(table, p);
540 if (!rn)
541 return NULL;
542
543 fec = rn->info;
544
545 if (!fec) {
546 fec = XCALLOC(MTYPE_FEC, sizeof(struct zebra_fec));
547
548 rn->info = fec;
549 fec->rn = rn;
550 fec->label = label;
551 fec->client_list = list_new();
552 } else
553 route_unlock_node(rn); /* for the route_node_get */
554
555 fec->label_index = label_index;
556 fec->flags = flags;
557
558 return fec;
559 }
560
561 /*
562 * Delete a FEC. This may be upon the last client deregistering for
563 * a FEC and no binding exists or when the binding is deleted and there
564 * are no registered clients.
565 */
566 static int fec_del(struct zebra_fec *fec)
567 {
568 list_delete(&fec->client_list);
569 fec->rn->info = NULL;
570 route_unlock_node(fec->rn);
571 XFREE(MTYPE_FEC, fec);
572 return 0;
573 }
574
575 /*
576 * Hash function for label.
577 */
578 static unsigned int label_hash(const void *p)
579 {
580 const struct zebra_ile *ile = p;
581
582 return (jhash_1word(ile->in_label, 0));
583 }
584
585 /*
586 * Compare 2 LSP hash entries based on in-label.
587 */
588 static bool label_cmp(const void *p1, const void *p2)
589 {
590 const struct zebra_ile *ile1 = p1;
591 const struct zebra_ile *ile2 = p2;
592
593 return (ile1->in_label == ile2->in_label);
594 }
595
596 /*
597 * Check if an IPv4 nexthop for a NHLFE is active. Update nexthop based on
598 * the passed flag.
599 * NOTE: Looking only for connected routes right now.
600 */
601 static int nhlfe_nexthop_active_ipv4(struct zebra_nhlfe *nhlfe,
602 struct nexthop *nexthop)
603 {
604 struct route_table *table;
605 struct prefix_ipv4 p;
606 struct route_node *rn;
607 struct route_entry *match;
608 struct nexthop *match_nh;
609
610 table = zebra_vrf_table(AFI_IP, SAFI_UNICAST, nexthop->vrf_id);
611 if (!table)
612 return 0;
613
614 /* Lookup nexthop in IPv4 routing table. */
615 memset(&p, 0, sizeof(p));
616 p.family = AF_INET;
617 p.prefixlen = IPV4_MAX_BITLEN;
618 p.prefix = nexthop->gate.ipv4;
619
620 rn = route_node_match(table, (struct prefix *)&p);
621 if (!rn)
622 return 0;
623
624 route_unlock_node(rn);
625
626 /* Locate a valid connected route. */
627 RNODE_FOREACH_RE (rn, match) {
628 if (CHECK_FLAG(match->status, ROUTE_ENTRY_REMOVED)
629 || !CHECK_FLAG(match->flags, ZEBRA_FLAG_SELECTED))
630 continue;
631
632 for (match_nh = match->nhe->nhg.nexthop; match_nh;
633 match_nh = match_nh->next) {
634 if (match->type == ZEBRA_ROUTE_CONNECT
635 || nexthop->ifindex == match_nh->ifindex) {
636 nexthop->ifindex = match_nh->ifindex;
637 return 1;
638 }
639 }
640 }
641
642 return 0;
643 }
644
645
646 /*
647 * Check if an IPv6 nexthop for a NHLFE is active. Update nexthop based on
648 * the passed flag.
649 * NOTE: Looking only for connected routes right now.
650 */
651 static int nhlfe_nexthop_active_ipv6(struct zebra_nhlfe *nhlfe,
652 struct nexthop *nexthop)
653 {
654 struct route_table *table;
655 struct prefix_ipv6 p;
656 struct route_node *rn;
657 struct route_entry *match;
658
659 table = zebra_vrf_table(AFI_IP6, SAFI_UNICAST, nexthop->vrf_id);
660 if (!table)
661 return 0;
662
663 /* Lookup nexthop in IPv6 routing table. */
664 memset(&p, 0, sizeof(p));
665 p.family = AF_INET6;
666 p.prefixlen = IPV6_MAX_BITLEN;
667 p.prefix = nexthop->gate.ipv6;
668
669 rn = route_node_match(table, (struct prefix *)&p);
670 if (!rn)
671 return 0;
672
673 route_unlock_node(rn);
674
675 /* Locate a valid connected route. */
676 RNODE_FOREACH_RE (rn, match) {
677 if ((match->type == ZEBRA_ROUTE_CONNECT)
678 && !CHECK_FLAG(match->status, ROUTE_ENTRY_REMOVED)
679 && CHECK_FLAG(match->flags, ZEBRA_FLAG_SELECTED))
680 break;
681 }
682
683 if (!match || !match->nhe->nhg.nexthop)
684 return 0;
685
686 nexthop->ifindex = match->nhe->nhg.nexthop->ifindex;
687 return 1;
688 }
689
690
691 /*
692 * Check the nexthop reachability for a NHLFE and return if valid (reachable)
693 * or not.
694 * NOTE: Each NHLFE points to only 1 nexthop.
695 */
696 static int nhlfe_nexthop_active(struct zebra_nhlfe *nhlfe)
697 {
698 struct nexthop *nexthop;
699 struct interface *ifp;
700 struct zebra_ns *zns;
701
702 nexthop = nhlfe->nexthop;
703 if (!nexthop) // unexpected
704 return 0;
705
706 /* Check on nexthop based on type. */
707 switch (nexthop->type) {
708 case NEXTHOP_TYPE_IFINDEX:
709 /*
710 * Lookup if this type is special. The
711 * NEXTHOP_TYPE_IFINDEX is a pop and
712 * forward into a different table for
713 * processing. As such this ifindex
714 * passed to us may be a VRF device
715 * which will not be in the default
716 * VRF. So let's look in all of them
717 */
718 zns = zebra_ns_lookup(NS_DEFAULT);
719 ifp = if_lookup_by_index_per_ns(zns, nexthop->ifindex);
720 if (ifp && if_is_operative(ifp))
721 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
722 else
723 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
724 break;
725 case NEXTHOP_TYPE_IPV4:
726 case NEXTHOP_TYPE_IPV4_IFINDEX:
727 if (nhlfe_nexthop_active_ipv4(nhlfe, nexthop))
728 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
729 else
730 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
731 break;
732
733 case NEXTHOP_TYPE_IPV6:
734 if (nhlfe_nexthop_active_ipv6(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_IFINDEX:
741 if (IN6_IS_ADDR_LINKLOCAL(&nexthop->gate.ipv6)) {
742 ifp = if_lookup_by_index(nexthop->ifindex,
743 nexthop->vrf_id);
744 if (ifp && if_is_operative(ifp))
745 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
746 else
747 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
748 } else {
749 if (nhlfe_nexthop_active_ipv6(nhlfe, nexthop))
750 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
751 else
752 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
753 }
754 break;
755
756 case NEXTHOP_TYPE_BLACKHOLE:
757 break;
758 }
759
760 return CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
761 }
762
763 /*
764 * Walk through NHLFEs for a LSP forwarding entry, verify nexthop
765 * reachability and select the best. Multipath entries are also
766 * marked. This is invoked when an LSP scheduled for processing (due
767 * to some change) is examined.
768 */
769 static void lsp_select_best_nhlfe(struct zebra_lsp *lsp)
770 {
771 struct zebra_nhlfe *nhlfe;
772 struct zebra_nhlfe *best;
773 struct nexthop *nexthop;
774 int changed = 0;
775
776 if (!lsp)
777 return;
778
779 best = NULL;
780 lsp->num_ecmp = 0;
781 UNSET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
782
783 /*
784 * First compute the best path, after checking nexthop status. We are
785 * only concerned with non-deleted NHLFEs.
786 */
787 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
788 /* Clear selection flags. */
789 UNSET_FLAG(nhlfe->flags,
790 (NHLFE_FLAG_SELECTED | NHLFE_FLAG_MULTIPATH));
791
792 if (!CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED)
793 && nhlfe_nexthop_active(nhlfe)) {
794 if (!best || (nhlfe->distance < best->distance))
795 best = nhlfe;
796 }
797 }
798
799 lsp->best_nhlfe = best;
800 if (!lsp->best_nhlfe)
801 return;
802
803 /*
804 * Check the active status of backup nhlfes also
805 */
806 frr_each_safe(nhlfe_list, &lsp->backup_nhlfe_list, nhlfe) {
807 if (!CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED))
808 (void)nhlfe_nexthop_active(nhlfe);
809 }
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 frr_each(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
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_bucket *bucket, void *ctxt)
860 {
861 struct zebra_lsp *lsp;
862
863 lsp = (struct zebra_lsp *)bucket->data;
864 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED))
865 (void)dplane_lsp_delete(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_bucket *bucket, void *ctxt)
873 {
874 struct zebra_lsp *lsp;
875
876 lsp = (struct zebra_lsp *)bucket->data;
877
878 /* In the common flow, this is used when external events occur. For
879 * LSPs with backup nhlfes, we'll assume that the forwarding
880 * plane will use the backups to handle these events, until the
881 * owning protocol can react.
882 */
883 if (ctxt == NULL) {
884 /* Skip LSPs with backups */
885 if (nhlfe_list_first(&lsp->backup_nhlfe_list) != NULL) {
886 if (IS_ZEBRA_DEBUG_MPLS_DETAIL)
887 zlog_debug("%s: skip LSP in-label %u",
888 __func__, lsp->ile.in_label);
889 return;
890 }
891 }
892
893 (void)lsp_processq_add(lsp);
894 }
895
896 /*
897 * Process a LSP entry that is in the queue. Recalculate best NHLFE and
898 * any multipaths and update or delete from the kernel, as needed.
899 */
900 static wq_item_status lsp_process(struct work_queue *wq, void *data)
901 {
902 struct zebra_lsp *lsp;
903 struct zebra_nhlfe *oldbest, *newbest;
904 char buf[BUFSIZ], buf2[BUFSIZ];
905 struct zebra_vrf *zvrf = vrf_info_lookup(VRF_DEFAULT);
906 enum zebra_dplane_result res;
907
908 lsp = (struct zebra_lsp *)data;
909 if (!lsp) // unexpected
910 return WQ_SUCCESS;
911
912 oldbest = lsp->best_nhlfe;
913
914 /* Select best NHLFE(s) */
915 lsp_select_best_nhlfe(lsp);
916
917 newbest = lsp->best_nhlfe;
918
919 if (IS_ZEBRA_DEBUG_MPLS) {
920 if (oldbest)
921 nhlfe2str(oldbest, buf, sizeof(buf));
922 if (newbest)
923 nhlfe2str(newbest, buf2, sizeof(buf2));
924 zlog_debug(
925 "Process LSP in-label %u oldbest %s newbest %s flags 0x%x ecmp# %d",
926 lsp->ile.in_label, oldbest ? buf : "NULL",
927 newbest ? buf2 : "NULL", lsp->flags, lsp->num_ecmp);
928 }
929
930 if (!CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED)) {
931 /* Not already installed */
932 if (newbest) {
933
934 UNSET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
935
936 switch (dplane_lsp_add(lsp)) {
937 case ZEBRA_DPLANE_REQUEST_QUEUED:
938 /* Set 'installed' flag so we will know
939 * that an install is in-flight.
940 */
941 SET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
942
943 zvrf->lsp_installs_queued++;
944 break;
945 case ZEBRA_DPLANE_REQUEST_FAILURE:
946 flog_warn(EC_ZEBRA_LSP_INSTALL_FAILURE,
947 "LSP Install Failure: %u",
948 lsp->ile.in_label);
949 break;
950 case ZEBRA_DPLANE_REQUEST_SUCCESS:
951 zvrf->lsp_installs++;
952 break;
953 }
954 }
955 } else {
956 /* Installed, may need an update and/or delete. */
957 if (!newbest) {
958 res = dplane_lsp_delete(lsp);
959
960 /* We do some of the lsp cleanup immediately for
961 * deletes.
962 */
963 UNSET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
964 clear_nhlfe_installed(lsp);
965
966 switch (res) {
967 case ZEBRA_DPLANE_REQUEST_QUEUED:
968 zvrf->lsp_removals_queued++;
969 break;
970 case ZEBRA_DPLANE_REQUEST_FAILURE:
971 flog_warn(EC_ZEBRA_LSP_DELETE_FAILURE,
972 "LSP Deletion Failure: %u",
973 lsp->ile.in_label);
974 break;
975 case ZEBRA_DPLANE_REQUEST_SUCCESS:
976 zvrf->lsp_removals++;
977 break;
978 }
979 } else if (CHECK_FLAG(lsp->flags, LSP_FLAG_CHANGED)) {
980 struct zebra_nhlfe *nhlfe;
981 struct nexthop *nexthop;
982
983 UNSET_FLAG(lsp->flags, LSP_FLAG_CHANGED);
984
985 /* We leave the INSTALLED flag set here
986 * so we know an update is in-flight.
987 */
988
989 /*
990 * Any NHLFE that was installed but is not
991 * selected now needs to have its flags updated.
992 */
993 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
994 nexthop = nhlfe->nexthop;
995 if (!nexthop)
996 continue;
997
998 if (CHECK_FLAG(nhlfe->flags,
999 NHLFE_FLAG_INSTALLED)
1000 && !CHECK_FLAG(nhlfe->flags,
1001 NHLFE_FLAG_SELECTED)) {
1002 UNSET_FLAG(nhlfe->flags,
1003 NHLFE_FLAG_INSTALLED);
1004 UNSET_FLAG(nexthop->flags,
1005 NEXTHOP_FLAG_FIB);
1006 }
1007 }
1008
1009 switch (dplane_lsp_update(lsp)) {
1010 case ZEBRA_DPLANE_REQUEST_QUEUED:
1011 zvrf->lsp_installs_queued++;
1012 break;
1013 case ZEBRA_DPLANE_REQUEST_FAILURE:
1014 flog_warn(EC_ZEBRA_LSP_INSTALL_FAILURE,
1015 "LSP Update Failure: %u",
1016 lsp->ile.in_label);
1017 break;
1018 case ZEBRA_DPLANE_REQUEST_SUCCESS:
1019 zvrf->lsp_installs++;
1020 break;
1021 }
1022 }
1023 }
1024
1025 return WQ_SUCCESS;
1026 }
1027
1028
1029 /*
1030 * Callback upon processing completion of a LSP forwarding entry.
1031 */
1032 static void lsp_processq_del(struct work_queue *wq, void *data)
1033 {
1034 struct zebra_vrf *zvrf;
1035 struct zebra_lsp *lsp;
1036 struct hash *lsp_table;
1037 struct zebra_nhlfe *nhlfe;
1038
1039 /* If zebra is shutting down, don't delete any structs,
1040 * just ignore this callback. The LSPs will be cleaned up
1041 * during the shutdown processing.
1042 */
1043 if (zebra_router_in_shutdown())
1044 return;
1045
1046 zvrf = vrf_info_lookup(VRF_DEFAULT);
1047 assert(zvrf);
1048
1049 lsp_table = zvrf->lsp_table;
1050 if (!lsp_table) // unexpected
1051 return;
1052
1053 lsp = (struct zebra_lsp *)data;
1054 if (!lsp) // unexpected
1055 return;
1056
1057 /* Clear flag, remove any NHLFEs marked for deletion. If no NHLFEs
1058 * exist,
1059 * delete LSP entry also.
1060 */
1061 UNSET_FLAG(lsp->flags, LSP_FLAG_SCHEDULED);
1062
1063 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
1064 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED))
1065 nhlfe_del(nhlfe);
1066 }
1067
1068 frr_each_safe(nhlfe_list, &lsp->backup_nhlfe_list, nhlfe) {
1069 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED))
1070 nhlfe_del(nhlfe);
1071 }
1072
1073 lsp_check_free(lsp_table, &lsp);
1074 }
1075
1076 /*
1077 * Callback upon finishing the processing of all scheduled
1078 * LSP forwarding entries.
1079 */
1080 static void lsp_processq_complete(struct work_queue *wq)
1081 {
1082 /* Nothing to do for now. */
1083 }
1084
1085 /*
1086 * Add LSP forwarding entry to queue for subsequent processing.
1087 */
1088 static int lsp_processq_add(struct zebra_lsp *lsp)
1089 {
1090 /* If already scheduled, exit. */
1091 if (CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED))
1092 return 0;
1093
1094 if (zrouter.lsp_process_q == NULL) {
1095 flog_err(EC_ZEBRA_WQ_NONEXISTENT,
1096 "%s: work_queue does not exist!", __func__);
1097 return -1;
1098 }
1099
1100 work_queue_add(zrouter.lsp_process_q, lsp);
1101 SET_FLAG(lsp->flags, LSP_FLAG_SCHEDULED);
1102 return 0;
1103 }
1104
1105 /*
1106 * Callback to allocate LSP forwarding table entry.
1107 */
1108 static void *lsp_alloc(void *p)
1109 {
1110 const struct zebra_ile *ile = p;
1111 struct zebra_lsp *lsp;
1112
1113 lsp = XCALLOC(MTYPE_LSP, sizeof(struct zebra_lsp));
1114 lsp->ile = *ile;
1115 nhlfe_list_init(&lsp->nhlfe_list);
1116 nhlfe_list_init(&lsp->backup_nhlfe_list);
1117
1118 if (IS_ZEBRA_DEBUG_MPLS)
1119 zlog_debug("Alloc LSP in-label %u", lsp->ile.in_label);
1120
1121 return ((void *)lsp);
1122 }
1123
1124 /*
1125 * Check whether lsp can be freed - no nhlfes, e.g., and call free api
1126 */
1127 static void lsp_check_free(struct hash *lsp_table, struct zebra_lsp **plsp)
1128 {
1129 struct zebra_lsp *lsp;
1130
1131 if (plsp == NULL || *plsp == NULL)
1132 return;
1133
1134 lsp = *plsp;
1135
1136 if ((nhlfe_list_first(&lsp->nhlfe_list) == NULL) &&
1137 (nhlfe_list_first(&lsp->backup_nhlfe_list) == NULL) &&
1138 !CHECK_FLAG(lsp->flags, LSP_FLAG_SCHEDULED))
1139 lsp_free(lsp_table, plsp);
1140 }
1141
1142 static void lsp_free_nhlfe(struct zebra_lsp *lsp)
1143 {
1144 struct zebra_nhlfe *nhlfe;
1145
1146 while ((nhlfe = nhlfe_list_first(&lsp->nhlfe_list))) {
1147 nhlfe_list_del(&lsp->nhlfe_list, nhlfe);
1148 nhlfe_free(nhlfe);
1149 }
1150
1151 while ((nhlfe = nhlfe_list_first(&lsp->backup_nhlfe_list))) {
1152 nhlfe_list_del(&lsp->backup_nhlfe_list, nhlfe);
1153 nhlfe_free(nhlfe);
1154 }
1155 }
1156
1157 /*
1158 * Dtor for an LSP: remove from ile hash, release any internal allocations,
1159 * free LSP object.
1160 */
1161 static void lsp_free(struct hash *lsp_table, struct zebra_lsp **plsp)
1162 {
1163 struct zebra_lsp *lsp;
1164
1165 if (plsp == NULL || *plsp == NULL)
1166 return;
1167
1168 lsp = *plsp;
1169
1170 if (IS_ZEBRA_DEBUG_MPLS)
1171 zlog_debug("Free LSP in-label %u flags 0x%x",
1172 lsp->ile.in_label, lsp->flags);
1173
1174 lsp_free_nhlfe(lsp);
1175
1176 hash_release(lsp_table, &lsp->ile);
1177 XFREE(MTYPE_LSP, lsp);
1178
1179 *plsp = NULL;
1180 }
1181
1182 /*
1183 * Create printable string for NHLFE entry.
1184 */
1185 static char *nhlfe2str(const struct zebra_nhlfe *nhlfe, char *buf, int size)
1186 {
1187 const struct nexthop *nexthop;
1188
1189 buf[0] = '\0';
1190 nexthop = nhlfe->nexthop;
1191 switch (nexthop->type) {
1192 case NEXTHOP_TYPE_IPV4:
1193 case NEXTHOP_TYPE_IPV4_IFINDEX:
1194 inet_ntop(AF_INET, &nexthop->gate.ipv4, buf, size);
1195 break;
1196 case NEXTHOP_TYPE_IPV6:
1197 case NEXTHOP_TYPE_IPV6_IFINDEX:
1198 inet_ntop(AF_INET6, &nexthop->gate.ipv6, buf, size);
1199 break;
1200 case NEXTHOP_TYPE_IFINDEX:
1201 snprintf(buf, size, "Ifindex: %u", nexthop->ifindex);
1202 case NEXTHOP_TYPE_BLACKHOLE:
1203 break;
1204 }
1205
1206 return buf;
1207 }
1208
1209 /*
1210 * Check if NHLFE matches with search info passed.
1211 */
1212 static int nhlfe_nhop_match(struct zebra_nhlfe *nhlfe,
1213 enum nexthop_types_t gtype,
1214 const union g_addr *gate, ifindex_t ifindex)
1215 {
1216 struct nexthop *nhop;
1217 int cmp = 1;
1218
1219 nhop = nhlfe->nexthop;
1220 if (!nhop)
1221 return 1;
1222
1223 if (nhop->type != gtype)
1224 return 1;
1225
1226 switch (nhop->type) {
1227 case NEXTHOP_TYPE_IPV4:
1228 case NEXTHOP_TYPE_IPV4_IFINDEX:
1229 cmp = memcmp(&(nhop->gate.ipv4), &(gate->ipv4),
1230 sizeof(struct in_addr));
1231 if (!cmp && nhop->type == NEXTHOP_TYPE_IPV4_IFINDEX)
1232 cmp = !(nhop->ifindex == ifindex);
1233 break;
1234 case NEXTHOP_TYPE_IPV6:
1235 case NEXTHOP_TYPE_IPV6_IFINDEX:
1236 cmp = memcmp(&(nhop->gate.ipv6), &(gate->ipv6),
1237 sizeof(struct in6_addr));
1238 if (!cmp && nhop->type == NEXTHOP_TYPE_IPV6_IFINDEX)
1239 cmp = !(nhop->ifindex == ifindex);
1240 break;
1241 case NEXTHOP_TYPE_IFINDEX:
1242 cmp = !(nhop->ifindex == ifindex);
1243 break;
1244 case NEXTHOP_TYPE_BLACKHOLE:
1245 break;
1246 }
1247
1248 return cmp;
1249 }
1250
1251
1252 /*
1253 * Locate NHLFE that matches with passed info.
1254 */
1255 static struct zebra_nhlfe *nhlfe_find(struct nhlfe_list_head *list,
1256 enum lsp_types_t lsp_type,
1257 enum nexthop_types_t gtype,
1258 const union g_addr *gate,
1259 ifindex_t ifindex)
1260 {
1261 struct zebra_nhlfe *nhlfe;
1262
1263 frr_each_safe(nhlfe_list, list, nhlfe) {
1264 if (nhlfe->type != lsp_type)
1265 continue;
1266 if (!nhlfe_nhop_match(nhlfe, gtype, gate, ifindex))
1267 break;
1268 }
1269
1270 return nhlfe;
1271 }
1272
1273 /*
1274 * Allocate and init new NHLFE.
1275 */
1276 static struct zebra_nhlfe *
1277 nhlfe_alloc(struct zebra_lsp *lsp, enum lsp_types_t lsp_type,
1278 enum nexthop_types_t gtype, const union g_addr *gate,
1279 ifindex_t ifindex, uint8_t num_labels, const mpls_label_t *labels)
1280 {
1281 struct zebra_nhlfe *nhlfe;
1282 struct nexthop *nexthop;
1283
1284 assert(lsp);
1285
1286 nhlfe = XCALLOC(MTYPE_NHLFE, sizeof(struct zebra_nhlfe));
1287
1288 nhlfe->lsp = lsp;
1289 nhlfe->type = lsp_type;
1290 nhlfe->distance = lsp_distance(lsp_type);
1291
1292 nexthop = nexthop_new();
1293
1294 nexthop_add_labels(nexthop, lsp_type, num_labels, labels);
1295
1296 nexthop->vrf_id = VRF_DEFAULT;
1297 nexthop->type = gtype;
1298 switch (nexthop->type) {
1299 case NEXTHOP_TYPE_IPV4:
1300 case NEXTHOP_TYPE_IPV4_IFINDEX:
1301 nexthop->gate.ipv4 = gate->ipv4;
1302 if (ifindex)
1303 nexthop->ifindex = ifindex;
1304 break;
1305 case NEXTHOP_TYPE_IPV6:
1306 case NEXTHOP_TYPE_IPV6_IFINDEX:
1307 nexthop->gate.ipv6 = gate->ipv6;
1308 if (ifindex)
1309 nexthop->ifindex = ifindex;
1310 break;
1311 case NEXTHOP_TYPE_IFINDEX:
1312 nexthop->ifindex = ifindex;
1313 break;
1314 case NEXTHOP_TYPE_BLACKHOLE:
1315 if (IS_ZEBRA_DEBUG_MPLS)
1316 zlog_debug("%s: invalid: blackhole nexthop", __func__);
1317
1318 nexthop_free(nexthop);
1319 XFREE(MTYPE_NHLFE, nhlfe);
1320 return NULL;
1321 }
1322 nhlfe->nexthop = nexthop;
1323
1324 return nhlfe;
1325 }
1326
1327 /*
1328 * Add primary or backup NHLFE. Base entry must have been created and
1329 * duplicate check done.
1330 */
1331 static struct zebra_nhlfe *nhlfe_add(struct zebra_lsp *lsp,
1332 enum lsp_types_t lsp_type,
1333 enum nexthop_types_t gtype,
1334 const union g_addr *gate,
1335 ifindex_t ifindex, uint8_t num_labels,
1336 const mpls_label_t *labels, bool is_backup)
1337 {
1338 struct zebra_nhlfe *nhlfe;
1339
1340 if (!lsp)
1341 return NULL;
1342
1343 /* Must have labels */
1344 if (num_labels == 0 || labels == NULL) {
1345 if (IS_ZEBRA_DEBUG_MPLS)
1346 zlog_debug("%s: invalid nexthop: no labels", __func__);
1347
1348 return NULL;
1349 }
1350
1351 /* Allocate new object */
1352 nhlfe = nhlfe_alloc(lsp, lsp_type, gtype, gate, ifindex, num_labels,
1353 labels);
1354
1355 if (!nhlfe)
1356 return NULL;
1357
1358 /* Enqueue to LSP: primaries at head of list, backups at tail */
1359 if (is_backup) {
1360 SET_FLAG(nhlfe->flags, NHLFE_FLAG_IS_BACKUP);
1361 nhlfe_list_add_tail(&lsp->backup_nhlfe_list, nhlfe);
1362 } else
1363 nhlfe_list_add_head(&lsp->nhlfe_list, nhlfe);
1364
1365 return nhlfe;
1366 }
1367
1368 /*
1369 * Common delete for NHLFEs.
1370 */
1371 static void nhlfe_free(struct zebra_nhlfe *nhlfe)
1372 {
1373 if (!nhlfe)
1374 return;
1375
1376 /* Free nexthop. */
1377 if (nhlfe->nexthop)
1378 nexthop_free(nhlfe->nexthop);
1379
1380 nhlfe->nexthop = NULL;
1381
1382 XFREE(MTYPE_NHLFE, nhlfe);
1383 }
1384
1385
1386 /*
1387 * Disconnect NHLFE from LSP, and free. Entry must be present on LSP's list.
1388 */
1389 static int nhlfe_del(struct zebra_nhlfe *nhlfe)
1390 {
1391 struct zebra_lsp *lsp;
1392
1393 if (!nhlfe)
1394 return -1;
1395
1396 lsp = nhlfe->lsp;
1397 if (!lsp)
1398 return -1;
1399
1400 if (nhlfe == lsp->best_nhlfe)
1401 lsp->best_nhlfe = NULL;
1402
1403 /* Unlink from LSP */
1404 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_IS_BACKUP))
1405 nhlfe_list_del(&lsp->backup_nhlfe_list, nhlfe);
1406 else
1407 nhlfe_list_del(&lsp->nhlfe_list, nhlfe);
1408
1409 nhlfe->lsp = NULL;
1410
1411 nhlfe_free(nhlfe);
1412
1413 return 0;
1414 }
1415
1416 /*
1417 * Update label for NHLFE entry.
1418 */
1419 static void nhlfe_out_label_update(struct zebra_nhlfe *nhlfe,
1420 struct mpls_label_stack *nh_label)
1421 {
1422 nhlfe->nexthop->nh_label->label[0] = nh_label->label[0];
1423 }
1424
1425 static int mpls_lsp_uninstall_all(struct hash *lsp_table, struct zebra_lsp *lsp,
1426 enum lsp_types_t type)
1427 {
1428 struct zebra_nhlfe *nhlfe;
1429 int schedule_lsp = 0;
1430 char buf[BUFSIZ];
1431
1432 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED))
1433 schedule_lsp = 1;
1434
1435 /* Mark NHLFEs for delete or directly delete, as appropriate. */
1436 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
1437 /* Skip non-static NHLFEs */
1438 if (nhlfe->type != type)
1439 continue;
1440
1441 if (IS_ZEBRA_DEBUG_MPLS) {
1442 nhlfe2str(nhlfe, buf, sizeof(buf));
1443 zlog_debug(
1444 "Del LSP in-label %u type %d nexthop %s flags 0x%x",
1445 lsp->ile.in_label, type, buf, nhlfe->flags);
1446 }
1447
1448 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED)) {
1449 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
1450 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
1451 schedule_lsp = 1;
1452 } else {
1453 nhlfe_del(nhlfe);
1454 }
1455 }
1456
1457 frr_each_safe(nhlfe_list, &lsp->backup_nhlfe_list, nhlfe) {
1458 /* Skip non-static NHLFEs */
1459 if (nhlfe->type != type)
1460 continue;
1461
1462 if (IS_ZEBRA_DEBUG_MPLS) {
1463 nhlfe2str(nhlfe, buf, sizeof(buf));
1464 zlog_debug(
1465 "Del backup LSP in-label %u type %d nexthop %s flags 0x%x",
1466 lsp->ile.in_label, type, buf, nhlfe->flags);
1467 }
1468
1469 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED)) {
1470 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
1471 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
1472 schedule_lsp = 1;
1473 } else {
1474 nhlfe_del(nhlfe);
1475 }
1476 }
1477
1478 /* Queue LSP for processing, if needed, else delete. */
1479 if (schedule_lsp) {
1480 if (IS_ZEBRA_DEBUG_MPLS) {
1481 zlog_debug("Schedule LSP in-label %u flags 0x%x",
1482 lsp->ile.in_label, lsp->flags);
1483 }
1484 if (lsp_processq_add(lsp))
1485 return -1;
1486 } else {
1487 lsp_check_free(lsp_table, &lsp);
1488 }
1489
1490 return 0;
1491 }
1492
1493 /*
1494 * Uninstall all static NHLFEs for a particular LSP forwarding entry.
1495 * If no other NHLFEs exist, the entry would be deleted.
1496 */
1497 static int mpls_static_lsp_uninstall_all(struct zebra_vrf *zvrf,
1498 mpls_label_t in_label)
1499 {
1500 struct hash *lsp_table;
1501 struct zebra_ile tmp_ile;
1502 struct zebra_lsp *lsp;
1503
1504 /* Lookup table. */
1505 lsp_table = zvrf->lsp_table;
1506 if (!lsp_table)
1507 return -1;
1508
1509 /* If entry is not present, exit. */
1510 tmp_ile.in_label = in_label;
1511 lsp = hash_lookup(lsp_table, &tmp_ile);
1512 if (!lsp || (nhlfe_list_first(&lsp->nhlfe_list) == NULL))
1513 return 0;
1514
1515 return mpls_lsp_uninstall_all(lsp_table, lsp, ZEBRA_LSP_STATIC);
1516 }
1517
1518 static json_object *nhlfe_json(struct zebra_nhlfe *nhlfe)
1519 {
1520 json_object *json_nhlfe = NULL;
1521 json_object *json_backups = NULL;
1522 json_object *json_label_stack;
1523 struct nexthop *nexthop = nhlfe->nexthop;
1524 int i;
1525
1526 json_nhlfe = json_object_new_object();
1527 json_object_string_add(json_nhlfe, "type", nhlfe_type2str(nhlfe->type));
1528 json_object_int_add(json_nhlfe, "outLabel",
1529 nexthop->nh_label->label[0]);
1530
1531 json_label_stack = json_object_new_array();
1532 json_object_object_add(json_nhlfe, "outLabelStack", json_label_stack);
1533 for (i = 0; i < nexthop->nh_label->num_labels; i++)
1534 json_object_array_add(
1535 json_label_stack,
1536 json_object_new_int(nexthop->nh_label->label[i]));
1537
1538 json_object_int_add(json_nhlfe, "distance", nhlfe->distance);
1539
1540 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED))
1541 json_object_boolean_true_add(json_nhlfe, "installed");
1542
1543 switch (nexthop->type) {
1544 case NEXTHOP_TYPE_IPV4:
1545 case NEXTHOP_TYPE_IPV4_IFINDEX:
1546 json_object_string_addf(json_nhlfe, "nexthop", "%pI4",
1547 &nexthop->gate.ipv4);
1548 break;
1549 case NEXTHOP_TYPE_IPV6:
1550 case NEXTHOP_TYPE_IPV6_IFINDEX:
1551 json_object_string_addf(json_nhlfe, "nexthop", "%pI6",
1552 &nexthop->gate.ipv6);
1553
1554 if (nexthop->ifindex)
1555 json_object_string_add(json_nhlfe, "interface",
1556 ifindex2ifname(nexthop->ifindex,
1557 nexthop->vrf_id));
1558 break;
1559 case NEXTHOP_TYPE_IFINDEX:
1560 if (nexthop->ifindex)
1561 json_object_string_add(json_nhlfe, "interface",
1562 ifindex2ifname(nexthop->ifindex,
1563 nexthop->vrf_id));
1564 break;
1565 case NEXTHOP_TYPE_BLACKHOLE:
1566 break;
1567 }
1568
1569 if (CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_HAS_BACKUP)) {
1570 json_backups = json_object_new_array();
1571 for (i = 0; i < nexthop->backup_num; i++) {
1572 json_object_array_add(
1573 json_backups,
1574 json_object_new_int(nexthop->backup_idx[i]));
1575 }
1576
1577 json_object_object_add(json_nhlfe, "backupIndex",
1578 json_backups);
1579 }
1580
1581 return json_nhlfe;
1582 }
1583
1584 /*
1585 * Print the NHLFE for a LSP forwarding entry.
1586 */
1587 static void nhlfe_print(struct zebra_nhlfe *nhlfe, struct vty *vty,
1588 const char *indent)
1589 {
1590 struct nexthop *nexthop;
1591 char buf[MPLS_LABEL_STRLEN];
1592
1593 nexthop = nhlfe->nexthop;
1594 if (!nexthop || !nexthop->nh_label) // unexpected
1595 return;
1596
1597 vty_out(vty, " type: %s remote label: %s distance: %d\n",
1598 nhlfe_type2str(nhlfe->type),
1599 mpls_label2str(nexthop->nh_label->num_labels,
1600 nexthop->nh_label->label,
1601 buf, sizeof(buf), 0),
1602 nhlfe->distance);
1603
1604 if (indent)
1605 vty_out(vty, "%s", indent);
1606
1607 switch (nexthop->type) {
1608 case NEXTHOP_TYPE_IPV4:
1609 case NEXTHOP_TYPE_IPV4_IFINDEX:
1610 vty_out(vty, " via %pI4", &nexthop->gate.ipv4);
1611 if (nexthop->ifindex)
1612 vty_out(vty, " dev %s",
1613 ifindex2ifname(nexthop->ifindex,
1614 nexthop->vrf_id));
1615 break;
1616 case NEXTHOP_TYPE_IPV6:
1617 case NEXTHOP_TYPE_IPV6_IFINDEX:
1618 vty_out(vty, " via %s",
1619 inet_ntop(AF_INET6, &nexthop->gate.ipv6, buf,
1620 sizeof(buf)));
1621 if (nexthop->ifindex)
1622 vty_out(vty, " dev %s",
1623 ifindex2ifname(nexthop->ifindex,
1624 nexthop->vrf_id));
1625 break;
1626 case NEXTHOP_TYPE_IFINDEX:
1627 if (nexthop->ifindex)
1628 vty_out(vty, " dev %s",
1629 ifindex2ifname(nexthop->ifindex,
1630 nexthop->vrf_id));
1631 break;
1632 case NEXTHOP_TYPE_BLACKHOLE:
1633 break;
1634 }
1635 vty_out(vty, "%s",
1636 CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_IS_BACKUP) ? " (backup)"
1637 : "");
1638 vty_out(vty, "%s",
1639 CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED) ? " (installed)"
1640 : "");
1641 vty_out(vty, "\n");
1642 }
1643
1644 /*
1645 * Print an LSP forwarding entry.
1646 */
1647 static void lsp_print(struct vty *vty, struct zebra_lsp *lsp)
1648 {
1649 struct zebra_nhlfe *nhlfe, *backup;
1650 int i, j;
1651
1652 vty_out(vty, "Local label: %u%s\n", lsp->ile.in_label,
1653 CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED) ? " (installed)"
1654 : "");
1655
1656 frr_each(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
1657 nhlfe_print(nhlfe, vty, NULL);
1658
1659 if (nhlfe->nexthop == NULL ||
1660 !CHECK_FLAG(nhlfe->nexthop->flags,
1661 NEXTHOP_FLAG_HAS_BACKUP))
1662 continue;
1663
1664 /* Backup nhlfes: find backups in backup list */
1665
1666 for (j = 0; j < nhlfe->nexthop->backup_num; j++) {
1667 i = 0;
1668 backup = NULL;
1669 frr_each(nhlfe_list, &lsp->backup_nhlfe_list, backup) {
1670 if (i == nhlfe->nexthop->backup_idx[j])
1671 break;
1672 i++;
1673 }
1674
1675 if (backup) {
1676 vty_out(vty, " [backup %d]", i);
1677 nhlfe_print(backup, vty, " ");
1678 }
1679 }
1680 }
1681 }
1682
1683 /*
1684 * JSON objects for an LSP forwarding entry.
1685 */
1686 static json_object *lsp_json(struct zebra_lsp *lsp)
1687 {
1688 struct zebra_nhlfe *nhlfe = NULL;
1689 json_object *json = json_object_new_object();
1690 json_object *json_nhlfe_list = json_object_new_array();
1691
1692 json_object_int_add(json, "inLabel", lsp->ile.in_label);
1693
1694 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED))
1695 json_object_boolean_true_add(json, "installed");
1696
1697 frr_each(nhlfe_list, &lsp->nhlfe_list, nhlfe)
1698 json_object_array_add(json_nhlfe_list, nhlfe_json(nhlfe));
1699
1700 json_object_object_add(json, "nexthops", json_nhlfe_list);
1701 json_nhlfe_list = NULL;
1702
1703
1704 frr_each(nhlfe_list, &lsp->backup_nhlfe_list, nhlfe) {
1705 if (json_nhlfe_list == NULL)
1706 json_nhlfe_list = json_object_new_array();
1707
1708 json_object_array_add(json_nhlfe_list, nhlfe_json(nhlfe));
1709 }
1710
1711 if (json_nhlfe_list)
1712 json_object_object_add(json, "backupNexthops", json_nhlfe_list);
1713
1714 return json;
1715 }
1716
1717
1718 /* Return a sorted linked list of the hash contents */
1719 static struct list *hash_get_sorted_list(struct hash *hash, void *cmp)
1720 {
1721 unsigned int i;
1722 struct hash_bucket *hb;
1723 struct list *sorted_list = list_new();
1724
1725 sorted_list->cmp = (int (*)(void *, void *))cmp;
1726
1727 for (i = 0; i < hash->size; i++)
1728 for (hb = hash->index[i]; hb; hb = hb->next)
1729 listnode_add_sort(sorted_list, hb->data);
1730
1731 return sorted_list;
1732 }
1733
1734 /*
1735 * Compare two LSPs based on their label values.
1736 */
1737 static int lsp_cmp(const struct zebra_lsp *lsp1, const struct zebra_lsp *lsp2)
1738 {
1739 if (lsp1->ile.in_label < lsp2->ile.in_label)
1740 return -1;
1741
1742 if (lsp1->ile.in_label > lsp2->ile.in_label)
1743 return 1;
1744
1745 return 0;
1746 }
1747
1748 /*
1749 * Initialize work queue for processing changed LSPs.
1750 */
1751 static void mpls_processq_init(void)
1752 {
1753 zrouter.lsp_process_q = work_queue_new(zrouter.master, "LSP processing");
1754
1755 zrouter.lsp_process_q->spec.workfunc = &lsp_process;
1756 zrouter.lsp_process_q->spec.del_item_data = &lsp_processq_del;
1757 zrouter.lsp_process_q->spec.errorfunc = NULL;
1758 zrouter.lsp_process_q->spec.completion_func = &lsp_processq_complete;
1759 zrouter.lsp_process_q->spec.max_retries = 0;
1760 zrouter.lsp_process_q->spec.hold = 10;
1761 }
1762
1763
1764 /*
1765 * Process LSP update results from zebra dataplane.
1766 */
1767 void zebra_mpls_lsp_dplane_result(struct zebra_dplane_ctx *ctx)
1768 {
1769 struct zebra_vrf *zvrf;
1770 mpls_label_t label;
1771 struct zebra_ile tmp_ile;
1772 struct hash *lsp_table;
1773 struct zebra_lsp *lsp;
1774 struct zebra_nhlfe *nhlfe;
1775 struct nexthop *nexthop;
1776 enum dplane_op_e op;
1777 enum zebra_dplane_result status;
1778 enum zebra_sr_policy_update_label_mode update_mode;
1779
1780 op = dplane_ctx_get_op(ctx);
1781 status = dplane_ctx_get_status(ctx);
1782
1783 if (IS_ZEBRA_DEBUG_DPLANE_DETAIL)
1784 zlog_debug("LSP dplane ctx %p, op %s, in-label %u, result %s",
1785 ctx, dplane_op2str(op),
1786 dplane_ctx_get_in_label(ctx),
1787 dplane_res2str(status));
1788
1789 label = dplane_ctx_get_in_label(ctx);
1790
1791 switch (op) {
1792 case DPLANE_OP_LSP_INSTALL:
1793 case DPLANE_OP_LSP_UPDATE:
1794 /* Look for zebra LSP object */
1795 zvrf = vrf_info_lookup(VRF_DEFAULT);
1796 if (zvrf == NULL)
1797 break;
1798
1799 lsp_table = zvrf->lsp_table;
1800
1801 tmp_ile.in_label = label;
1802 lsp = hash_lookup(lsp_table, &tmp_ile);
1803 if (lsp == NULL) {
1804 if (IS_ZEBRA_DEBUG_DPLANE)
1805 zlog_debug("LSP ctx %p: in-label %u not found",
1806 ctx, dplane_ctx_get_in_label(ctx));
1807 break;
1808 }
1809
1810 /* TODO -- Confirm that this result is still 'current' */
1811
1812 if (status != ZEBRA_DPLANE_REQUEST_SUCCESS) {
1813 UNSET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
1814 clear_nhlfe_installed(lsp);
1815 flog_warn(EC_ZEBRA_LSP_INSTALL_FAILURE,
1816 "LSP Install Failure: in-label %u",
1817 lsp->ile.in_label);
1818 break;
1819 }
1820
1821 /* Update zebra object */
1822 SET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
1823 frr_each(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
1824 nexthop = nhlfe->nexthop;
1825 if (!nexthop)
1826 continue;
1827
1828 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED) &&
1829 CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE)) {
1830 SET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
1831 SET_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB);
1832 }
1833 }
1834
1835 update_mode = (op == DPLANE_OP_LSP_INSTALL)
1836 ? ZEBRA_SR_POLICY_LABEL_CREATED
1837 : ZEBRA_SR_POLICY_LABEL_UPDATED;
1838 zebra_sr_policy_label_update(label, update_mode);
1839 break;
1840
1841 case DPLANE_OP_LSP_DELETE:
1842 if (status != ZEBRA_DPLANE_REQUEST_SUCCESS) {
1843 flog_warn(EC_ZEBRA_LSP_DELETE_FAILURE,
1844 "LSP Deletion Failure: in-label %u",
1845 dplane_ctx_get_in_label(ctx));
1846 break;
1847 }
1848 zebra_sr_policy_label_update(label,
1849 ZEBRA_SR_POLICY_LABEL_REMOVED);
1850 break;
1851
1852 default:
1853 break;
1854
1855 } /* Switch */
1856 }
1857
1858 /*
1859 * Process LSP installation info from two sets of nhlfes: a set from
1860 * a dplane notification, and a set from the zebra LSP object. Update
1861 * counters of installed nexthops, and return whether the LSP has changed.
1862 */
1863 static bool compare_notif_nhlfes(const struct nhlfe_list_head *ctx_head,
1864 struct nhlfe_list_head *nhlfe_head,
1865 int *start_counter, int *end_counter)
1866 {
1867 struct zebra_nhlfe *nhlfe;
1868 const struct zebra_nhlfe *ctx_nhlfe;
1869 struct nexthop *nexthop;
1870 const struct nexthop *ctx_nexthop;
1871 int start_count = 0, end_count = 0;
1872 bool changed_p = false;
1873 bool is_debug = (IS_ZEBRA_DEBUG_DPLANE | IS_ZEBRA_DEBUG_MPLS);
1874
1875 frr_each_safe(nhlfe_list, nhlfe_head, nhlfe) {
1876 char buf[NEXTHOP_STRLEN];
1877
1878 nexthop = nhlfe->nexthop;
1879 if (!nexthop)
1880 continue;
1881
1882 if (CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB))
1883 start_count++;
1884
1885 ctx_nhlfe = NULL;
1886 ctx_nexthop = NULL;
1887 frr_each(nhlfe_list_const, ctx_head, ctx_nhlfe) {
1888 ctx_nexthop = ctx_nhlfe->nexthop;
1889 if (!ctx_nexthop)
1890 continue;
1891
1892 if ((ctx_nexthop->type == nexthop->type) &&
1893 nexthop_same(ctx_nexthop, nexthop)) {
1894 /* Matched */
1895 break;
1896 }
1897 }
1898
1899 if (is_debug)
1900 nexthop2str(nexthop, buf, sizeof(buf));
1901
1902 if (ctx_nhlfe && ctx_nexthop) {
1903 if (is_debug) {
1904 const char *tstr = "";
1905
1906 if (!CHECK_FLAG(ctx_nhlfe->flags,
1907 NHLFE_FLAG_INSTALLED))
1908 tstr = "not ";
1909
1910 zlog_debug("LSP dplane notif: matched nh %s (%sinstalled)",
1911 buf, tstr);
1912 }
1913
1914 /* Test zebra nhlfe install state */
1915 if (CHECK_FLAG(ctx_nhlfe->flags,
1916 NHLFE_FLAG_INSTALLED)) {
1917
1918 if (!CHECK_FLAG(nhlfe->flags,
1919 NHLFE_FLAG_INSTALLED))
1920 changed_p = true;
1921
1922 /* Update counter */
1923 end_count++;
1924 } else {
1925
1926 if (CHECK_FLAG(nhlfe->flags,
1927 NHLFE_FLAG_INSTALLED))
1928 changed_p = true;
1929 }
1930
1931 } else {
1932 /* Not mentioned in lfib set -> uninstalled */
1933 if (CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED) ||
1934 CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE) ||
1935 CHECK_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB)) {
1936 changed_p = true;
1937 }
1938
1939 if (is_debug)
1940 zlog_debug("LSP dplane notif: no match, nh %s",
1941 buf);
1942 }
1943 }
1944
1945 if (start_counter)
1946 *start_counter += start_count;
1947 if (end_counter)
1948 *end_counter += end_count;
1949
1950 return changed_p;
1951 }
1952
1953 /*
1954 * Update an lsp nhlfe list from a dplane context, typically an async
1955 * notification context. Update the LSP list to match the installed
1956 * status from the context's list.
1957 */
1958 static int update_nhlfes_from_ctx(struct nhlfe_list_head *nhlfe_head,
1959 const struct nhlfe_list_head *ctx_head)
1960 {
1961 int ret = 0;
1962 struct zebra_nhlfe *nhlfe;
1963 const struct zebra_nhlfe *ctx_nhlfe;
1964 struct nexthop *nexthop;
1965 const struct nexthop *ctx_nexthop;
1966 bool is_debug = (IS_ZEBRA_DEBUG_DPLANE | IS_ZEBRA_DEBUG_MPLS);
1967
1968 frr_each_safe(nhlfe_list, nhlfe_head, nhlfe) {
1969 char buf[NEXTHOP_STRLEN];
1970
1971 nexthop = nhlfe->nexthop;
1972 if (!nexthop)
1973 continue;
1974
1975 ctx_nhlfe = NULL;
1976 ctx_nexthop = NULL;
1977 frr_each(nhlfe_list_const, ctx_head, ctx_nhlfe) {
1978 ctx_nexthop = ctx_nhlfe->nexthop;
1979 if (!ctx_nexthop)
1980 continue;
1981
1982 if ((ctx_nexthop->type == nexthop->type) &&
1983 nexthop_same(ctx_nexthop, nexthop)) {
1984 /* Matched */
1985 break;
1986 }
1987 }
1988
1989 if (is_debug)
1990 nexthop2str(nexthop, buf, sizeof(buf));
1991
1992 if (ctx_nhlfe && ctx_nexthop) {
1993
1994 /* Bring zebra nhlfe install state into sync */
1995 if (CHECK_FLAG(ctx_nhlfe->flags,
1996 NHLFE_FLAG_INSTALLED)) {
1997 if (is_debug)
1998 zlog_debug("%s: matched lsp nhlfe %s (installed)",
1999 __func__, buf);
2000
2001 SET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
2002 SET_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED);
2003
2004 } else {
2005 if (is_debug)
2006 zlog_debug("%s: matched lsp nhlfe %s (not installed)",
2007 __func__, buf);
2008
2009 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
2010 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED);
2011 }
2012
2013 if (CHECK_FLAG(ctx_nhlfe->nexthop->flags,
2014 NEXTHOP_FLAG_FIB)) {
2015 SET_FLAG(nhlfe->nexthop->flags,
2016 NEXTHOP_FLAG_ACTIVE);
2017 SET_FLAG(nhlfe->nexthop->flags,
2018 NEXTHOP_FLAG_FIB);
2019 } else {
2020 UNSET_FLAG(nhlfe->nexthop->flags,
2021 NEXTHOP_FLAG_ACTIVE);
2022 UNSET_FLAG(nhlfe->nexthop->flags,
2023 NEXTHOP_FLAG_FIB);
2024 }
2025
2026 } else {
2027 /* Not mentioned in lfib set -> uninstalled */
2028 if (is_debug)
2029 zlog_debug("%s: no match for lsp nhlfe %s",
2030 __func__, buf);
2031 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED);
2032 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_SELECTED);
2033 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_FIB);
2034 UNSET_FLAG(nexthop->flags, NEXTHOP_FLAG_ACTIVE);
2035 }
2036 }
2037
2038 return ret;
2039 }
2040
2041 /*
2042 * Process async dplane notifications.
2043 */
2044 void zebra_mpls_process_dplane_notify(struct zebra_dplane_ctx *ctx)
2045 {
2046 struct zebra_vrf *zvrf;
2047 struct zebra_ile tmp_ile;
2048 struct hash *lsp_table;
2049 struct zebra_lsp *lsp;
2050 const struct nhlfe_list_head *ctx_list;
2051 int start_count = 0, end_count = 0; /* Installed counts */
2052 bool changed_p = false;
2053 bool is_debug = (IS_ZEBRA_DEBUG_DPLANE | IS_ZEBRA_DEBUG_MPLS);
2054 enum zebra_sr_policy_update_label_mode update_mode;
2055
2056 if (is_debug)
2057 zlog_debug("LSP dplane notif, in-label %u",
2058 dplane_ctx_get_in_label(ctx));
2059
2060 /* Look for zebra LSP object */
2061 zvrf = vrf_info_lookup(VRF_DEFAULT);
2062 if (zvrf == NULL)
2063 return;
2064
2065 lsp_table = zvrf->lsp_table;
2066
2067 tmp_ile.in_label = dplane_ctx_get_in_label(ctx);
2068 lsp = hash_lookup(lsp_table, &tmp_ile);
2069 if (lsp == NULL) {
2070 if (is_debug)
2071 zlog_debug("dplane LSP notif: in-label %u not found",
2072 dplane_ctx_get_in_label(ctx));
2073 return;
2074 }
2075
2076 /*
2077 * The dataplane/forwarding plane is notifying zebra about the state
2078 * of the nexthops associated with this LSP. First, we take a
2079 * pre-scan pass to determine whether the LSP has transitioned
2080 * from installed -> uninstalled. In that case, we need to have
2081 * the existing state of the LSP objects available before making
2082 * any changes.
2083 */
2084 ctx_list = dplane_ctx_get_nhlfe_list(ctx);
2085
2086 changed_p = compare_notif_nhlfes(ctx_list, &lsp->nhlfe_list,
2087 &start_count, &end_count);
2088
2089 if (is_debug)
2090 zlog_debug("LSP dplane notif: lfib start_count %d, end_count %d%s",
2091 start_count, end_count,
2092 changed_p ? ", changed" : "");
2093
2094 ctx_list = dplane_ctx_get_backup_nhlfe_list(ctx);
2095
2096 if (compare_notif_nhlfes(ctx_list, &lsp->backup_nhlfe_list,
2097 &start_count, &end_count))
2098 /* Avoid accidentally setting back to 'false' */
2099 changed_p = true;
2100
2101 if (is_debug)
2102 zlog_debug("LSP dplane notif: lfib backups, start_count %d, end_count %d%s",
2103 start_count, end_count,
2104 changed_p ? ", changed" : "");
2105
2106 /*
2107 * Has the LSP become uninstalled? We need the existing state of the
2108 * nexthops/nhlfes at this point so we know what to delete.
2109 */
2110 if (start_count > 0 && end_count == 0) {
2111 /* Inform other lfibs */
2112 dplane_lsp_notif_update(lsp, DPLANE_OP_LSP_DELETE, ctx);
2113 }
2114
2115 /*
2116 * Now we take a second pass and bring the zebra
2117 * nexthop state into sync with the forwarding-plane state.
2118 */
2119 ctx_list = dplane_ctx_get_nhlfe_list(ctx);
2120 update_nhlfes_from_ctx(&lsp->nhlfe_list, ctx_list);
2121
2122 ctx_list = dplane_ctx_get_backup_nhlfe_list(ctx);
2123 update_nhlfes_from_ctx(&lsp->backup_nhlfe_list, ctx_list);
2124
2125 if (end_count > 0) {
2126 SET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
2127
2128 /* SR-TE update too */
2129 if (start_count == 0)
2130 update_mode = ZEBRA_SR_POLICY_LABEL_CREATED;
2131 else
2132 update_mode = ZEBRA_SR_POLICY_LABEL_UPDATED;
2133 zebra_sr_policy_label_update(lsp->ile.in_label, update_mode);
2134
2135 if (changed_p)
2136 dplane_lsp_notif_update(lsp, DPLANE_OP_LSP_UPDATE, ctx);
2137
2138 } else {
2139 /* SR-TE update too */
2140 zebra_sr_policy_label_update(lsp->ile.in_label,
2141 ZEBRA_SR_POLICY_LABEL_REMOVED);
2142
2143 UNSET_FLAG(lsp->flags, LSP_FLAG_INSTALLED);
2144 clear_nhlfe_installed(lsp);
2145 }
2146 }
2147
2148 /*
2149 * Install dynamic LSP entry.
2150 */
2151 int zebra_mpls_lsp_install(struct zebra_vrf *zvrf, struct route_node *rn,
2152 struct route_entry *re)
2153 {
2154 struct route_table *table;
2155 struct zebra_fec *fec;
2156
2157 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(&rn->p))];
2158 if (!table)
2159 return -1;
2160
2161 /* See if there is a configured label binding for this FEC. */
2162 fec = fec_find(table, &rn->p);
2163 if (!fec || fec->label == MPLS_INVALID_LABEL)
2164 return 0;
2165
2166 /* We cannot install a label forwarding entry if local label is the
2167 * implicit-null label.
2168 */
2169 if (fec->label == MPLS_LABEL_IMPLICIT_NULL)
2170 return 0;
2171
2172 if (lsp_install(zvrf, fec->label, rn, re))
2173 return -1;
2174
2175 return 0;
2176 }
2177
2178 /*
2179 * Uninstall dynamic LSP entry, if any.
2180 */
2181 int zebra_mpls_lsp_uninstall(struct zebra_vrf *zvrf, struct route_node *rn,
2182 struct route_entry *re)
2183 {
2184 struct route_table *table;
2185 struct zebra_fec *fec;
2186
2187 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(&rn->p))];
2188 if (!table)
2189 return -1;
2190
2191 /* See if there is a configured label binding for this FEC. */
2192 fec = fec_find(table, &rn->p);
2193 if (!fec || fec->label == MPLS_INVALID_LABEL)
2194 return 0;
2195
2196 /* Uninstall always removes all dynamic NHLFEs. */
2197 return lsp_uninstall(zvrf, fec->label);
2198 }
2199
2200 /*
2201 * Add an NHLFE to an LSP, return the newly-added object. This path only changes
2202 * the LSP object - nothing is scheduled for processing, for example.
2203 */
2204 struct zebra_nhlfe *
2205 zebra_mpls_lsp_add_nhlfe(struct zebra_lsp *lsp, enum lsp_types_t lsp_type,
2206 enum nexthop_types_t gtype, const union g_addr *gate,
2207 ifindex_t ifindex, uint8_t num_labels,
2208 const mpls_label_t *out_labels)
2209 {
2210 /* Just a public pass-through to the internal implementation */
2211 return nhlfe_add(lsp, lsp_type, gtype, gate, ifindex, num_labels,
2212 out_labels, false /*backup*/);
2213 }
2214
2215 /*
2216 * Add a backup NHLFE to an LSP, return the newly-added object.
2217 * This path only changes the LSP object - nothing is scheduled for
2218 * processing, for example.
2219 */
2220 struct zebra_nhlfe *zebra_mpls_lsp_add_backup_nhlfe(
2221 struct zebra_lsp *lsp, enum lsp_types_t lsp_type,
2222 enum nexthop_types_t gtype, const union g_addr *gate, ifindex_t ifindex,
2223 uint8_t num_labels, const mpls_label_t *out_labels)
2224 {
2225 /* Just a public pass-through to the internal implementation */
2226 return nhlfe_add(lsp, lsp_type, gtype, gate, ifindex, num_labels,
2227 out_labels, true);
2228 }
2229
2230 /*
2231 * Add an NHLFE to an LSP based on a nexthop; return the newly-added object
2232 */
2233 struct zebra_nhlfe *zebra_mpls_lsp_add_nh(struct zebra_lsp *lsp,
2234 enum lsp_types_t lsp_type,
2235 const struct nexthop *nh)
2236 {
2237 struct zebra_nhlfe *nhlfe;
2238
2239 if (nh->nh_label == NULL || nh->nh_label->num_labels == 0)
2240 return NULL;
2241
2242 nhlfe = nhlfe_add(lsp, lsp_type, nh->type, &nh->gate, nh->ifindex,
2243 nh->nh_label->num_labels, nh->nh_label->label,
2244 false /*backup*/);
2245
2246 return nhlfe;
2247 }
2248
2249 /*
2250 * Add a backup NHLFE to an LSP based on a nexthop;
2251 * return the newly-added object.
2252 */
2253 struct zebra_nhlfe *zebra_mpls_lsp_add_backup_nh(struct zebra_lsp *lsp,
2254 enum lsp_types_t lsp_type,
2255 const struct nexthop *nh)
2256 {
2257 struct zebra_nhlfe *nhlfe;
2258
2259 if (nh->nh_label == NULL || nh->nh_label->num_labels == 0)
2260 return NULL;
2261
2262 nhlfe = nhlfe_add(lsp, lsp_type, nh->type, &nh->gate,
2263 nh->ifindex, nh->nh_label->num_labels,
2264 nh->nh_label->label, true);
2265
2266 return nhlfe;
2267 }
2268
2269 /*
2270 * Free an allocated NHLFE
2271 */
2272 void zebra_mpls_nhlfe_free(struct zebra_nhlfe *nhlfe)
2273 {
2274 /* Just a pass-through to the internal implementation */
2275 nhlfe_free(nhlfe);
2276 }
2277
2278 /*
2279 * Registration from a client for the label binding for a FEC. If a binding
2280 * already exists, it is informed to the client.
2281 * NOTE: If there is a manually configured label binding, that is used.
2282 * Otherwise, if a label index is specified, it means we have to allocate the
2283 * label from a locally configured label block (SRGB), if one exists and index
2284 * is acceptable. If no label index then just register the specified label.
2285 * NOTE2: Either label or label_index is expected to be set to MPLS_INVALID_*
2286 * by the calling function. Register requests with both will be rejected.
2287 */
2288 int zebra_mpls_fec_register(struct zebra_vrf *zvrf, struct prefix *p,
2289 uint32_t label, uint32_t label_index,
2290 struct zserv *client)
2291 {
2292 struct route_table *table;
2293 struct zebra_fec *fec;
2294 bool new_client;
2295 bool label_change = false;
2296 uint32_t old_label;
2297 bool have_label_index = (label_index != MPLS_INVALID_LABEL_INDEX);
2298 bool is_configured_fec = false; /* indicate statically configured FEC */
2299
2300 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2301 if (!table)
2302 return -1;
2303
2304 if (label != MPLS_INVALID_LABEL && have_label_index) {
2305 flog_err(
2306 EC_ZEBRA_FEC_LABEL_INDEX_LABEL_CONFLICT,
2307 "Rejecting FEC register for %pFX with both label %u and Label Index %u specified, client %s",
2308 p, label, label_index,
2309 zebra_route_string(client->proto));
2310 return -1;
2311 }
2312
2313 /* Locate FEC */
2314 fec = fec_find(table, p);
2315 if (!fec) {
2316 fec = fec_add(table, p, label, 0, label_index);
2317 if (!fec) {
2318 flog_err(
2319 EC_ZEBRA_FEC_ADD_FAILED,
2320 "Failed to add FEC %pFX upon register, client %s",
2321 p, zebra_route_string(client->proto));
2322 return -1;
2323 }
2324
2325 old_label = MPLS_INVALID_LABEL;
2326 new_client = true;
2327 } else {
2328 /* Check if the FEC has been statically defined in the config */
2329 is_configured_fec = fec->flags & FEC_FLAG_CONFIGURED;
2330 /* Client may register same FEC with different label index. */
2331 new_client =
2332 (listnode_lookup(fec->client_list, client) == NULL);
2333 if (!new_client && fec->label_index == label_index
2334 && fec->label == label)
2335 /* Duplicate register */
2336 return 0;
2337
2338 /* Save current label, update the FEC */
2339 old_label = fec->label;
2340 fec->label_index = label_index;
2341 }
2342
2343 if (new_client)
2344 listnode_add(fec->client_list, client);
2345
2346 if (IS_ZEBRA_DEBUG_MPLS)
2347 zlog_debug("FEC %pFX label%s %u %s by client %s%s", p,
2348 have_label_index ? " index" : "",
2349 have_label_index ? label_index : label,
2350 new_client ? "registered" : "updated",
2351 zebra_route_string(client->proto),
2352 is_configured_fec
2353 ? ", but using statically configured label"
2354 : "");
2355
2356 /* If not a statically configured FEC, derive the local label
2357 * from label index or use the provided label
2358 */
2359 if (!is_configured_fec) {
2360 if (have_label_index)
2361 fec_derive_label_from_index(zvrf, fec);
2362 else
2363 fec->label = label;
2364
2365 /* If no label change, exit. */
2366 if (fec->label == old_label)
2367 return 0;
2368
2369 label_change = true;
2370 }
2371
2372 /* If new client or label change, update client and install or uninstall
2373 * label forwarding entry as needed.
2374 */
2375 /* Inform client of label, if needed. */
2376 if ((new_client && fec->label != MPLS_INVALID_LABEL) || label_change) {
2377 if (IS_ZEBRA_DEBUG_MPLS)
2378 zlog_debug("Update client label %u", fec->label);
2379 fec_send(fec, client);
2380 }
2381
2382 if (new_client || label_change)
2383 return fec_change_update_lsp(zvrf, fec, old_label);
2384
2385 return 0;
2386 }
2387
2388 /*
2389 * Deregistration from a client for the label binding for a FEC. The FEC
2390 * itself is deleted if no other registered clients exist and there is no
2391 * label bound to the FEC.
2392 */
2393 int zebra_mpls_fec_unregister(struct zebra_vrf *zvrf, struct prefix *p,
2394 struct zserv *client)
2395 {
2396 struct route_table *table;
2397 struct zebra_fec *fec;
2398
2399 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2400 if (!table)
2401 return -1;
2402
2403 fec = fec_find(table, p);
2404 if (!fec) {
2405 flog_err(EC_ZEBRA_FEC_RM_FAILED,
2406 "Failed to find FEC %pFX upon unregister, client %s",
2407 p, zebra_route_string(client->proto));
2408 return -1;
2409 }
2410
2411 listnode_delete(fec->client_list, client);
2412
2413 if (IS_ZEBRA_DEBUG_MPLS)
2414 zlog_debug("FEC %pFX unregistered by client %s", p,
2415 zebra_route_string(client->proto));
2416
2417 /* If not a configured entry, delete the FEC if no other clients. Before
2418 * deleting, see if any LSP needs to be uninstalled.
2419 */
2420 if (!(fec->flags & FEC_FLAG_CONFIGURED)
2421 && list_isempty(fec->client_list)) {
2422 mpls_label_t old_label = fec->label;
2423 fec->label = MPLS_INVALID_LABEL; /* reset */
2424 fec_change_update_lsp(zvrf, fec, old_label);
2425 fec_del(fec);
2426 }
2427
2428 return 0;
2429 }
2430
2431 /*
2432 * Cleanup any FECs registered by this client.
2433 */
2434 static int zebra_mpls_cleanup_fecs_for_client(struct zserv *client)
2435 {
2436 struct zebra_vrf *zvrf = vrf_info_lookup(VRF_DEFAULT);
2437 struct route_node *rn;
2438 struct zebra_fec *fec;
2439 struct listnode *node;
2440 struct zserv *fec_client;
2441 int af;
2442
2443 for (af = AFI_IP; af < AFI_MAX; af++) {
2444 if (zvrf->fec_table[af] == NULL)
2445 continue;
2446
2447 for (rn = route_top(zvrf->fec_table[af]); rn;
2448 rn = route_next(rn)) {
2449 fec = rn->info;
2450 if (!fec || list_isempty(fec->client_list))
2451 continue;
2452
2453 for (ALL_LIST_ELEMENTS_RO(fec->client_list, node,
2454 fec_client)) {
2455 if (fec_client == client) {
2456 listnode_delete(fec->client_list,
2457 fec_client);
2458 if (!(fec->flags & FEC_FLAG_CONFIGURED)
2459 && list_isempty(fec->client_list))
2460 fec_del(fec);
2461 break;
2462 }
2463 }
2464 }
2465 }
2466
2467 return 0;
2468 }
2469
2470 struct lsp_uninstall_args {
2471 struct hash *lsp_table;
2472 enum lsp_types_t type;
2473 };
2474
2475 /*
2476 * Cleanup MPLS labels registered by this client.
2477 */
2478 static int zebra_mpls_cleanup_zclient_labels(struct zserv *client)
2479 {
2480 struct vrf *vrf;
2481 struct zebra_vrf *zvrf;
2482
2483 RB_FOREACH (vrf, vrf_id_head, &vrfs_by_id) {
2484 struct lsp_uninstall_args args;
2485
2486 zvrf = vrf->info;
2487 if (!zvrf)
2488 continue;
2489
2490 /* Cleanup LSPs. */
2491 args.lsp_table = zvrf->lsp_table;
2492 args.type = lsp_type_from_re_type(client->proto);
2493 hash_iterate(zvrf->lsp_table, mpls_lsp_uninstall_all_type,
2494 &args);
2495
2496 /* Cleanup FTNs. */
2497 mpls_ftn_uninstall_all(zvrf, AFI_IP,
2498 lsp_type_from_re_type(client->proto));
2499 mpls_ftn_uninstall_all(zvrf, AFI_IP6,
2500 lsp_type_from_re_type(client->proto));
2501 }
2502
2503 return 0;
2504 }
2505
2506 /*
2507 * Return FEC (if any) to which this label is bound.
2508 * Note: Only works for per-prefix binding and when the label is not
2509 * implicit-null.
2510 * TODO: Currently walks entire table, can optimize later with another
2511 * hash..
2512 */
2513 struct zebra_fec *zebra_mpls_fec_for_label(struct zebra_vrf *zvrf,
2514 mpls_label_t label)
2515 {
2516 struct route_node *rn;
2517 struct zebra_fec *fec;
2518 int af;
2519
2520 for (af = AFI_IP; af < AFI_MAX; af++) {
2521 if (zvrf->fec_table[af] == NULL)
2522 continue;
2523
2524 for (rn = route_top(zvrf->fec_table[af]); rn;
2525 rn = route_next(rn)) {
2526 if (!rn->info)
2527 continue;
2528 fec = rn->info;
2529 if (fec->label == label)
2530 return fec;
2531 }
2532 }
2533
2534 return NULL;
2535 }
2536
2537 /*
2538 * Inform if specified label is currently bound to a FEC or not.
2539 */
2540 int zebra_mpls_label_already_bound(struct zebra_vrf *zvrf, mpls_label_t label)
2541 {
2542 return (zebra_mpls_fec_for_label(zvrf, label) ? 1 : 0);
2543 }
2544
2545 /*
2546 * Add static FEC to label binding. If there are clients registered for this
2547 * FEC, notify them. If there are labeled routes for this FEC, install the
2548 * label forwarding entry.
2549 */
2550 int zebra_mpls_static_fec_add(struct zebra_vrf *zvrf, struct prefix *p,
2551 mpls_label_t in_label)
2552 {
2553 struct route_table *table;
2554 struct zebra_fec *fec;
2555 mpls_label_t old_label;
2556 int ret = 0;
2557
2558 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2559 if (!table)
2560 return -1;
2561
2562 /* Update existing FEC or create a new one. */
2563 fec = fec_find(table, p);
2564 if (!fec) {
2565 fec = fec_add(table, p, in_label, FEC_FLAG_CONFIGURED,
2566 MPLS_INVALID_LABEL_INDEX);
2567 if (!fec) {
2568 flog_err(EC_ZEBRA_FEC_ADD_FAILED,
2569 "Failed to add FEC %pFX upon config", p);
2570 return -1;
2571 }
2572
2573 if (IS_ZEBRA_DEBUG_MPLS)
2574 zlog_debug("Add fec %pFX label %u", p, in_label);
2575 } else {
2576 fec->flags |= FEC_FLAG_CONFIGURED;
2577 if (fec->label == in_label)
2578 /* Duplicate config */
2579 return 0;
2580
2581 /* Label change, update clients. */
2582 old_label = fec->label;
2583 if (IS_ZEBRA_DEBUG_MPLS)
2584 zlog_debug("Update fec %pFX new label %u", p, in_label);
2585
2586 fec->label = in_label;
2587 fec_update_clients(fec);
2588
2589 /* Update label forwarding entries appropriately */
2590 ret = fec_change_update_lsp(zvrf, fec, old_label);
2591 }
2592
2593 return ret;
2594 }
2595
2596 /*
2597 * Remove static FEC to label binding. If there are no clients registered
2598 * for this FEC, delete the FEC; else notify clients
2599 * Note: Upon delete of static binding, if label index exists for this FEC,
2600 * client may need to be updated with derived label.
2601 */
2602 int zebra_mpls_static_fec_del(struct zebra_vrf *zvrf, struct prefix *p)
2603 {
2604 struct route_table *table;
2605 struct zebra_fec *fec;
2606 mpls_label_t old_label;
2607
2608 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2609 if (!table)
2610 return -1;
2611
2612 fec = fec_find(table, p);
2613 if (!fec) {
2614 flog_err(EC_ZEBRA_FEC_RM_FAILED,
2615 "Failed to find FEC %pFX upon delete", p);
2616 return -1;
2617 }
2618
2619 if (IS_ZEBRA_DEBUG_MPLS) {
2620 zlog_debug("Delete fec %pFX label %u label index %u", p,
2621 fec->label, fec->label_index);
2622 }
2623
2624 old_label = fec->label;
2625 fec->flags &= ~FEC_FLAG_CONFIGURED;
2626 fec->label = MPLS_INVALID_LABEL;
2627
2628 /* If no client exists, just delete the FEC. */
2629 if (list_isempty(fec->client_list)) {
2630 fec_del(fec);
2631 return 0;
2632 }
2633
2634 /* Derive the local label (from label index) or reset it. */
2635 fec_derive_label_from_index(zvrf, fec);
2636
2637 /* If there is a label change, update clients. */
2638 if (fec->label == old_label)
2639 return 0;
2640 fec_update_clients(fec);
2641
2642 /* Update label forwarding entries appropriately */
2643 return fec_change_update_lsp(zvrf, fec, old_label);
2644 }
2645
2646 /*
2647 * Display MPLS FEC to label binding configuration (VTY command handler).
2648 */
2649 int zebra_mpls_write_fec_config(struct vty *vty, struct zebra_vrf *zvrf)
2650 {
2651 struct route_node *rn;
2652 int af;
2653 struct zebra_fec *fec;
2654 int write = 0;
2655
2656 for (af = AFI_IP; af < AFI_MAX; af++) {
2657 if (zvrf->fec_table[af] == NULL)
2658 continue;
2659
2660 for (rn = route_top(zvrf->fec_table[af]); rn;
2661 rn = route_next(rn)) {
2662 if (!rn->info)
2663 continue;
2664
2665 char lstr[BUFSIZ];
2666 fec = rn->info;
2667
2668 if (!(fec->flags & FEC_FLAG_CONFIGURED))
2669 continue;
2670
2671 write = 1;
2672 vty_out(vty, "mpls label bind %pFX %s\n", &rn->p,
2673 label2str(fec->label, lstr, BUFSIZ));
2674 }
2675 }
2676
2677 return write;
2678 }
2679
2680 /*
2681 * Display MPLS FEC to label binding (VTY command handler).
2682 */
2683 void zebra_mpls_print_fec_table(struct vty *vty, struct zebra_vrf *zvrf)
2684 {
2685 struct route_node *rn;
2686 int af;
2687
2688 for (af = AFI_IP; af < AFI_MAX; af++) {
2689 if (zvrf->fec_table[af] == NULL)
2690 continue;
2691
2692 for (rn = route_top(zvrf->fec_table[af]); rn;
2693 rn = route_next(rn)) {
2694 if (!rn->info)
2695 continue;
2696 fec_print(rn->info, vty);
2697 }
2698 }
2699 }
2700
2701 /*
2702 * Display MPLS FEC to label binding for a specific FEC (VTY command handler).
2703 */
2704 void zebra_mpls_print_fec(struct vty *vty, struct zebra_vrf *zvrf,
2705 struct prefix *p)
2706 {
2707 struct route_table *table;
2708 struct route_node *rn;
2709
2710 table = zvrf->fec_table[family2afi(PREFIX_FAMILY(p))];
2711 if (!table)
2712 return;
2713
2714 apply_mask(p);
2715 rn = route_node_lookup(table, p);
2716 if (!rn)
2717 return;
2718
2719 route_unlock_node(rn);
2720 if (!rn->info)
2721 return;
2722
2723 fec_print(rn->info, vty);
2724 }
2725
2726 static void mpls_zebra_nhe_update(struct route_entry *re, afi_t afi,
2727 struct nhg_hash_entry *new_nhe)
2728 {
2729 struct nhg_hash_entry *nhe;
2730
2731 nhe = zebra_nhg_rib_find_nhe(new_nhe, afi);
2732
2733 route_entry_update_nhe(re, nhe);
2734 }
2735
2736 static bool ftn_update_nexthop(bool add_p, struct nexthop *nexthop,
2737 enum lsp_types_t type,
2738 const struct zapi_nexthop *znh)
2739 {
2740 if (add_p && nexthop->nh_label_type == ZEBRA_LSP_NONE)
2741 nexthop_add_labels(nexthop, type, znh->label_num, znh->labels);
2742 else if (!add_p && nexthop->nh_label_type == type)
2743 nexthop_del_labels(nexthop);
2744 else
2745 return false;
2746
2747 return true;
2748 }
2749
2750 int mpls_ftn_uninstall(struct zebra_vrf *zvrf, enum lsp_types_t type,
2751 struct prefix *prefix, uint8_t route_type,
2752 unsigned short route_instance)
2753 {
2754 struct route_table *table;
2755 struct route_node *rn;
2756 struct route_entry *re;
2757 struct nexthop *nexthop;
2758 struct nhg_hash_entry *new_nhe;
2759 afi_t afi = family2afi(prefix->family);
2760
2761 /* Lookup table. */
2762 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
2763 if (!table)
2764 return -1;
2765
2766 /* Lookup existing route */
2767 rn = route_node_get(table, prefix);
2768 RNODE_FOREACH_RE (rn, re) {
2769 if (CHECK_FLAG(re->status, ROUTE_ENTRY_REMOVED))
2770 continue;
2771 if (re->type == route_type && re->instance == route_instance)
2772 break;
2773 }
2774 if (re == NULL)
2775 return -1;
2776
2777 /*
2778 * Nexthops are now shared by multiple routes, so we have to make
2779 * a local copy, modify the copy, then update the route.
2780 */
2781 new_nhe = zebra_nhe_copy(re->nhe, 0);
2782
2783 for (nexthop = new_nhe->nhg.nexthop; nexthop; nexthop = nexthop->next)
2784 nexthop_del_labels(nexthop);
2785
2786 /* Update backup routes/nexthops also, if present. */
2787 if (zebra_nhg_get_backup_nhg(new_nhe) != NULL) {
2788 for (nexthop = new_nhe->backup_info->nhe->nhg.nexthop; nexthop;
2789 nexthop = nexthop->next)
2790 nexthop_del_labels(nexthop);
2791 }
2792
2793 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
2794 SET_FLAG(re->status, ROUTE_ENTRY_LABELS_CHANGED);
2795
2796 /* This will create (or ref) a new nhe, so we will discard the local
2797 * temporary nhe
2798 */
2799 mpls_zebra_nhe_update(re, afi, new_nhe);
2800
2801 zebra_nhg_free(new_nhe);
2802
2803 rib_queue_add(rn);
2804
2805 return 0;
2806 }
2807
2808 /*
2809 * Iterate through a list of nexthops, for a match for 'znh'. If found,
2810 * update its labels according to 'add_p', and return 'true' if successful.
2811 */
2812 static bool ftn_update_znh(bool add_p, enum lsp_types_t type,
2813 struct nexthop *head, const struct zapi_nexthop *znh)
2814 {
2815 bool found = false, success = false;
2816 struct nexthop *nexthop;
2817
2818 for (nexthop = head; nexthop; nexthop = nexthop->next) {
2819 switch (nexthop->type) {
2820 case NEXTHOP_TYPE_IPV4:
2821 case NEXTHOP_TYPE_IPV4_IFINDEX:
2822 if (znh->type != NEXTHOP_TYPE_IPV4
2823 && znh->type != NEXTHOP_TYPE_IPV4_IFINDEX)
2824 continue;
2825 if (!IPV4_ADDR_SAME(&nexthop->gate.ipv4,
2826 &znh->gate.ipv4))
2827 continue;
2828 if (nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX
2829 && nexthop->ifindex != znh->ifindex)
2830 continue;
2831
2832 found = true;
2833
2834 if (!ftn_update_nexthop(add_p, nexthop, type, znh))
2835 break;
2836
2837 success = true;
2838 break;
2839 case NEXTHOP_TYPE_IPV6:
2840 case NEXTHOP_TYPE_IPV6_IFINDEX:
2841 if (znh->type != NEXTHOP_TYPE_IPV6
2842 && znh->type != NEXTHOP_TYPE_IPV6_IFINDEX)
2843 continue;
2844 if (!IPV6_ADDR_SAME(&nexthop->gate.ipv6,
2845 &znh->gate.ipv6))
2846 continue;
2847 if (nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX
2848 && nexthop->ifindex != znh->ifindex)
2849 continue;
2850
2851 found = true;
2852
2853 if (!ftn_update_nexthop(add_p, nexthop, type, znh))
2854 break;
2855 success = true;
2856 break;
2857 case NEXTHOP_TYPE_IFINDEX:
2858 if (znh->type != NEXTHOP_TYPE_IFINDEX)
2859 continue;
2860 if (nexthop->ifindex != znh->ifindex)
2861 continue;
2862
2863 found = true;
2864
2865 if (!ftn_update_nexthop(add_p, nexthop, type, znh))
2866 break;
2867 success = true;
2868 break;
2869 case NEXTHOP_TYPE_BLACKHOLE:
2870 /* Not valid */
2871 continue;
2872 }
2873
2874 if (found)
2875 break;
2876 }
2877
2878 return success;
2879 }
2880
2881 /*
2882 * Install/uninstall LSP and (optionally) FEC-To-NHLFE (FTN) bindings,
2883 * using zapi message info.
2884 * There are several changes that need to be made, in several zebra
2885 * data structures, so we want to do all the work required at once.
2886 */
2887 int mpls_zapi_labels_process(bool add_p, struct zebra_vrf *zvrf,
2888 const struct zapi_labels *zl)
2889 {
2890 int i, counter, ret = 0;
2891 char buf[NEXTHOP_STRLEN];
2892 const struct zapi_nexthop *znh;
2893 struct route_table *table;
2894 struct route_node *rn = NULL;
2895 struct route_entry *re = NULL;
2896 struct nhg_hash_entry *new_nhe = NULL;
2897 bool found;
2898 afi_t afi = AFI_IP;
2899 const struct prefix *prefix = NULL;
2900 struct hash *lsp_table;
2901 struct zebra_ile tmp_ile;
2902 struct zebra_lsp *lsp = NULL;
2903
2904 /* Prep LSP for add case */
2905 if (add_p) {
2906 /* Lookup table. */
2907 lsp_table = zvrf->lsp_table;
2908 if (!lsp_table)
2909 return -1;
2910
2911 /* Find or create LSP object */
2912 tmp_ile.in_label = zl->local_label;
2913 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
2914 }
2915
2916 /* Prep for route/FEC update if requested */
2917 if (CHECK_FLAG(zl->message, ZAPI_LABELS_FTN)) {
2918 prefix = &zl->route.prefix;
2919
2920 afi = family2afi(prefix->family);
2921
2922 /* Lookup table. */
2923 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
2924 if (table) {
2925 /* Lookup existing route */
2926 rn = route_node_get(table, prefix);
2927 RNODE_FOREACH_RE(rn, re) {
2928 if (CHECK_FLAG(re->status, ROUTE_ENTRY_REMOVED))
2929 continue;
2930 if (re->type == zl->route.type &&
2931 re->instance == zl->route.instance)
2932 break;
2933 }
2934 }
2935
2936 if (re) {
2937 /*
2938 * Copy over current nexthops into a temporary group.
2939 * We can't just change the values here since the nhgs
2940 * are shared and if the labels change, we'll need
2941 * to find or create a new nhg. We need to create
2942 * a whole temporary group, make changes to it,
2943 * then attach that to the route.
2944 */
2945 new_nhe = zebra_nhe_copy(re->nhe, 0);
2946
2947 } else {
2948 /*
2949 * The old version of the zapi code
2950 * attempted to manage LSPs before trying to
2951 * find a route/FEC, so we'll continue that way.
2952 */
2953 if (IS_ZEBRA_DEBUG_RECV || IS_ZEBRA_DEBUG_MPLS)
2954 zlog_debug(
2955 "%s: FTN update requested: no route for prefix %pFX",
2956 __func__, prefix);
2957 }
2958 }
2959
2960 /*
2961 * Use info from the zapi nexthops to add/replace/remove LSP/FECs
2962 */
2963
2964 counter = 0;
2965 for (i = 0; i < zl->nexthop_num; i++) {
2966
2967 znh = &zl->nexthops[i];
2968
2969 /* Attempt LSP update */
2970 if (add_p)
2971 ret = lsp_znh_install(lsp, zl->type, znh);
2972 else
2973 ret = mpls_lsp_uninstall(zvrf, zl->type,
2974 zl->local_label, znh->type,
2975 &znh->gate, znh->ifindex,
2976 false);
2977 if (ret < 0) {
2978 if (IS_ZEBRA_DEBUG_RECV || IS_ZEBRA_DEBUG_MPLS) {
2979 zapi_nexthop2str(znh, buf, sizeof(buf));
2980 zlog_debug("%s: Unable to %sinstall LSP: label %u, znh %s",
2981 __func__, (add_p ? "" : "un"),
2982 zl->local_label, buf);
2983 }
2984 continue;
2985 }
2986
2987 /* Attempt route/FEC update if requested */
2988 if (re == NULL)
2989 continue;
2990
2991 /* Search the route's nexthops for a match, and update it. */
2992 found = ftn_update_znh(add_p, zl->type, new_nhe->nhg.nexthop,
2993 znh);
2994 if (found) {
2995 counter++;
2996 } else if (IS_ZEBRA_DEBUG_RECV | IS_ZEBRA_DEBUG_MPLS) {
2997 zapi_nexthop2str(znh, buf, sizeof(buf));
2998 zlog_debug(
2999 "%s: Unable to update FEC: prefix %pFX, label %u, znh %s",
3000 __func__, prefix, zl->local_label, buf);
3001 }
3002 }
3003
3004 /*
3005 * Process backup LSPs/nexthop entries also. We associate backup
3006 * LSP info with backup nexthops.
3007 */
3008 if (!CHECK_FLAG(zl->message, ZAPI_LABELS_HAS_BACKUPS))
3009 goto znh_done;
3010
3011 for (i = 0; i < zl->backup_nexthop_num; i++) {
3012
3013 znh = &zl->backup_nexthops[i];
3014
3015 if (add_p)
3016 ret = lsp_backup_znh_install(lsp, zl->type, znh);
3017 else
3018 ret = mpls_lsp_uninstall(zvrf, zl->type,
3019 zl->local_label,
3020 znh->type, &znh->gate,
3021 znh->ifindex, true);
3022
3023 if (ret < 0) {
3024 if (IS_ZEBRA_DEBUG_RECV ||
3025 IS_ZEBRA_DEBUG_MPLS) {
3026 zapi_nexthop2str(znh, buf, sizeof(buf));
3027 zlog_debug("%s: Unable to %sinstall backup LSP: label %u, znh %s",
3028 __func__, (add_p ? "" : "un"),
3029 zl->local_label, buf);
3030 }
3031 continue;
3032 }
3033
3034 /* Attempt backup nexthop/FEC update if requested */
3035 if (re == NULL || zebra_nhg_get_backup_nhg(new_nhe) == NULL)
3036 continue;
3037
3038 /* Search the route's backup nexthops for a match
3039 * and update it.
3040 */
3041 found = ftn_update_znh(add_p, zl->type,
3042 new_nhe->backup_info->nhe->nhg.nexthop,
3043 znh);
3044 if (found) {
3045 counter++;
3046 } else if (IS_ZEBRA_DEBUG_RECV | IS_ZEBRA_DEBUG_MPLS) {
3047 zapi_nexthop2str(znh, buf, sizeof(buf));
3048 zlog_debug(
3049 "%s: Unable to update backup FEC: prefix %pFX, label %u, znh %s",
3050 __func__, prefix, zl->local_label, buf);
3051 }
3052 }
3053
3054 znh_done:
3055
3056 /*
3057 * If we made changes, update the route, and schedule it
3058 * for rib processing
3059 */
3060 if (re != NULL && counter > 0) {
3061 assert(rn != NULL);
3062
3063 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
3064 SET_FLAG(re->status, ROUTE_ENTRY_LABELS_CHANGED);
3065
3066 mpls_zebra_nhe_update(re, afi, new_nhe);
3067
3068 rib_queue_add(rn);
3069 }
3070
3071 if (new_nhe)
3072 zebra_nhg_free(new_nhe);
3073
3074 return ret;
3075 }
3076
3077 /*
3078 * Install/update a NHLFE for an LSP in the forwarding table. This may be
3079 * a new LSP entry or a new NHLFE for an existing in-label or an update of
3080 * the out-label for an existing NHLFE (update case).
3081 */
3082 static struct zebra_nhlfe *
3083 lsp_add_nhlfe(struct zebra_lsp *lsp, enum lsp_types_t type,
3084 uint8_t num_out_labels, const mpls_label_t *out_labels,
3085 enum nexthop_types_t gtype, const union g_addr *gate,
3086 ifindex_t ifindex, bool is_backup)
3087 {
3088 struct zebra_nhlfe *nhlfe;
3089 char buf[MPLS_LABEL_STRLEN];
3090 const char *backup_str;
3091
3092 if (is_backup) {
3093 nhlfe = nhlfe_find(&lsp->backup_nhlfe_list, type, gtype,
3094 gate, ifindex);
3095 backup_str = "backup ";
3096 } else {
3097 nhlfe = nhlfe_find(&lsp->nhlfe_list, type, gtype, gate,
3098 ifindex);
3099 backup_str = "";
3100 }
3101
3102 if (nhlfe) {
3103 struct nexthop *nh = nhlfe->nexthop;
3104
3105 assert(nh);
3106 assert(nh->nh_label);
3107
3108 /* Clear deleted flag (in case it was set) */
3109 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
3110 if (nh->nh_label->num_labels == num_out_labels
3111 && !memcmp(nh->nh_label->label, out_labels,
3112 sizeof(mpls_label_t) * num_out_labels))
3113 /* No change */
3114 return nhlfe;
3115
3116 if (IS_ZEBRA_DEBUG_MPLS) {
3117 char buf2[MPLS_LABEL_STRLEN];
3118 char buf3[MPLS_LABEL_STRLEN];
3119
3120 nhlfe2str(nhlfe, buf, sizeof(buf));
3121 mpls_label2str(num_out_labels, out_labels, buf2,
3122 sizeof(buf2), 0);
3123 mpls_label2str(nh->nh_label->num_labels,
3124 nh->nh_label->label, buf3, sizeof(buf3),
3125 0);
3126
3127 zlog_debug("LSP in-label %u type %d %snexthop %s out-label(s) changed to %s (old %s)",
3128 lsp->ile.in_label, type, backup_str, buf,
3129 buf2, buf3);
3130 }
3131
3132 /* Update out label(s), trigger processing. */
3133 if (nh->nh_label->num_labels == num_out_labels)
3134 memcpy(nh->nh_label->label, out_labels,
3135 sizeof(mpls_label_t) * num_out_labels);
3136 else {
3137 nexthop_del_labels(nh);
3138 nexthop_add_labels(nh, type, num_out_labels,
3139 out_labels);
3140 }
3141 } else {
3142 /* Add LSP entry to this nexthop */
3143 nhlfe = nhlfe_add(lsp, type, gtype, gate, ifindex,
3144 num_out_labels, out_labels, is_backup);
3145 if (!nhlfe)
3146 return NULL;
3147
3148 if (IS_ZEBRA_DEBUG_MPLS) {
3149 char buf2[MPLS_LABEL_STRLEN];
3150
3151 nhlfe2str(nhlfe, buf, sizeof(buf));
3152 mpls_label2str(num_out_labels, out_labels, buf2,
3153 sizeof(buf2), 0);
3154
3155 zlog_debug("Add LSP in-label %u type %d %snexthop %s out-label(s) %s",
3156 lsp->ile.in_label, type, backup_str, buf,
3157 buf2);
3158 }
3159
3160 lsp->addr_family = NHLFE_FAMILY(nhlfe);
3161 }
3162
3163 /* Mark NHLFE, queue LSP for processing. */
3164 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
3165
3166 return nhlfe;
3167 }
3168
3169 /*
3170 * Install an LSP and forwarding entry; used primarily
3171 * from vrf zapi message processing.
3172 */
3173 int mpls_lsp_install(struct zebra_vrf *zvrf, enum lsp_types_t type,
3174 mpls_label_t in_label, uint8_t num_out_labels,
3175 const mpls_label_t *out_labels, enum nexthop_types_t gtype,
3176 const union g_addr *gate, ifindex_t ifindex)
3177 {
3178 struct hash *lsp_table;
3179 struct zebra_ile tmp_ile;
3180 struct zebra_lsp *lsp;
3181 struct zebra_nhlfe *nhlfe;
3182
3183 /* Lookup table. */
3184 lsp_table = zvrf->lsp_table;
3185 if (!lsp_table)
3186 return -1;
3187
3188 /* Find or create LSP object */
3189 tmp_ile.in_label = in_label;
3190 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
3191
3192 nhlfe = lsp_add_nhlfe(lsp, type, num_out_labels, out_labels, gtype,
3193 gate, ifindex, false /*backup*/);
3194 if (nhlfe == NULL)
3195 return -1;
3196
3197 /* Queue LSP for processing. */
3198 if (lsp_processq_add(lsp))
3199 return -1;
3200
3201 return 0;
3202 }
3203
3204 /*
3205 * Install or replace NHLFE, using info from zapi nexthop
3206 */
3207 static int lsp_znh_install(struct zebra_lsp *lsp, enum lsp_types_t type,
3208 const struct zapi_nexthop *znh)
3209 {
3210 struct zebra_nhlfe *nhlfe;
3211
3212 nhlfe = lsp_add_nhlfe(lsp, type, znh->label_num, znh->labels,
3213 znh->type, &znh->gate, znh->ifindex,
3214 false /*backup*/);
3215 if (nhlfe == NULL)
3216 return -1;
3217
3218 /* Update backup info if present */
3219 if (CHECK_FLAG(znh->flags, ZAPI_NEXTHOP_FLAG_HAS_BACKUP)) {
3220 if (znh->backup_num > NEXTHOP_MAX_BACKUPS) {
3221 nhlfe_del(nhlfe);
3222 return -1;
3223 }
3224
3225 nhlfe->nexthop->backup_num = znh->backup_num;
3226 memcpy(nhlfe->nexthop->backup_idx, znh->backup_idx,
3227 znh->backup_num);
3228 SET_FLAG(nhlfe->nexthop->flags, NEXTHOP_FLAG_HAS_BACKUP);
3229 } else {
3230 /* Ensure there's no stale backup info */
3231 UNSET_FLAG(nhlfe->nexthop->flags, NEXTHOP_FLAG_HAS_BACKUP);
3232 nhlfe->nexthop->backup_num = 0;
3233 }
3234
3235 /* Queue LSP for processing. */
3236 if (lsp_processq_add(lsp))
3237 return -1;
3238
3239 return 0;
3240 }
3241
3242 /*
3243 * Install/update backup NHLFE for an LSP, using info from a zapi message.
3244 */
3245 static int lsp_backup_znh_install(struct zebra_lsp *lsp, enum lsp_types_t type,
3246 const struct zapi_nexthop *znh)
3247 {
3248 struct zebra_nhlfe *nhlfe;
3249
3250 nhlfe = lsp_add_nhlfe(lsp, type, znh->label_num,
3251 znh->labels, znh->type, &znh->gate,
3252 znh->ifindex, true /*backup*/);
3253 if (nhlfe == NULL) {
3254 if (IS_ZEBRA_DEBUG_MPLS)
3255 zlog_debug("%s: unable to add backup nhlfe, label: %u",
3256 __func__, lsp->ile.in_label);
3257 return -1;
3258 }
3259
3260 /* Queue LSP for processing. */
3261 if (lsp_processq_add(lsp))
3262 return -1;
3263
3264 return 0;
3265 }
3266
3267 struct zebra_lsp *mpls_lsp_find(struct zebra_vrf *zvrf, mpls_label_t in_label)
3268 {
3269 struct hash *lsp_table;
3270 struct zebra_ile tmp_ile;
3271
3272 /* Lookup table. */
3273 lsp_table = zvrf->lsp_table;
3274 if (!lsp_table)
3275 return NULL;
3276
3277 /* If entry is not present, exit. */
3278 tmp_ile.in_label = in_label;
3279 return hash_lookup(lsp_table, &tmp_ile);
3280 }
3281
3282 /*
3283 * Uninstall a particular NHLFE in the forwarding table. If this is
3284 * the only NHLFE, the entire LSP forwarding entry has to be deleted.
3285 */
3286 int mpls_lsp_uninstall(struct zebra_vrf *zvrf, enum lsp_types_t type,
3287 mpls_label_t in_label, enum nexthop_types_t gtype,
3288 const union g_addr *gate, ifindex_t ifindex,
3289 bool backup_p)
3290 {
3291 struct hash *lsp_table;
3292 struct zebra_ile tmp_ile;
3293 struct zebra_lsp *lsp;
3294 struct zebra_nhlfe *nhlfe;
3295 char buf[NEXTHOP_STRLEN];
3296 bool schedule_lsp = false;
3297
3298 /* Lookup table. */
3299 lsp_table = zvrf->lsp_table;
3300 if (!lsp_table)
3301 return -1;
3302
3303 /* If entry is not present, exit. */
3304 tmp_ile.in_label = in_label;
3305 lsp = hash_lookup(lsp_table, &tmp_ile);
3306 if (!lsp)
3307 return 0;
3308
3309 if (backup_p)
3310 nhlfe = nhlfe_find(&lsp->backup_nhlfe_list, type, gtype,
3311 gate, ifindex);
3312 else
3313 nhlfe = nhlfe_find(&lsp->nhlfe_list, type, gtype, gate,
3314 ifindex);
3315 if (!nhlfe)
3316 return 0;
3317
3318 if (IS_ZEBRA_DEBUG_MPLS) {
3319 nhlfe2str(nhlfe, buf, sizeof(buf));
3320 zlog_debug("Del LSP in-label %u type %d nexthop %s flags 0x%x",
3321 in_label, type, buf, nhlfe->flags);
3322 }
3323
3324 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED) ||
3325 CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED))
3326 schedule_lsp = true;
3327
3328 /* Mark NHLFE for delete or directly delete, as appropriate. */
3329 if (schedule_lsp) {
3330 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
3331 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
3332
3333 if (IS_ZEBRA_DEBUG_MPLS)
3334 zlog_debug("Schedule LSP in-label %u flags 0x%x",
3335 lsp->ile.in_label, lsp->flags);
3336 if (lsp_processq_add(lsp))
3337 return -1;
3338 } else {
3339 nhlfe_del(nhlfe);
3340
3341 /* Free LSP entry if no other NHLFEs and not scheduled. */
3342 lsp_check_free(lsp_table, &lsp);
3343 }
3344 return 0;
3345 }
3346
3347 int mpls_lsp_uninstall_all_vrf(struct zebra_vrf *zvrf, enum lsp_types_t type,
3348 mpls_label_t in_label)
3349 {
3350 struct hash *lsp_table;
3351 struct zebra_ile tmp_ile;
3352 struct zebra_lsp *lsp;
3353
3354 /* Lookup table. */
3355 lsp_table = zvrf->lsp_table;
3356 if (!lsp_table)
3357 return -1;
3358
3359 /* If entry is not present, exit. */
3360 tmp_ile.in_label = in_label;
3361 lsp = hash_lookup(lsp_table, &tmp_ile);
3362 if (!lsp)
3363 return 0;
3364
3365 return mpls_lsp_uninstall_all(lsp_table, lsp, type);
3366 }
3367
3368 /*
3369 * Uninstall all NHLFEs for a particular LSP forwarding entry.
3370 * If no other NHLFEs exist, the entry would be deleted.
3371 */
3372 static void mpls_lsp_uninstall_all_type(struct hash_bucket *bucket, void *ctxt)
3373 {
3374 struct lsp_uninstall_args *args = ctxt;
3375 struct zebra_lsp *lsp;
3376 struct hash *lsp_table;
3377
3378 lsp = (struct zebra_lsp *)bucket->data;
3379 if (nhlfe_list_first(&lsp->nhlfe_list) == NULL)
3380 return;
3381
3382 lsp_table = args->lsp_table;
3383 if (!lsp_table)
3384 return;
3385
3386 mpls_lsp_uninstall_all(lsp_table, lsp, args->type);
3387 }
3388
3389 /*
3390 * Uninstall all FEC-To-NHLFE (FTN) bindings of the given address-family and
3391 * LSP type.
3392 */
3393 static void mpls_ftn_uninstall_all(struct zebra_vrf *zvrf,
3394 int afi, enum lsp_types_t lsp_type)
3395 {
3396 struct route_table *table;
3397 struct route_node *rn;
3398 struct route_entry *re;
3399 struct nexthop *nexthop;
3400 struct nexthop_group *nhg;
3401 bool update;
3402
3403 /* Process routes of interested address-families. */
3404 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
3405 if (!table)
3406 return;
3407
3408 for (rn = route_top(table); rn; rn = route_next(rn)) {
3409 update = false;
3410
3411 RNODE_FOREACH_RE (rn, re) {
3412 struct nhg_hash_entry *new_nhe;
3413
3414 new_nhe = zebra_nhe_copy(re->nhe, 0);
3415
3416 nhg = &new_nhe->nhg;
3417 for (nexthop = nhg->nexthop; nexthop;
3418 nexthop = nexthop->next) {
3419 if (nexthop->nh_label_type != lsp_type)
3420 continue;
3421
3422 nexthop_del_labels(nexthop);
3423 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
3424 SET_FLAG(re->status,
3425 ROUTE_ENTRY_LABELS_CHANGED);
3426 update = true;
3427 }
3428
3429 /* Check for backup info and update that also */
3430 nhg = zebra_nhg_get_backup_nhg(new_nhe);
3431 if (nhg != NULL) {
3432 for (nexthop = nhg->nexthop; nexthop;
3433 nexthop = nexthop->next) {
3434 if (nexthop->nh_label_type != lsp_type)
3435 continue;
3436
3437 nexthop_del_labels(nexthop);
3438 SET_FLAG(re->status,
3439 ROUTE_ENTRY_CHANGED);
3440 SET_FLAG(re->status,
3441 ROUTE_ENTRY_LABELS_CHANGED);
3442 update = true;
3443 }
3444 }
3445
3446 if (CHECK_FLAG(re->status, ROUTE_ENTRY_LABELS_CHANGED))
3447 mpls_zebra_nhe_update(re, afi, new_nhe);
3448
3449 zebra_nhg_free(new_nhe);
3450 }
3451
3452 if (update)
3453 rib_queue_add(rn);
3454 }
3455 }
3456
3457 #if defined(HAVE_CUMULUS)
3458 /*
3459 * Check that the label values used in LSP creation are consistent. The
3460 * main criteria is that if there is ECMP, the label operation must still
3461 * be consistent - i.e., all paths either do a swap or do PHP. This is due
3462 * to current HW restrictions.
3463 */
3464 int zebra_mpls_lsp_label_consistent(struct zebra_vrf *zvrf,
3465 mpls_label_t in_label,
3466 mpls_label_t out_label,
3467 enum nexthop_types_t gtype,
3468 union g_addr *gate, ifindex_t ifindex)
3469 {
3470 struct hash *slsp_table;
3471 struct zebra_ile tmp_ile;
3472 struct zebra_lsp *lsp;
3473 struct zebra_nhlfe *nhlfe;
3474 const struct nexthop *nh;
3475
3476 /* Lookup table. */
3477 slsp_table = zvrf->slsp_table;
3478 if (!slsp_table)
3479 return 0;
3480
3481 /* If entry is not present, exit. */
3482 tmp_ile.in_label = in_label;
3483 lsp = hash_lookup(slsp_table, &tmp_ile);
3484 if (!lsp)
3485 return 1;
3486
3487 nhlfe = nhlfe_find(&lsp->nhlfe_list, ZEBRA_LSP_STATIC,
3488 gtype, gate, ifindex);
3489 if (nhlfe) {
3490 nh = nhlfe->nexthop;
3491
3492 if (nh == NULL || nh->nh_label == NULL)
3493 return 0;
3494
3495 if (nh->nh_label->label[0] == out_label)
3496 return 1;
3497
3498 /* If not only NHLFE, cannot allow label change. */
3499 if (nhlfe != nhlfe_list_first(&lsp->nhlfe_list) ||
3500 nhlfe_list_next(&lsp->nhlfe_list, nhlfe) != NULL)
3501 return 0;
3502 } else {
3503 /* If other NHLFEs exist, label operation must match. */
3504 nhlfe = nhlfe_list_first(&lsp->nhlfe_list);
3505 if (nhlfe != NULL) {
3506 int cur_op, new_op;
3507
3508 nh = nhlfe->nexthop;
3509
3510 if (nh == NULL || nh->nh_label == NULL)
3511 return 0;
3512
3513 cur_op = (nh->nh_label->label[0] ==
3514 MPLS_LABEL_IMPLICIT_NULL);
3515 new_op = (out_label == MPLS_LABEL_IMPLICIT_NULL);
3516 if (cur_op != new_op)
3517 return 0;
3518 }
3519 }
3520
3521 /* Label values are good. */
3522 return 1;
3523 }
3524 #endif /* HAVE_CUMULUS */
3525
3526 /*
3527 * Add static LSP entry. This may be the first entry for this incoming label
3528 * or an additional nexthop; an existing entry may also have outgoing label
3529 * changed.
3530 * Note: The label operation (swap or PHP) is common for the LSP entry (all
3531 * NHLFEs).
3532 */
3533 int zebra_mpls_static_lsp_add(struct zebra_vrf *zvrf, mpls_label_t in_label,
3534 mpls_label_t out_label,
3535 enum nexthop_types_t gtype, union g_addr *gate,
3536 ifindex_t ifindex)
3537 {
3538 struct hash *slsp_table;
3539 struct zebra_ile tmp_ile;
3540 struct zebra_lsp *lsp;
3541 struct zebra_nhlfe *nhlfe;
3542 char buf[BUFSIZ];
3543
3544 /* Lookup table. */
3545 slsp_table = zvrf->slsp_table;
3546 if (!slsp_table)
3547 return -1;
3548
3549 /* Find or create LSP. */
3550 tmp_ile.in_label = in_label;
3551 lsp = hash_get(slsp_table, &tmp_ile, lsp_alloc);
3552
3553 nhlfe = nhlfe_find(&lsp->nhlfe_list, ZEBRA_LSP_STATIC, gtype, gate,
3554 ifindex);
3555 if (nhlfe) {
3556 struct nexthop *nh = nhlfe->nexthop;
3557
3558 assert(nh);
3559 assert(nh->nh_label);
3560
3561 /* Compare existing nexthop */
3562 if (nh->nh_label->num_labels == 1 &&
3563 nh->nh_label->label[0] == out_label)
3564 /* No change */
3565 return 0;
3566
3567 if (IS_ZEBRA_DEBUG_MPLS) {
3568 nhlfe2str(nhlfe, buf, sizeof(buf));
3569 zlog_debug(
3570 "Upd static LSP in-label %u nexthop %s out-label %u (old %u)",
3571 in_label, buf, out_label,
3572 nh->nh_label->label[0]);
3573 }
3574 if (nh->nh_label->num_labels == 1)
3575 nh->nh_label->label[0] = out_label;
3576 else {
3577 nexthop_del_labels(nh);
3578 nexthop_add_labels(nh, ZEBRA_LSP_STATIC, 1, &out_label);
3579 }
3580
3581 } else {
3582 /* Add static LSP entry to this nexthop */
3583 nhlfe = nhlfe_add(lsp, ZEBRA_LSP_STATIC, gtype, gate,
3584 ifindex, 1, &out_label, false /*backup*/);
3585 if (!nhlfe)
3586 return -1;
3587
3588 if (IS_ZEBRA_DEBUG_MPLS) {
3589 nhlfe2str(nhlfe, buf, sizeof(buf));
3590 zlog_debug(
3591 "Add static LSP in-label %u nexthop %s out-label %u",
3592 in_label, buf, out_label);
3593 }
3594 }
3595
3596 /* (Re)Install LSP in the main table. */
3597 if (mpls_lsp_install(zvrf, ZEBRA_LSP_STATIC, in_label, 1, &out_label,
3598 gtype, gate, ifindex))
3599 return -1;
3600
3601 return 0;
3602 }
3603
3604 /*
3605 * Delete static LSP entry. This may be the delete of one particular
3606 * NHLFE for this incoming label or the delete of the entire entry (i.e.,
3607 * all NHLFEs).
3608 * NOTE: Delete of the only NHLFE will also end up deleting the entire
3609 * LSP configuration.
3610 */
3611 int zebra_mpls_static_lsp_del(struct zebra_vrf *zvrf, mpls_label_t in_label,
3612 enum nexthop_types_t gtype, union g_addr *gate,
3613 ifindex_t ifindex)
3614 {
3615 struct hash *slsp_table;
3616 struct zebra_ile tmp_ile;
3617 struct zebra_lsp *lsp;
3618 struct zebra_nhlfe *nhlfe;
3619
3620 /* Lookup table. */
3621 slsp_table = zvrf->slsp_table;
3622 if (!slsp_table)
3623 return -1;
3624
3625 /* If entry is not present, exit. */
3626 tmp_ile.in_label = in_label;
3627 lsp = hash_lookup(slsp_table, &tmp_ile);
3628 if (!lsp)
3629 return 0;
3630
3631 /* Is it delete of entire LSP or a specific NHLFE? */
3632 if (gtype == NEXTHOP_TYPE_BLACKHOLE) {
3633 if (IS_ZEBRA_DEBUG_MPLS)
3634 zlog_debug("Del static LSP in-label %u", in_label);
3635
3636 /* Uninstall entire LSP from the main table. */
3637 mpls_static_lsp_uninstall_all(zvrf, in_label);
3638
3639 /* Delete all static NHLFEs */
3640 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
3641 nhlfe_del(nhlfe);
3642 }
3643 } else {
3644 /* Find specific NHLFE, exit if not found. */
3645 nhlfe = nhlfe_find(&lsp->nhlfe_list, ZEBRA_LSP_STATIC,
3646 gtype, gate, ifindex);
3647 if (!nhlfe)
3648 return 0;
3649
3650 if (IS_ZEBRA_DEBUG_MPLS) {
3651 char buf[BUFSIZ];
3652 nhlfe2str(nhlfe, buf, sizeof(buf));
3653 zlog_debug("Del static LSP in-label %u nexthop %s",
3654 in_label, buf);
3655 }
3656
3657 /* Uninstall LSP from the main table. */
3658 mpls_lsp_uninstall(zvrf, ZEBRA_LSP_STATIC, in_label, gtype,
3659 gate, ifindex, false);
3660
3661 /* Delete static LSP NHLFE */
3662 nhlfe_del(nhlfe);
3663 }
3664
3665 /* Remove entire static LSP entry if no NHLFE - valid in either case
3666 * above.
3667 */
3668 if (nhlfe_list_first(&lsp->nhlfe_list) == NULL) {
3669 lsp = hash_release(slsp_table, &tmp_ile);
3670 lsp_free_nhlfe(lsp);
3671 XFREE(MTYPE_LSP, lsp);
3672 }
3673
3674 return 0;
3675 }
3676
3677 /*
3678 * Schedule all MPLS label forwarding entries for processing.
3679 * Called upon changes that may affect one or more of them such as
3680 * interface or nexthop state changes.
3681 */
3682 void zebra_mpls_lsp_schedule(struct zebra_vrf *zvrf)
3683 {
3684 if (!zvrf)
3685 return;
3686 hash_iterate(zvrf->lsp_table, lsp_schedule, NULL);
3687 }
3688
3689 /*
3690 * Display MPLS label forwarding table for a specific LSP
3691 * (VTY command handler).
3692 */
3693 void zebra_mpls_print_lsp(struct vty *vty, struct zebra_vrf *zvrf,
3694 mpls_label_t label, bool use_json)
3695 {
3696 struct hash *lsp_table;
3697 struct zebra_lsp *lsp;
3698 struct zebra_ile tmp_ile;
3699 json_object *json = NULL;
3700
3701 /* Lookup table. */
3702 lsp_table = zvrf->lsp_table;
3703 if (!lsp_table)
3704 return;
3705
3706 /* If entry is not present, exit. */
3707 tmp_ile.in_label = label;
3708 lsp = hash_lookup(lsp_table, &tmp_ile);
3709 if (!lsp)
3710 return;
3711
3712 if (use_json) {
3713 json = lsp_json(lsp);
3714 vty_json(vty, json);
3715 } else
3716 lsp_print(vty, lsp);
3717 }
3718
3719 /*
3720 * Display MPLS label forwarding table (VTY command handler).
3721 */
3722 void zebra_mpls_print_lsp_table(struct vty *vty, struct zebra_vrf *zvrf,
3723 bool use_json)
3724 {
3725 char buf[BUFSIZ];
3726 json_object *json = NULL;
3727 struct zebra_lsp *lsp = NULL;
3728 struct zebra_nhlfe *nhlfe = NULL;
3729 struct listnode *node = NULL;
3730 struct list *lsp_list = hash_get_sorted_list(zvrf->lsp_table, lsp_cmp);
3731
3732 if (use_json) {
3733 json = json_object_new_object();
3734
3735 for (ALL_LIST_ELEMENTS_RO(lsp_list, node, lsp))
3736 json_object_object_add(
3737 json, label2str(lsp->ile.in_label, buf,
3738 sizeof(buf)),
3739 lsp_json(lsp));
3740
3741 vty_json(vty, json);
3742 } else {
3743 struct ttable *tt;
3744
3745 /* Prepare table. */
3746 tt = ttable_new(&ttable_styles[TTSTYLE_BLANK]);
3747 ttable_add_row(tt, "Inbound Label|Type|Nexthop|Outbound Label");
3748 tt->style.cell.rpad = 2;
3749 tt->style.corner = '+';
3750 ttable_restyle(tt);
3751 ttable_rowseps(tt, 0, BOTTOM, true, '-');
3752
3753 for (ALL_LIST_ELEMENTS_RO(lsp_list, node, lsp)) {
3754 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
3755 struct nexthop *nexthop;
3756 const char *out_label_str;
3757 char nh_buf[NEXTHOP_STRLEN];
3758
3759 nexthop = nhlfe->nexthop;
3760
3761 switch (nexthop->type) {
3762 case NEXTHOP_TYPE_IFINDEX: {
3763 struct zebra_ns *zns;
3764 struct interface *ifp;
3765
3766 zns = zebra_ns_lookup(NS_DEFAULT);
3767 ifp = if_lookup_by_index_per_ns(
3768 zns, nexthop->ifindex);
3769 snprintf(nh_buf, sizeof(nh_buf), "%s",
3770 ifp ? ifp->name : "Null");
3771 break;
3772 }
3773 case NEXTHOP_TYPE_IPV4:
3774 case NEXTHOP_TYPE_IPV4_IFINDEX:
3775 inet_ntop(AF_INET, &nexthop->gate.ipv4,
3776 nh_buf, sizeof(nh_buf));
3777 break;
3778 case NEXTHOP_TYPE_IPV6:
3779 case NEXTHOP_TYPE_IPV6_IFINDEX:
3780 inet_ntop(AF_INET6, &nexthop->gate.ipv6,
3781 nh_buf, sizeof(nh_buf));
3782 break;
3783 case NEXTHOP_TYPE_BLACKHOLE:
3784 break;
3785 }
3786
3787 if (nexthop->type != NEXTHOP_TYPE_IFINDEX)
3788 out_label_str = mpls_label2str(
3789 nexthop->nh_label->num_labels,
3790 &nexthop->nh_label->label[0],
3791 buf, sizeof(buf), 1);
3792 else
3793 out_label_str = "-";
3794
3795 ttable_add_row(tt, "%u|%s|%s|%s",
3796 lsp->ile.in_label,
3797 nhlfe_type2str(nhlfe->type),
3798 nh_buf, out_label_str);
3799 }
3800 }
3801
3802 /* Dump the generated table. */
3803 if (tt->nrows > 1) {
3804 char *table = ttable_dump(tt, "\n");
3805 vty_out(vty, "%s\n", table);
3806 XFREE(MTYPE_TMP, table);
3807 }
3808 ttable_del(tt);
3809 }
3810
3811 list_delete(&lsp_list);
3812 }
3813
3814 /*
3815 * Create printable string for static LSP configuration.
3816 */
3817 static char *nhlfe_config_str(const struct zebra_nhlfe *nhlfe, char *buf,
3818 int size)
3819 {
3820 const struct nexthop *nh;
3821
3822 nh = nhlfe->nexthop;
3823
3824 buf[0] = '\0';
3825 switch (nh->type) {
3826 case NEXTHOP_TYPE_IPV4:
3827 case NEXTHOP_TYPE_IPV4_IFINDEX:
3828 inet_ntop(AF_INET, &nh->gate.ipv4, buf, size);
3829 if (nh->ifindex)
3830 strlcat(buf, ifindex2ifname(nh->ifindex, VRF_DEFAULT),
3831 size);
3832 break;
3833 case NEXTHOP_TYPE_IPV6:
3834 case NEXTHOP_TYPE_IPV6_IFINDEX:
3835 inet_ntop(AF_INET6, &nh->gate.ipv6, buf, size);
3836 if (nh->ifindex)
3837 strlcat(buf,
3838 ifindex2ifname(nh->ifindex, VRF_DEFAULT),
3839 size);
3840 break;
3841 case NEXTHOP_TYPE_IFINDEX:
3842 if (nh->ifindex)
3843 strlcat(buf,
3844 ifindex2ifname(nh->ifindex, VRF_DEFAULT),
3845 size);
3846 break;
3847 case NEXTHOP_TYPE_BLACKHOLE:
3848 break;
3849 }
3850
3851 return buf;
3852 }
3853
3854 /*
3855 * Display MPLS LSP configuration of all static LSPs (VTY command handler).
3856 */
3857 int zebra_mpls_write_lsp_config(struct vty *vty, struct zebra_vrf *zvrf)
3858 {
3859 struct zebra_lsp *lsp;
3860 struct zebra_nhlfe *nhlfe;
3861 struct nexthop *nh;
3862 struct listnode *node;
3863 struct list *slsp_list =
3864 hash_get_sorted_list(zvrf->slsp_table, lsp_cmp);
3865
3866 for (ALL_LIST_ELEMENTS_RO(slsp_list, node, lsp)) {
3867 frr_each(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
3868 char buf[BUFSIZ];
3869 char lstr[30];
3870
3871 nh = nhlfe->nexthop;
3872 if (nh == NULL || nh->nh_label == NULL)
3873 continue;
3874
3875 nhlfe_config_str(nhlfe, buf, sizeof(buf));
3876
3877 switch (nh->nh_label->label[0]) {
3878 case MPLS_LABEL_IPV4_EXPLICIT_NULL:
3879 case MPLS_LABEL_IPV6_EXPLICIT_NULL:
3880 strlcpy(lstr, "explicit-null", sizeof(lstr));
3881 break;
3882 case MPLS_LABEL_IMPLICIT_NULL:
3883 strlcpy(lstr, "implicit-null", sizeof(lstr));
3884 break;
3885 default:
3886 snprintf(lstr, sizeof(lstr), "%u",
3887 nh->nh_label->label[0]);
3888 break;
3889 }
3890
3891 vty_out(vty, "mpls lsp %u %s %s\n", lsp->ile.in_label,
3892 buf, lstr);
3893 }
3894 }
3895
3896 list_delete(&slsp_list);
3897 return (zvrf->slsp_table->count ? 1 : 0);
3898 }
3899
3900 /*
3901 * Add/update global label block.
3902 */
3903 int zebra_mpls_label_block_add(struct zebra_vrf *zvrf, uint32_t start_label,
3904 uint32_t end_label)
3905 {
3906 zvrf->mpls_srgb.start_label = start_label;
3907 zvrf->mpls_srgb.end_label = end_label;
3908
3909 /* Evaluate registered FECs to see if any get a label or not. */
3910 fec_evaluate(zvrf);
3911 return 0;
3912 }
3913
3914 /*
3915 * Delete global label block.
3916 */
3917 int zebra_mpls_label_block_del(struct zebra_vrf *zvrf)
3918 {
3919 zvrf->mpls_srgb.start_label = MPLS_DEFAULT_MIN_SRGB_LABEL;
3920 zvrf->mpls_srgb.end_label = MPLS_DEFAULT_MAX_SRGB_LABEL;
3921
3922 /* Process registered FECs to clear their local label, if needed. */
3923 fec_evaluate(zvrf);
3924 return 0;
3925 }
3926
3927 /*
3928 * Display MPLS global label block configuration (VTY command handler).
3929 */
3930 int zebra_mpls_write_label_block_config(struct vty *vty, struct zebra_vrf *zvrf)
3931 {
3932 if (zvrf->mpls_srgb.start_label == 0)
3933 return 0;
3934
3935 if ((zvrf->mpls_srgb.start_label != MPLS_DEFAULT_MIN_SRGB_LABEL)
3936 || (zvrf->mpls_srgb.end_label != MPLS_DEFAULT_MAX_SRGB_LABEL)) {
3937 vty_out(vty, "mpls label global-block %u %u\n",
3938 zvrf->mpls_srgb.start_label, zvrf->mpls_srgb.end_label);
3939 }
3940
3941 return 1;
3942 }
3943
3944 /*
3945 * Called when VRF becomes inactive, cleans up information but keeps
3946 * the table itself.
3947 */
3948 void zebra_mpls_cleanup_tables(struct zebra_vrf *zvrf)
3949 {
3950 struct zebra_vrf *def_zvrf;
3951 afi_t afi;
3952
3953 if (zvrf_id(zvrf) == VRF_DEFAULT)
3954 hash_iterate(zvrf->lsp_table, lsp_uninstall_from_kernel, NULL);
3955 else {
3956 /*
3957 * For other vrfs, we try to remove associated LSPs; we locate
3958 * the LSPs in the default vrf.
3959 */
3960 def_zvrf = zebra_vrf_lookup_by_id(VRF_DEFAULT);
3961
3962 /* At shutdown, the default may be gone already */
3963 if (def_zvrf == NULL)
3964 return;
3965
3966 for (afi = AFI_IP; afi < AFI_MAX; afi++) {
3967 if (zvrf->label[afi] != MPLS_LABEL_NONE)
3968 lsp_uninstall(def_zvrf, zvrf->label[afi]);
3969 }
3970 }
3971 }
3972
3973 /*
3974 * When a vrf label is assigned and the client goes away
3975 * we should cleanup the vrf labels associated with
3976 * that zclient.
3977 */
3978 void zebra_mpls_client_cleanup_vrf_label(uint8_t proto)
3979 {
3980 struct vrf *vrf;
3981 struct zebra_vrf *def_zvrf = zebra_vrf_lookup_by_id(VRF_DEFAULT);
3982
3983 if (def_zvrf == NULL)
3984 return;
3985
3986 RB_FOREACH (vrf, vrf_id_head, &vrfs_by_id) {
3987 struct zebra_vrf *zvrf = vrf->info;
3988 afi_t afi;
3989
3990 if (!zvrf)
3991 continue;
3992
3993 for (afi = AFI_IP; afi < AFI_MAX; afi++) {
3994 if (zvrf->label_proto[afi] == proto
3995 && zvrf->label[afi] != MPLS_LABEL_NONE)
3996 lsp_uninstall(def_zvrf, zvrf->label[afi]);
3997
3998 /*
3999 * Cleanup data structures by fiat
4000 */
4001 zvrf->label_proto[afi] = 0;
4002 zvrf->label[afi] = MPLS_LABEL_NONE;
4003 }
4004 }
4005 }
4006
4007 static void lsp_table_free(void *p)
4008 {
4009 struct zebra_lsp *lsp = p;
4010
4011 lsp_free_nhlfe(lsp);
4012
4013 XFREE(MTYPE_LSP, lsp);
4014 }
4015
4016 /*
4017 * Called upon process exiting, need to delete LSP forwarding
4018 * entries from the kernel.
4019 * NOTE: Currently supported only for default VRF.
4020 */
4021 void zebra_mpls_close_tables(struct zebra_vrf *zvrf)
4022 {
4023 hash_iterate(zvrf->lsp_table, lsp_uninstall_from_kernel, NULL);
4024 hash_clean(zvrf->lsp_table, lsp_table_free);
4025 hash_free(zvrf->lsp_table);
4026 hash_clean(zvrf->slsp_table, lsp_table_free);
4027 hash_free(zvrf->slsp_table);
4028 route_table_finish(zvrf->fec_table[AFI_IP]);
4029 route_table_finish(zvrf->fec_table[AFI_IP6]);
4030 }
4031
4032 /*
4033 * Allocate MPLS tables for this VRF and do other initialization.
4034 * NOTE: Currently supported only for default VRF.
4035 */
4036 void zebra_mpls_init_tables(struct zebra_vrf *zvrf)
4037 {
4038 char buffer[80];
4039
4040 if (!zvrf)
4041 return;
4042
4043 snprintf(buffer, sizeof(buffer), "ZEBRA SLSP table: %s",
4044 zvrf->vrf->name);
4045 zvrf->slsp_table = hash_create_size(8, label_hash, label_cmp, buffer);
4046
4047 snprintf(buffer, sizeof(buffer), "ZEBRA LSP table: %s",
4048 zvrf->vrf->name);
4049 zvrf->lsp_table = hash_create_size(8, label_hash, label_cmp, buffer);
4050 zvrf->fec_table[AFI_IP] = route_table_init();
4051 zvrf->fec_table[AFI_IP6] = route_table_init();
4052 zvrf->mpls_flags = 0;
4053 zvrf->mpls_srgb.start_label = MPLS_DEFAULT_MIN_SRGB_LABEL;
4054 zvrf->mpls_srgb.end_label = MPLS_DEFAULT_MAX_SRGB_LABEL;
4055 }
4056
4057 void zebra_mpls_turned_on(void)
4058 {
4059 if (!mpls_enabled) {
4060 mpls_processq_init();
4061 mpls_enabled = true;
4062 }
4063
4064 hook_register(zserv_client_close, zebra_mpls_cleanup_fecs_for_client);
4065 hook_register(zserv_client_close, zebra_mpls_cleanup_zclient_labels);
4066 }
4067
4068 /*
4069 * Global MPLS initialization.
4070 */
4071 void zebra_mpls_init(void)
4072 {
4073 mpls_enabled = false;
4074 mpls_pw_reach_strict = false;
4075
4076 if (mpls_kernel_init() < 0) {
4077 flog_warn(EC_ZEBRA_MPLS_SUPPORT_DISABLED,
4078 "Disabling MPLS support (no kernel support)");
4079 return;
4080 }
4081
4082 zebra_mpls_turned_on();
4083 }
FRRouting mirror