]> 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 #11894 from sri-mohan1/sri-bgp-dbg1
[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 void zebra_mpls_ftn_uninstall(struct zebra_vrf *zvrf, enum lsp_types_t type,
2751 struct prefix *prefix, uint8_t route_type,
2752 uint8_t 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;
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;
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
2806 /*
2807 * Iterate through a list of nexthops, for a match for 'znh'. If found,
2808 * update its labels according to 'add_p', and return 'true' if successful.
2809 */
2810 static bool ftn_update_znh(bool add_p, enum lsp_types_t type,
2811 struct nexthop *head, const struct zapi_nexthop *znh)
2812 {
2813 bool found = false, success = false;
2814 struct nexthop *nexthop;
2815
2816 for (nexthop = head; nexthop; nexthop = nexthop->next) {
2817 switch (nexthop->type) {
2818 case NEXTHOP_TYPE_IPV4:
2819 case NEXTHOP_TYPE_IPV4_IFINDEX:
2820 if (znh->type != NEXTHOP_TYPE_IPV4
2821 && znh->type != NEXTHOP_TYPE_IPV4_IFINDEX)
2822 continue;
2823 if (!IPV4_ADDR_SAME(&nexthop->gate.ipv4,
2824 &znh->gate.ipv4))
2825 continue;
2826 if (nexthop->type == NEXTHOP_TYPE_IPV4_IFINDEX
2827 && nexthop->ifindex != znh->ifindex)
2828 continue;
2829
2830 found = true;
2831
2832 if (!ftn_update_nexthop(add_p, nexthop, type, znh))
2833 break;
2834
2835 success = true;
2836 break;
2837 case NEXTHOP_TYPE_IPV6:
2838 case NEXTHOP_TYPE_IPV6_IFINDEX:
2839 if (znh->type != NEXTHOP_TYPE_IPV6
2840 && znh->type != NEXTHOP_TYPE_IPV6_IFINDEX)
2841 continue;
2842 if (!IPV6_ADDR_SAME(&nexthop->gate.ipv6,
2843 &znh->gate.ipv6))
2844 continue;
2845 if (nexthop->type == NEXTHOP_TYPE_IPV6_IFINDEX
2846 && nexthop->ifindex != znh->ifindex)
2847 continue;
2848
2849 found = true;
2850
2851 if (!ftn_update_nexthop(add_p, nexthop, type, znh))
2852 break;
2853 success = true;
2854 break;
2855 case NEXTHOP_TYPE_IFINDEX:
2856 if (znh->type != NEXTHOP_TYPE_IFINDEX)
2857 continue;
2858 if (nexthop->ifindex != znh->ifindex)
2859 continue;
2860
2861 found = true;
2862
2863 if (!ftn_update_nexthop(add_p, nexthop, type, znh))
2864 break;
2865 success = true;
2866 break;
2867 case NEXTHOP_TYPE_BLACKHOLE:
2868 /* Not valid */
2869 continue;
2870 }
2871
2872 if (found)
2873 break;
2874 }
2875
2876 return success;
2877 }
2878
2879 /*
2880 * Install/uninstall LSP and (optionally) FEC-To-NHLFE (FTN) bindings,
2881 * using zapi message info.
2882 * There are several changes that need to be made, in several zebra
2883 * data structures, so we want to do all the work required at once.
2884 */
2885 void zebra_mpls_zapi_labels_process(bool add_p, struct zebra_vrf *zvrf,
2886 const struct zapi_labels *zl)
2887 {
2888 int i, counter, ret = 0;
2889 char buf[NEXTHOP_STRLEN];
2890 const struct zapi_nexthop *znh;
2891 struct route_table *table;
2892 struct route_node *rn = NULL;
2893 struct route_entry *re = NULL;
2894 struct nhg_hash_entry *new_nhe = NULL;
2895 bool found;
2896 afi_t afi = AFI_IP;
2897 const struct prefix *prefix = NULL;
2898 struct hash *lsp_table;
2899 struct zebra_ile tmp_ile;
2900 struct zebra_lsp *lsp = NULL;
2901
2902 /* Prep LSP for add case */
2903 if (add_p) {
2904 /* Lookup table. */
2905 lsp_table = zvrf->lsp_table;
2906 if (!lsp_table)
2907 return;
2908
2909 /* Find or create LSP object */
2910 tmp_ile.in_label = zl->local_label;
2911 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
2912 }
2913
2914 /* Prep for route/FEC update if requested */
2915 if (CHECK_FLAG(zl->message, ZAPI_LABELS_FTN)) {
2916 prefix = &zl->route.prefix;
2917
2918 afi = family2afi(prefix->family);
2919
2920 /* Lookup table. */
2921 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
2922 if (table) {
2923 /* Lookup existing route */
2924 rn = route_node_get(table, prefix);
2925 RNODE_FOREACH_RE(rn, re) {
2926 if (CHECK_FLAG(re->status, ROUTE_ENTRY_REMOVED))
2927 continue;
2928 if (re->type == zl->route.type &&
2929 re->instance == zl->route.instance)
2930 break;
2931 }
2932 }
2933
2934 if (re) {
2935 /*
2936 * Copy over current nexthops into a temporary group.
2937 * We can't just change the values here since the nhgs
2938 * are shared and if the labels change, we'll need
2939 * to find or create a new nhg. We need to create
2940 * a whole temporary group, make changes to it,
2941 * then attach that to the route.
2942 */
2943 new_nhe = zebra_nhe_copy(re->nhe, 0);
2944
2945 } else {
2946 /*
2947 * The old version of the zapi code
2948 * attempted to manage LSPs before trying to
2949 * find a route/FEC, so we'll continue that way.
2950 */
2951 if (IS_ZEBRA_DEBUG_RECV || IS_ZEBRA_DEBUG_MPLS)
2952 zlog_debug(
2953 "%s: FTN update requested: no route for prefix %pFX",
2954 __func__, prefix);
2955 }
2956 }
2957
2958 /*
2959 * Use info from the zapi nexthops to add/replace/remove LSP/FECs
2960 */
2961
2962 counter = 0;
2963 for (i = 0; i < zl->nexthop_num; i++) {
2964
2965 znh = &zl->nexthops[i];
2966
2967 /* Attempt LSP update */
2968 if (add_p)
2969 ret = lsp_znh_install(lsp, zl->type, znh);
2970 else
2971 ret = mpls_lsp_uninstall(zvrf, zl->type,
2972 zl->local_label, znh->type,
2973 &znh->gate, znh->ifindex,
2974 false);
2975 if (ret < 0) {
2976 if (IS_ZEBRA_DEBUG_RECV || IS_ZEBRA_DEBUG_MPLS) {
2977 zapi_nexthop2str(znh, buf, sizeof(buf));
2978 zlog_debug("%s: Unable to %sinstall LSP: label %u, znh %s",
2979 __func__, (add_p ? "" : "un"),
2980 zl->local_label, buf);
2981 }
2982 continue;
2983 }
2984
2985 /* Attempt route/FEC update if requested */
2986 if (re == NULL)
2987 continue;
2988
2989 /* Search the route's nexthops for a match, and update it. */
2990 found = ftn_update_znh(add_p, zl->type, new_nhe->nhg.nexthop,
2991 znh);
2992 if (found) {
2993 counter++;
2994 } else if (IS_ZEBRA_DEBUG_RECV | IS_ZEBRA_DEBUG_MPLS) {
2995 zapi_nexthop2str(znh, buf, sizeof(buf));
2996 zlog_debug(
2997 "%s: Unable to update FEC: prefix %pFX, label %u, znh %s",
2998 __func__, prefix, zl->local_label, buf);
2999 }
3000 }
3001
3002 /*
3003 * Process backup LSPs/nexthop entries also. We associate backup
3004 * LSP info with backup nexthops.
3005 */
3006 if (!CHECK_FLAG(zl->message, ZAPI_LABELS_HAS_BACKUPS))
3007 goto znh_done;
3008
3009 for (i = 0; i < zl->backup_nexthop_num; i++) {
3010
3011 znh = &zl->backup_nexthops[i];
3012
3013 if (add_p)
3014 ret = lsp_backup_znh_install(lsp, zl->type, znh);
3015 else
3016 ret = mpls_lsp_uninstall(zvrf, zl->type,
3017 zl->local_label,
3018 znh->type, &znh->gate,
3019 znh->ifindex, true);
3020
3021 if (ret < 0) {
3022 if (IS_ZEBRA_DEBUG_RECV ||
3023 IS_ZEBRA_DEBUG_MPLS) {
3024 zapi_nexthop2str(znh, buf, sizeof(buf));
3025 zlog_debug("%s: Unable to %sinstall backup LSP: label %u, znh %s",
3026 __func__, (add_p ? "" : "un"),
3027 zl->local_label, buf);
3028 }
3029 continue;
3030 }
3031
3032 /* Attempt backup nexthop/FEC update if requested */
3033 if (re == NULL || zebra_nhg_get_backup_nhg(new_nhe) == NULL)
3034 continue;
3035
3036 /* Search the route's backup nexthops for a match
3037 * and update it.
3038 */
3039 found = ftn_update_znh(add_p, zl->type,
3040 new_nhe->backup_info->nhe->nhg.nexthop,
3041 znh);
3042 if (found) {
3043 counter++;
3044 } else if (IS_ZEBRA_DEBUG_RECV | IS_ZEBRA_DEBUG_MPLS) {
3045 zapi_nexthop2str(znh, buf, sizeof(buf));
3046 zlog_debug(
3047 "%s: Unable to update backup FEC: prefix %pFX, label %u, znh %s",
3048 __func__, prefix, zl->local_label, buf);
3049 }
3050 }
3051
3052 znh_done:
3053
3054 /*
3055 * If we made changes, update the route, and schedule it
3056 * for rib processing
3057 */
3058 if (re != NULL && counter > 0) {
3059 assert(rn != NULL);
3060
3061 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
3062 SET_FLAG(re->status, ROUTE_ENTRY_LABELS_CHANGED);
3063
3064 mpls_zebra_nhe_update(re, afi, new_nhe);
3065
3066 rib_queue_add(rn);
3067 }
3068
3069 if (new_nhe)
3070 zebra_nhg_free(new_nhe);
3071 }
3072
3073 /*
3074 * Install/update a NHLFE for an LSP in the forwarding table. This may be
3075 * a new LSP entry or a new NHLFE for an existing in-label or an update of
3076 * the out-label for an existing NHLFE (update case).
3077 */
3078 static struct zebra_nhlfe *
3079 lsp_add_nhlfe(struct zebra_lsp *lsp, enum lsp_types_t type,
3080 uint8_t num_out_labels, const mpls_label_t *out_labels,
3081 enum nexthop_types_t gtype, const union g_addr *gate,
3082 ifindex_t ifindex, bool is_backup)
3083 {
3084 struct zebra_nhlfe *nhlfe;
3085 char buf[MPLS_LABEL_STRLEN];
3086 const char *backup_str;
3087
3088 if (is_backup) {
3089 nhlfe = nhlfe_find(&lsp->backup_nhlfe_list, type, gtype,
3090 gate, ifindex);
3091 backup_str = "backup ";
3092 } else {
3093 nhlfe = nhlfe_find(&lsp->nhlfe_list, type, gtype, gate,
3094 ifindex);
3095 backup_str = "";
3096 }
3097
3098 if (nhlfe) {
3099 struct nexthop *nh = nhlfe->nexthop;
3100
3101 assert(nh);
3102 assert(nh->nh_label);
3103
3104 /* Clear deleted flag (in case it was set) */
3105 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
3106 if (nh->nh_label->num_labels == num_out_labels
3107 && !memcmp(nh->nh_label->label, out_labels,
3108 sizeof(mpls_label_t) * num_out_labels))
3109 /* No change */
3110 return nhlfe;
3111
3112 if (IS_ZEBRA_DEBUG_MPLS) {
3113 char buf2[MPLS_LABEL_STRLEN];
3114 char buf3[MPLS_LABEL_STRLEN];
3115
3116 nhlfe2str(nhlfe, buf, sizeof(buf));
3117 mpls_label2str(num_out_labels, out_labels, buf2,
3118 sizeof(buf2), 0);
3119 mpls_label2str(nh->nh_label->num_labels,
3120 nh->nh_label->label, buf3, sizeof(buf3),
3121 0);
3122
3123 zlog_debug("LSP in-label %u type %d %snexthop %s out-label(s) changed to %s (old %s)",
3124 lsp->ile.in_label, type, backup_str, buf,
3125 buf2, buf3);
3126 }
3127
3128 /* Update out label(s), trigger processing. */
3129 if (nh->nh_label->num_labels == num_out_labels)
3130 memcpy(nh->nh_label->label, out_labels,
3131 sizeof(mpls_label_t) * num_out_labels);
3132 else {
3133 nexthop_del_labels(nh);
3134 nexthop_add_labels(nh, type, num_out_labels,
3135 out_labels);
3136 }
3137 } else {
3138 /* Add LSP entry to this nexthop */
3139 nhlfe = nhlfe_add(lsp, type, gtype, gate, ifindex,
3140 num_out_labels, out_labels, is_backup);
3141 if (!nhlfe)
3142 return NULL;
3143
3144 if (IS_ZEBRA_DEBUG_MPLS) {
3145 char buf2[MPLS_LABEL_STRLEN];
3146
3147 nhlfe2str(nhlfe, buf, sizeof(buf));
3148 mpls_label2str(num_out_labels, out_labels, buf2,
3149 sizeof(buf2), 0);
3150
3151 zlog_debug("Add LSP in-label %u type %d %snexthop %s out-label(s) %s",
3152 lsp->ile.in_label, type, backup_str, buf,
3153 buf2);
3154 }
3155
3156 lsp->addr_family = NHLFE_FAMILY(nhlfe);
3157 }
3158
3159 /* Mark NHLFE, queue LSP for processing. */
3160 SET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
3161
3162 return nhlfe;
3163 }
3164
3165 /*
3166 * Install an LSP and forwarding entry; used primarily
3167 * from vrf zapi message processing.
3168 */
3169 int mpls_lsp_install(struct zebra_vrf *zvrf, enum lsp_types_t type,
3170 mpls_label_t in_label, uint8_t num_out_labels,
3171 const mpls_label_t *out_labels, enum nexthop_types_t gtype,
3172 const union g_addr *gate, ifindex_t ifindex)
3173 {
3174 struct hash *lsp_table;
3175 struct zebra_ile tmp_ile;
3176 struct zebra_lsp *lsp;
3177 struct zebra_nhlfe *nhlfe;
3178
3179 /* Lookup table. */
3180 lsp_table = zvrf->lsp_table;
3181 if (!lsp_table)
3182 return -1;
3183
3184 /* Find or create LSP object */
3185 tmp_ile.in_label = in_label;
3186 lsp = hash_get(lsp_table, &tmp_ile, lsp_alloc);
3187
3188 nhlfe = lsp_add_nhlfe(lsp, type, num_out_labels, out_labels, gtype,
3189 gate, ifindex, false /*backup*/);
3190 if (nhlfe == NULL)
3191 return -1;
3192
3193 /* Queue LSP for processing. */
3194 if (lsp_processq_add(lsp))
3195 return -1;
3196
3197 return 0;
3198 }
3199
3200 /*
3201 * Install or replace NHLFE, using info from zapi nexthop
3202 */
3203 static int lsp_znh_install(struct zebra_lsp *lsp, enum lsp_types_t type,
3204 const struct zapi_nexthop *znh)
3205 {
3206 struct zebra_nhlfe *nhlfe;
3207
3208 nhlfe = lsp_add_nhlfe(lsp, type, znh->label_num, znh->labels,
3209 znh->type, &znh->gate, znh->ifindex,
3210 false /*backup*/);
3211 if (nhlfe == NULL)
3212 return -1;
3213
3214 /* Update backup info if present */
3215 if (CHECK_FLAG(znh->flags, ZAPI_NEXTHOP_FLAG_HAS_BACKUP)) {
3216 if (znh->backup_num > NEXTHOP_MAX_BACKUPS) {
3217 nhlfe_del(nhlfe);
3218 return -1;
3219 }
3220
3221 nhlfe->nexthop->backup_num = znh->backup_num;
3222 memcpy(nhlfe->nexthop->backup_idx, znh->backup_idx,
3223 znh->backup_num);
3224 SET_FLAG(nhlfe->nexthop->flags, NEXTHOP_FLAG_HAS_BACKUP);
3225 } else {
3226 /* Ensure there's no stale backup info */
3227 UNSET_FLAG(nhlfe->nexthop->flags, NEXTHOP_FLAG_HAS_BACKUP);
3228 nhlfe->nexthop->backup_num = 0;
3229 }
3230
3231 /* Queue LSP for processing. */
3232 if (lsp_processq_add(lsp))
3233 return -1;
3234
3235 return 0;
3236 }
3237
3238 /*
3239 * Install/update backup NHLFE for an LSP, using info from a zapi message.
3240 */
3241 static int lsp_backup_znh_install(struct zebra_lsp *lsp, enum lsp_types_t type,
3242 const struct zapi_nexthop *znh)
3243 {
3244 struct zebra_nhlfe *nhlfe;
3245
3246 nhlfe = lsp_add_nhlfe(lsp, type, znh->label_num,
3247 znh->labels, znh->type, &znh->gate,
3248 znh->ifindex, true /*backup*/);
3249 if (nhlfe == NULL) {
3250 if (IS_ZEBRA_DEBUG_MPLS)
3251 zlog_debug("%s: unable to add backup nhlfe, label: %u",
3252 __func__, lsp->ile.in_label);
3253 return -1;
3254 }
3255
3256 /* Queue LSP for processing. */
3257 if (lsp_processq_add(lsp))
3258 return -1;
3259
3260 return 0;
3261 }
3262
3263 struct zebra_lsp *mpls_lsp_find(struct zebra_vrf *zvrf, mpls_label_t in_label)
3264 {
3265 struct hash *lsp_table;
3266 struct zebra_ile tmp_ile;
3267
3268 /* Lookup table. */
3269 lsp_table = zvrf->lsp_table;
3270 if (!lsp_table)
3271 return NULL;
3272
3273 /* If entry is not present, exit. */
3274 tmp_ile.in_label = in_label;
3275 return hash_lookup(lsp_table, &tmp_ile);
3276 }
3277
3278 /*
3279 * Uninstall a particular NHLFE in the forwarding table. If this is
3280 * the only NHLFE, the entire LSP forwarding entry has to be deleted.
3281 */
3282 int mpls_lsp_uninstall(struct zebra_vrf *zvrf, enum lsp_types_t type,
3283 mpls_label_t in_label, enum nexthop_types_t gtype,
3284 const union g_addr *gate, ifindex_t ifindex,
3285 bool backup_p)
3286 {
3287 struct hash *lsp_table;
3288 struct zebra_ile tmp_ile;
3289 struct zebra_lsp *lsp;
3290 struct zebra_nhlfe *nhlfe;
3291 char buf[NEXTHOP_STRLEN];
3292 bool schedule_lsp = false;
3293
3294 /* Lookup table. */
3295 lsp_table = zvrf->lsp_table;
3296 if (!lsp_table)
3297 return -1;
3298
3299 /* If entry is not present, exit. */
3300 tmp_ile.in_label = in_label;
3301 lsp = hash_lookup(lsp_table, &tmp_ile);
3302 if (!lsp)
3303 return 0;
3304
3305 if (backup_p)
3306 nhlfe = nhlfe_find(&lsp->backup_nhlfe_list, type, gtype,
3307 gate, ifindex);
3308 else
3309 nhlfe = nhlfe_find(&lsp->nhlfe_list, type, gtype, gate,
3310 ifindex);
3311 if (!nhlfe)
3312 return 0;
3313
3314 if (IS_ZEBRA_DEBUG_MPLS) {
3315 nhlfe2str(nhlfe, buf, sizeof(buf));
3316 zlog_debug("Del LSP in-label %u type %d nexthop %s flags 0x%x",
3317 in_label, type, buf, nhlfe->flags);
3318 }
3319
3320 if (CHECK_FLAG(lsp->flags, LSP_FLAG_INSTALLED) ||
3321 CHECK_FLAG(nhlfe->flags, NHLFE_FLAG_INSTALLED))
3322 schedule_lsp = true;
3323
3324 /* Mark NHLFE for delete or directly delete, as appropriate. */
3325 if (schedule_lsp) {
3326 SET_FLAG(nhlfe->flags, NHLFE_FLAG_DELETED);
3327 UNSET_FLAG(nhlfe->flags, NHLFE_FLAG_CHANGED);
3328
3329 if (IS_ZEBRA_DEBUG_MPLS)
3330 zlog_debug("Schedule LSP in-label %u flags 0x%x",
3331 lsp->ile.in_label, lsp->flags);
3332 if (lsp_processq_add(lsp))
3333 return -1;
3334 } else {
3335 nhlfe_del(nhlfe);
3336
3337 /* Free LSP entry if no other NHLFEs and not scheduled. */
3338 lsp_check_free(lsp_table, &lsp);
3339 }
3340 return 0;
3341 }
3342
3343 int mpls_lsp_uninstall_all_vrf(struct zebra_vrf *zvrf, enum lsp_types_t type,
3344 mpls_label_t in_label)
3345 {
3346 struct hash *lsp_table;
3347 struct zebra_ile tmp_ile;
3348 struct zebra_lsp *lsp;
3349
3350 /* Lookup table. */
3351 lsp_table = zvrf->lsp_table;
3352 if (!lsp_table)
3353 return -1;
3354
3355 /* If entry is not present, exit. */
3356 tmp_ile.in_label = in_label;
3357 lsp = hash_lookup(lsp_table, &tmp_ile);
3358 if (!lsp)
3359 return 0;
3360
3361 return mpls_lsp_uninstall_all(lsp_table, lsp, type);
3362 }
3363
3364 /*
3365 * Uninstall all NHLFEs for a particular LSP forwarding entry.
3366 * If no other NHLFEs exist, the entry would be deleted.
3367 */
3368 static void mpls_lsp_uninstall_all_type(struct hash_bucket *bucket, void *ctxt)
3369 {
3370 struct lsp_uninstall_args *args = ctxt;
3371 struct zebra_lsp *lsp;
3372 struct hash *lsp_table;
3373
3374 lsp = (struct zebra_lsp *)bucket->data;
3375 if (nhlfe_list_first(&lsp->nhlfe_list) == NULL)
3376 return;
3377
3378 lsp_table = args->lsp_table;
3379 if (!lsp_table)
3380 return;
3381
3382 mpls_lsp_uninstall_all(lsp_table, lsp, args->type);
3383 }
3384
3385 /*
3386 * Uninstall all FEC-To-NHLFE (FTN) bindings of the given address-family and
3387 * LSP type.
3388 */
3389 static void mpls_ftn_uninstall_all(struct zebra_vrf *zvrf,
3390 int afi, enum lsp_types_t lsp_type)
3391 {
3392 struct route_table *table;
3393 struct route_node *rn;
3394 struct route_entry *re;
3395 struct nexthop *nexthop;
3396 struct nexthop_group *nhg;
3397 bool update;
3398
3399 /* Process routes of interested address-families. */
3400 table = zebra_vrf_table(afi, SAFI_UNICAST, zvrf_id(zvrf));
3401 if (!table)
3402 return;
3403
3404 for (rn = route_top(table); rn; rn = route_next(rn)) {
3405 update = false;
3406
3407 RNODE_FOREACH_RE (rn, re) {
3408 struct nhg_hash_entry *new_nhe;
3409
3410 new_nhe = zebra_nhe_copy(re->nhe, 0);
3411
3412 nhg = &new_nhe->nhg;
3413 for (nexthop = nhg->nexthop; nexthop;
3414 nexthop = nexthop->next) {
3415 if (nexthop->nh_label_type != lsp_type)
3416 continue;
3417
3418 nexthop_del_labels(nexthop);
3419 SET_FLAG(re->status, ROUTE_ENTRY_CHANGED);
3420 SET_FLAG(re->status,
3421 ROUTE_ENTRY_LABELS_CHANGED);
3422 update = true;
3423 }
3424
3425 /* Check for backup info and update that also */
3426 nhg = zebra_nhg_get_backup_nhg(new_nhe);
3427 if (nhg != NULL) {
3428 for (nexthop = nhg->nexthop; nexthop;
3429 nexthop = nexthop->next) {
3430 if (nexthop->nh_label_type != lsp_type)
3431 continue;
3432
3433 nexthop_del_labels(nexthop);
3434 SET_FLAG(re->status,
3435 ROUTE_ENTRY_CHANGED);
3436 SET_FLAG(re->status,
3437 ROUTE_ENTRY_LABELS_CHANGED);
3438 update = true;
3439 }
3440 }
3441
3442 if (CHECK_FLAG(re->status, ROUTE_ENTRY_LABELS_CHANGED))
3443 mpls_zebra_nhe_update(re, afi, new_nhe);
3444
3445 zebra_nhg_free(new_nhe);
3446 }
3447
3448 if (update)
3449 rib_queue_add(rn);
3450 }
3451 }
3452
3453 #if defined(HAVE_CUMULUS)
3454 /*
3455 * Check that the label values used in LSP creation are consistent. The
3456 * main criteria is that if there is ECMP, the label operation must still
3457 * be consistent - i.e., all paths either do a swap or do PHP. This is due
3458 * to current HW restrictions.
3459 */
3460 int zebra_mpls_lsp_label_consistent(struct zebra_vrf *zvrf,
3461 mpls_label_t in_label,
3462 mpls_label_t out_label,
3463 enum nexthop_types_t gtype,
3464 union g_addr *gate, ifindex_t ifindex)
3465 {
3466 struct hash *slsp_table;
3467 struct zebra_ile tmp_ile;
3468 struct zebra_lsp *lsp;
3469 struct zebra_nhlfe *nhlfe;
3470 const struct nexthop *nh;
3471
3472 /* Lookup table. */
3473 slsp_table = zvrf->slsp_table;
3474 if (!slsp_table)
3475 return 0;
3476
3477 /* If entry is not present, exit. */
3478 tmp_ile.in_label = in_label;
3479 lsp = hash_lookup(slsp_table, &tmp_ile);
3480 if (!lsp)
3481 return 1;
3482
3483 nhlfe = nhlfe_find(&lsp->nhlfe_list, ZEBRA_LSP_STATIC,
3484 gtype, gate, ifindex);
3485 if (nhlfe) {
3486 nh = nhlfe->nexthop;
3487
3488 if (nh == NULL || nh->nh_label == NULL)
3489 return 0;
3490
3491 if (nh->nh_label->label[0] == out_label)
3492 return 1;
3493
3494 /* If not only NHLFE, cannot allow label change. */
3495 if (nhlfe != nhlfe_list_first(&lsp->nhlfe_list) ||
3496 nhlfe_list_next(&lsp->nhlfe_list, nhlfe) != NULL)
3497 return 0;
3498 } else {
3499 /* If other NHLFEs exist, label operation must match. */
3500 nhlfe = nhlfe_list_first(&lsp->nhlfe_list);
3501 if (nhlfe != NULL) {
3502 int cur_op, new_op;
3503
3504 nh = nhlfe->nexthop;
3505
3506 if (nh == NULL || nh->nh_label == NULL)
3507 return 0;
3508
3509 cur_op = (nh->nh_label->label[0] ==
3510 MPLS_LABEL_IMPLICIT_NULL);
3511 new_op = (out_label == MPLS_LABEL_IMPLICIT_NULL);
3512 if (cur_op != new_op)
3513 return 0;
3514 }
3515 }
3516
3517 /* Label values are good. */
3518 return 1;
3519 }
3520 #endif /* HAVE_CUMULUS */
3521
3522 /*
3523 * Add static LSP entry. This may be the first entry for this incoming label
3524 * or an additional nexthop; an existing entry may also have outgoing label
3525 * changed.
3526 * Note: The label operation (swap or PHP) is common for the LSP entry (all
3527 * NHLFEs).
3528 */
3529 int zebra_mpls_static_lsp_add(struct zebra_vrf *zvrf, mpls_label_t in_label,
3530 mpls_label_t out_label,
3531 enum nexthop_types_t gtype, union g_addr *gate,
3532 ifindex_t ifindex)
3533 {
3534 struct hash *slsp_table;
3535 struct zebra_ile tmp_ile;
3536 struct zebra_lsp *lsp;
3537 struct zebra_nhlfe *nhlfe;
3538 char buf[BUFSIZ];
3539
3540 /* Lookup table. */
3541 slsp_table = zvrf->slsp_table;
3542 if (!slsp_table)
3543 return -1;
3544
3545 /* Find or create LSP. */
3546 tmp_ile.in_label = in_label;
3547 lsp = hash_get(slsp_table, &tmp_ile, lsp_alloc);
3548
3549 nhlfe = nhlfe_find(&lsp->nhlfe_list, ZEBRA_LSP_STATIC, gtype, gate,
3550 ifindex);
3551 if (nhlfe) {
3552 struct nexthop *nh = nhlfe->nexthop;
3553
3554 assert(nh);
3555 assert(nh->nh_label);
3556
3557 /* Compare existing nexthop */
3558 if (nh->nh_label->num_labels == 1 &&
3559 nh->nh_label->label[0] == out_label)
3560 /* No change */
3561 return 0;
3562
3563 if (IS_ZEBRA_DEBUG_MPLS) {
3564 nhlfe2str(nhlfe, buf, sizeof(buf));
3565 zlog_debug(
3566 "Upd static LSP in-label %u nexthop %s out-label %u (old %u)",
3567 in_label, buf, out_label,
3568 nh->nh_label->label[0]);
3569 }
3570 if (nh->nh_label->num_labels == 1)
3571 nh->nh_label->label[0] = out_label;
3572 else {
3573 nexthop_del_labels(nh);
3574 nexthop_add_labels(nh, ZEBRA_LSP_STATIC, 1, &out_label);
3575 }
3576
3577 } else {
3578 /* Add static LSP entry to this nexthop */
3579 nhlfe = nhlfe_add(lsp, ZEBRA_LSP_STATIC, gtype, gate,
3580 ifindex, 1, &out_label, false /*backup*/);
3581 if (!nhlfe)
3582 return -1;
3583
3584 if (IS_ZEBRA_DEBUG_MPLS) {
3585 nhlfe2str(nhlfe, buf, sizeof(buf));
3586 zlog_debug(
3587 "Add static LSP in-label %u nexthop %s out-label %u",
3588 in_label, buf, out_label);
3589 }
3590 }
3591
3592 /* (Re)Install LSP in the main table. */
3593 if (mpls_lsp_install(zvrf, ZEBRA_LSP_STATIC, in_label, 1, &out_label,
3594 gtype, gate, ifindex))
3595 return -1;
3596
3597 return 0;
3598 }
3599
3600 /*
3601 * Delete static LSP entry. This may be the delete of one particular
3602 * NHLFE for this incoming label or the delete of the entire entry (i.e.,
3603 * all NHLFEs).
3604 * NOTE: Delete of the only NHLFE will also end up deleting the entire
3605 * LSP configuration.
3606 */
3607 int zebra_mpls_static_lsp_del(struct zebra_vrf *zvrf, mpls_label_t in_label,
3608 enum nexthop_types_t gtype, union g_addr *gate,
3609 ifindex_t ifindex)
3610 {
3611 struct hash *slsp_table;
3612 struct zebra_ile tmp_ile;
3613 struct zebra_lsp *lsp;
3614 struct zebra_nhlfe *nhlfe;
3615
3616 /* Lookup table. */
3617 slsp_table = zvrf->slsp_table;
3618 if (!slsp_table)
3619 return -1;
3620
3621 /* If entry is not present, exit. */
3622 tmp_ile.in_label = in_label;
3623 lsp = hash_lookup(slsp_table, &tmp_ile);
3624 if (!lsp)
3625 return 0;
3626
3627 /* Is it delete of entire LSP or a specific NHLFE? */
3628 if (gtype == NEXTHOP_TYPE_BLACKHOLE) {
3629 if (IS_ZEBRA_DEBUG_MPLS)
3630 zlog_debug("Del static LSP in-label %u", in_label);
3631
3632 /* Uninstall entire LSP from the main table. */
3633 mpls_static_lsp_uninstall_all(zvrf, in_label);
3634
3635 /* Delete all static NHLFEs */
3636 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
3637 nhlfe_del(nhlfe);
3638 }
3639 } else {
3640 /* Find specific NHLFE, exit if not found. */
3641 nhlfe = nhlfe_find(&lsp->nhlfe_list, ZEBRA_LSP_STATIC,
3642 gtype, gate, ifindex);
3643 if (!nhlfe)
3644 return 0;
3645
3646 if (IS_ZEBRA_DEBUG_MPLS) {
3647 char buf[BUFSIZ];
3648 nhlfe2str(nhlfe, buf, sizeof(buf));
3649 zlog_debug("Del static LSP in-label %u nexthop %s",
3650 in_label, buf);
3651 }
3652
3653 /* Uninstall LSP from the main table. */
3654 mpls_lsp_uninstall(zvrf, ZEBRA_LSP_STATIC, in_label, gtype,
3655 gate, ifindex, false);
3656
3657 /* Delete static LSP NHLFE */
3658 nhlfe_del(nhlfe);
3659 }
3660
3661 /* Remove entire static LSP entry if no NHLFE - valid in either case
3662 * above.
3663 */
3664 if (nhlfe_list_first(&lsp->nhlfe_list) == NULL) {
3665 lsp = hash_release(slsp_table, &tmp_ile);
3666 lsp_free_nhlfe(lsp);
3667 XFREE(MTYPE_LSP, lsp);
3668 }
3669
3670 return 0;
3671 }
3672
3673 /*
3674 * Schedule all MPLS label forwarding entries for processing.
3675 * Called upon changes that may affect one or more of them such as
3676 * interface or nexthop state changes.
3677 */
3678 void zebra_mpls_lsp_schedule(struct zebra_vrf *zvrf)
3679 {
3680 if (!zvrf)
3681 return;
3682 hash_iterate(zvrf->lsp_table, lsp_schedule, NULL);
3683 }
3684
3685 /*
3686 * Display MPLS label forwarding table for a specific LSP
3687 * (VTY command handler).
3688 */
3689 void zebra_mpls_print_lsp(struct vty *vty, struct zebra_vrf *zvrf,
3690 mpls_label_t label, bool use_json)
3691 {
3692 struct hash *lsp_table;
3693 struct zebra_lsp *lsp;
3694 struct zebra_ile tmp_ile;
3695 json_object *json = NULL;
3696
3697 /* Lookup table. */
3698 lsp_table = zvrf->lsp_table;
3699 if (!lsp_table)
3700 return;
3701
3702 /* If entry is not present, exit. */
3703 tmp_ile.in_label = label;
3704 lsp = hash_lookup(lsp_table, &tmp_ile);
3705 if (!lsp)
3706 return;
3707
3708 if (use_json) {
3709 json = lsp_json(lsp);
3710 vty_json(vty, json);
3711 } else
3712 lsp_print(vty, lsp);
3713 }
3714
3715 /*
3716 * Display MPLS label forwarding table (VTY command handler).
3717 */
3718 void zebra_mpls_print_lsp_table(struct vty *vty, struct zebra_vrf *zvrf,
3719 bool use_json)
3720 {
3721 char buf[BUFSIZ];
3722 json_object *json = NULL;
3723 struct zebra_lsp *lsp = NULL;
3724 struct zebra_nhlfe *nhlfe = NULL;
3725 struct listnode *node = NULL;
3726 struct list *lsp_list = hash_get_sorted_list(zvrf->lsp_table, lsp_cmp);
3727
3728 if (use_json) {
3729 json = json_object_new_object();
3730
3731 for (ALL_LIST_ELEMENTS_RO(lsp_list, node, lsp))
3732 json_object_object_add(
3733 json, label2str(lsp->ile.in_label, buf,
3734 sizeof(buf)),
3735 lsp_json(lsp));
3736
3737 vty_json(vty, json);
3738 } else {
3739 struct ttable *tt;
3740
3741 /* Prepare table. */
3742 tt = ttable_new(&ttable_styles[TTSTYLE_BLANK]);
3743 ttable_add_row(tt, "Inbound Label|Type|Nexthop|Outbound Label");
3744 tt->style.cell.rpad = 2;
3745 tt->style.corner = '+';
3746 ttable_restyle(tt);
3747 ttable_rowseps(tt, 0, BOTTOM, true, '-');
3748
3749 for (ALL_LIST_ELEMENTS_RO(lsp_list, node, lsp)) {
3750 frr_each_safe(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
3751 struct nexthop *nexthop;
3752 const char *out_label_str;
3753 char nh_buf[NEXTHOP_STRLEN];
3754
3755 nexthop = nhlfe->nexthop;
3756
3757 switch (nexthop->type) {
3758 case NEXTHOP_TYPE_IFINDEX: {
3759 struct zebra_ns *zns;
3760 struct interface *ifp;
3761
3762 zns = zebra_ns_lookup(NS_DEFAULT);
3763 ifp = if_lookup_by_index_per_ns(
3764 zns, nexthop->ifindex);
3765 snprintf(nh_buf, sizeof(nh_buf), "%s",
3766 ifp ? ifp->name : "Null");
3767 break;
3768 }
3769 case NEXTHOP_TYPE_IPV4:
3770 case NEXTHOP_TYPE_IPV4_IFINDEX:
3771 inet_ntop(AF_INET, &nexthop->gate.ipv4,
3772 nh_buf, sizeof(nh_buf));
3773 break;
3774 case NEXTHOP_TYPE_IPV6:
3775 case NEXTHOP_TYPE_IPV6_IFINDEX:
3776 inet_ntop(AF_INET6, &nexthop->gate.ipv6,
3777 nh_buf, sizeof(nh_buf));
3778 break;
3779 case NEXTHOP_TYPE_BLACKHOLE:
3780 break;
3781 }
3782
3783 if (nexthop->type != NEXTHOP_TYPE_IFINDEX)
3784 out_label_str = mpls_label2str(
3785 nexthop->nh_label->num_labels,
3786 &nexthop->nh_label->label[0],
3787 buf, sizeof(buf), 1);
3788 else
3789 out_label_str = "-";
3790
3791 ttable_add_row(tt, "%u|%s|%s|%s",
3792 lsp->ile.in_label,
3793 nhlfe_type2str(nhlfe->type),
3794 nh_buf, out_label_str);
3795 }
3796 }
3797
3798 /* Dump the generated table. */
3799 if (tt->nrows > 1) {
3800 char *table = ttable_dump(tt, "\n");
3801 vty_out(vty, "%s\n", table);
3802 XFREE(MTYPE_TMP, table);
3803 }
3804 ttable_del(tt);
3805 }
3806
3807 list_delete(&lsp_list);
3808 }
3809
3810 /*
3811 * Create printable string for static LSP configuration.
3812 */
3813 static char *nhlfe_config_str(const struct zebra_nhlfe *nhlfe, char *buf,
3814 int size)
3815 {
3816 const struct nexthop *nh;
3817
3818 nh = nhlfe->nexthop;
3819
3820 buf[0] = '\0';
3821 switch (nh->type) {
3822 case NEXTHOP_TYPE_IPV4:
3823 case NEXTHOP_TYPE_IPV4_IFINDEX:
3824 inet_ntop(AF_INET, &nh->gate.ipv4, buf, size);
3825 if (nh->ifindex)
3826 strlcat(buf, ifindex2ifname(nh->ifindex, VRF_DEFAULT),
3827 size);
3828 break;
3829 case NEXTHOP_TYPE_IPV6:
3830 case NEXTHOP_TYPE_IPV6_IFINDEX:
3831 inet_ntop(AF_INET6, &nh->gate.ipv6, buf, size);
3832 if (nh->ifindex)
3833 strlcat(buf,
3834 ifindex2ifname(nh->ifindex, VRF_DEFAULT),
3835 size);
3836 break;
3837 case NEXTHOP_TYPE_IFINDEX:
3838 if (nh->ifindex)
3839 strlcat(buf,
3840 ifindex2ifname(nh->ifindex, VRF_DEFAULT),
3841 size);
3842 break;
3843 case NEXTHOP_TYPE_BLACKHOLE:
3844 break;
3845 }
3846
3847 return buf;
3848 }
3849
3850 /*
3851 * Display MPLS LSP configuration of all static LSPs (VTY command handler).
3852 */
3853 int zebra_mpls_write_lsp_config(struct vty *vty, struct zebra_vrf *zvrf)
3854 {
3855 struct zebra_lsp *lsp;
3856 struct zebra_nhlfe *nhlfe;
3857 struct nexthop *nh;
3858 struct listnode *node;
3859 struct list *slsp_list =
3860 hash_get_sorted_list(zvrf->slsp_table, lsp_cmp);
3861
3862 for (ALL_LIST_ELEMENTS_RO(slsp_list, node, lsp)) {
3863 frr_each(nhlfe_list, &lsp->nhlfe_list, nhlfe) {
3864 char buf[BUFSIZ];
3865 char lstr[30];
3866
3867 nh = nhlfe->nexthop;
3868 if (nh == NULL || nh->nh_label == NULL)
3869 continue;
3870
3871 nhlfe_config_str(nhlfe, buf, sizeof(buf));
3872
3873 switch (nh->nh_label->label[0]) {
3874 case MPLS_LABEL_IPV4_EXPLICIT_NULL:
3875 case MPLS_LABEL_IPV6_EXPLICIT_NULL:
3876 strlcpy(lstr, "explicit-null", sizeof(lstr));
3877 break;
3878 case MPLS_LABEL_IMPLICIT_NULL:
3879 strlcpy(lstr, "implicit-null", sizeof(lstr));
3880 break;
3881 default:
3882 snprintf(lstr, sizeof(lstr), "%u",
3883 nh->nh_label->label[0]);
3884 break;
3885 }
3886
3887 vty_out(vty, "mpls lsp %u %s %s\n", lsp->ile.in_label,
3888 buf, lstr);
3889 }
3890 }
3891
3892 list_delete(&slsp_list);
3893 return (zvrf->slsp_table->count ? 1 : 0);
3894 }
3895
3896 /*
3897 * Add/update global label block.
3898 */
3899 int zebra_mpls_label_block_add(struct zebra_vrf *zvrf, uint32_t start_label,
3900 uint32_t end_label)
3901 {
3902 zvrf->mpls_srgb.start_label = start_label;
3903 zvrf->mpls_srgb.end_label = end_label;
3904
3905 /* Evaluate registered FECs to see if any get a label or not. */
3906 fec_evaluate(zvrf);
3907 return 0;
3908 }
3909
3910 /*
3911 * Delete global label block.
3912 */
3913 int zebra_mpls_label_block_del(struct zebra_vrf *zvrf)
3914 {
3915 zvrf->mpls_srgb.start_label = MPLS_DEFAULT_MIN_SRGB_LABEL;
3916 zvrf->mpls_srgb.end_label = MPLS_DEFAULT_MAX_SRGB_LABEL;
3917
3918 /* Process registered FECs to clear their local label, if needed. */
3919 fec_evaluate(zvrf);
3920 return 0;
3921 }
3922
3923 /*
3924 * Display MPLS global label block configuration (VTY command handler).
3925 */
3926 int zebra_mpls_write_label_block_config(struct vty *vty, struct zebra_vrf *zvrf)
3927 {
3928 if (zvrf->mpls_srgb.start_label == 0)
3929 return 0;
3930
3931 if ((zvrf->mpls_srgb.start_label != MPLS_DEFAULT_MIN_SRGB_LABEL)
3932 || (zvrf->mpls_srgb.end_label != MPLS_DEFAULT_MAX_SRGB_LABEL)) {
3933 vty_out(vty, "mpls label global-block %u %u\n",
3934 zvrf->mpls_srgb.start_label, zvrf->mpls_srgb.end_label);
3935 }
3936
3937 return 1;
3938 }
3939
3940 /*
3941 * Called when VRF becomes inactive, cleans up information but keeps
3942 * the table itself.
3943 */
3944 void zebra_mpls_cleanup_tables(struct zebra_vrf *zvrf)
3945 {
3946 struct zebra_vrf *def_zvrf;
3947 afi_t afi;
3948
3949 if (zvrf_id(zvrf) == VRF_DEFAULT)
3950 hash_iterate(zvrf->lsp_table, lsp_uninstall_from_kernel, NULL);
3951 else {
3952 /*
3953 * For other vrfs, we try to remove associated LSPs; we locate
3954 * the LSPs in the default vrf.
3955 */
3956 def_zvrf = zebra_vrf_lookup_by_id(VRF_DEFAULT);
3957
3958 /* At shutdown, the default may be gone already */
3959 if (def_zvrf == NULL)
3960 return;
3961
3962 for (afi = AFI_IP; afi < AFI_MAX; afi++) {
3963 if (zvrf->label[afi] != MPLS_LABEL_NONE)
3964 lsp_uninstall(def_zvrf, zvrf->label[afi]);
3965 }
3966 }
3967 }
3968
3969 /*
3970 * When a vrf label is assigned and the client goes away
3971 * we should cleanup the vrf labels associated with
3972 * that zclient.
3973 */
3974 void zebra_mpls_client_cleanup_vrf_label(uint8_t proto)
3975 {
3976 struct vrf *vrf;
3977 struct zebra_vrf *def_zvrf = zebra_vrf_lookup_by_id(VRF_DEFAULT);
3978
3979 if (def_zvrf == NULL)
3980 return;
3981
3982 RB_FOREACH (vrf, vrf_id_head, &vrfs_by_id) {
3983 struct zebra_vrf *zvrf = vrf->info;
3984 afi_t afi;
3985
3986 if (!zvrf)
3987 continue;
3988
3989 for (afi = AFI_IP; afi < AFI_MAX; afi++) {
3990 if (zvrf->label_proto[afi] == proto
3991 && zvrf->label[afi] != MPLS_LABEL_NONE)
3992 lsp_uninstall(def_zvrf, zvrf->label[afi]);
3993
3994 /*
3995 * Cleanup data structures by fiat
3996 */
3997 zvrf->label_proto[afi] = 0;
3998 zvrf->label[afi] = MPLS_LABEL_NONE;
3999 }
4000 }
4001 }
4002
4003 static void lsp_table_free(void *p)
4004 {
4005 struct zebra_lsp *lsp = p;
4006
4007 lsp_free_nhlfe(lsp);
4008
4009 XFREE(MTYPE_LSP, lsp);
4010 }
4011
4012 /*
4013 * Called upon process exiting, need to delete LSP forwarding
4014 * entries from the kernel.
4015 * NOTE: Currently supported only for default VRF.
4016 */
4017 void zebra_mpls_close_tables(struct zebra_vrf *zvrf)
4018 {
4019 hash_iterate(zvrf->lsp_table, lsp_uninstall_from_kernel, NULL);
4020 hash_clean(zvrf->lsp_table, lsp_table_free);
4021 hash_free(zvrf->lsp_table);
4022 hash_clean(zvrf->slsp_table, lsp_table_free);
4023 hash_free(zvrf->slsp_table);
4024 route_table_finish(zvrf->fec_table[AFI_IP]);
4025 route_table_finish(zvrf->fec_table[AFI_IP6]);
4026 }
4027
4028 /*
4029 * Allocate MPLS tables for this VRF and do other initialization.
4030 * NOTE: Currently supported only for default VRF.
4031 */
4032 void zebra_mpls_init_tables(struct zebra_vrf *zvrf)
4033 {
4034 char buffer[80];
4035
4036 if (!zvrf)
4037 return;
4038
4039 snprintf(buffer, sizeof(buffer), "ZEBRA SLSP table: %s",
4040 zvrf->vrf->name);
4041 zvrf->slsp_table = hash_create_size(8, label_hash, label_cmp, buffer);
4042
4043 snprintf(buffer, sizeof(buffer), "ZEBRA LSP table: %s",
4044 zvrf->vrf->name);
4045 zvrf->lsp_table = hash_create_size(8, label_hash, label_cmp, buffer);
4046 zvrf->fec_table[AFI_IP] = route_table_init();
4047 zvrf->fec_table[AFI_IP6] = route_table_init();
4048 zvrf->mpls_flags = 0;
4049 zvrf->mpls_srgb.start_label = MPLS_DEFAULT_MIN_SRGB_LABEL;
4050 zvrf->mpls_srgb.end_label = MPLS_DEFAULT_MAX_SRGB_LABEL;
4051 }
4052
4053 void zebra_mpls_turned_on(void)
4054 {
4055 if (!mpls_enabled) {
4056 mpls_processq_init();
4057 mpls_enabled = true;
4058 }
4059
4060 hook_register(zserv_client_close, zebra_mpls_cleanup_fecs_for_client);
4061 hook_register(zserv_client_close, zebra_mpls_cleanup_zclient_labels);
4062 }
4063
4064 /*
4065 * Global MPLS initialization.
4066 */
4067 void zebra_mpls_init(void)
4068 {
4069 mpls_enabled = false;
4070 mpls_pw_reach_strict = false;
4071
4072 if (mpls_kernel_init() < 0) {
4073 flog_warn(EC_ZEBRA_MPLS_SUPPORT_DISABLED,
4074 "Disabling MPLS support (no kernel support)");
4075 return;
4076 }
4077
4078 zebra_mpls_turned_on();
4079 }
FRRouting mirror