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