]> git.proxmox.com Git - mirror_frr.git/blame - ospfd/ospf_sr.c
projects / mirror_frr.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
*: Add a hash_clean_and_free() function
[mirror_frr.git] / ospfd / ospf_sr.c
CommitLineData
acddc0ed 1// SPDX-License-Identifier: GPL-2.0-or-later
cf9b9f77
OD		 2/*
3 * This is an implementation of Segment Routing
6f751f14
OD		 4 * as per RFC 8665 - OSPF Extensions for Segment Routing
5 * and RFC 8476 - Signaling Maximum SID Depth (MSD) Using OSPF
cf9b9f77
OD		 6 *
7 * Module name: Segment Routing
8 *
cf9b9f77 9 * Author: Olivier Dugeon <olivier.dugeon@orange.com>
7743f2f8 10 * Author: Anselme Sawadogo <anselmesawadogo@gmail.com>
cf9b9f77 11 *
6f751f14 12 * Copyright (C) 2016 - 2020 Orange Labs http://www.orange.com
cf9b9f77
OD		 13 */
14
b45ac5f5
DL		 15#ifdef HAVE_CONFIG_H
16#include "config.h"
17#endif
18
cf9b9f77
OD		 19#include <math.h>
20#include <stdio.h>
21#include <stdlib.h>
22#include <zebra.h>
23
b61264a8 24#include "printfrr.h"
cf9b9f77
OD		 25#include "command.h"
26#include "hash.h"
27#include "if.h"
28#include "if.h"
29#include "jhash.h"
30#include "libospf.h" /* for ospf interface types */
31#include "linklist.h"
32#include "log.h"
33#include "memory.h"
34#include "monotime.h"
35#include "network.h"
36#include "prefix.h"
37#include "sockunion.h" /* for inet_aton() */
38#include "stream.h"
39#include "table.h"
40#include "thread.h"
41#include "vty.h"
42#include "zclient.h"
b37eb79c 43#include "sbuf.h"
76665890 44#include <lib/json.h>
313d7993 45#include "ospf_errors.h"
cf9b9f77
OD		 46
47#include "ospfd/ospfd.h"
48#include "ospfd/ospf_interface.h"
49#include "ospfd/ospf_ism.h"
50#include "ospfd/ospf_asbr.h"
51#include "ospfd/ospf_lsa.h"
52#include "ospfd/ospf_lsdb.h"
53#include "ospfd/ospf_neighbor.h"
54#include "ospfd/ospf_nsm.h"
55#include "ospfd/ospf_flood.h"
56#include "ospfd/ospf_packet.h"
57#include "ospfd/ospf_spf.h"
58#include "ospfd/ospf_dump.h"
59#include "ospfd/ospf_route.h"
60#include "ospfd/ospf_ase.h"
61#include "ospfd/ospf_sr.h"
62#include "ospfd/ospf_ri.h"
63#include "ospfd/ospf_ext.h"
64#include "ospfd/ospf_zebra.h"
65
66/*
67 * Global variable to manage Segment Routing on this node.
68 * Note that all parameter values are stored in network byte order.
69 */
70static struct ospf_sr_db OspfSR;
71static void ospf_sr_register_vty(void);
b37eb79c 72static inline void del_adj_sid(struct sr_nhlfe nhlfe);
d81b8e0e 73static int ospf_sr_start(struct ospf *ospf);
cf9b9f77
OD		 74
75/*
76 * Segment Routing Data Base functions
77 */
78
79/* Hash function for Segment Routing entry */
d8b87afe 80static unsigned int sr_hash(const void *p)
cf9b9f77
OD		 81{
82 const struct in_addr *rid = p;
83
7743f2f8 84 return jhash_1word(rid->s_addr, 0);
cf9b9f77
OD		 85}
86
87/* Compare 2 Router ID hash entries based on SR Node */
74df8d6d 88static bool sr_cmp(const void *p1, const void *p2)
cf9b9f77
OD		 89{
90 const struct sr_node *srn = p1;
91 const struct in_addr *rid = p2;
92
7743f2f8 93 return IPV4_ADDR_SAME(&srn->adv_router, rid);
cf9b9f77
OD		 94}
95
fd3b19f2
OD		 96/* Functions to remove an SR Link */
97static void del_sr_link(void *val)
cf9b9f77 98{
fd3b19f2
OD		 99 struct sr_link *srl = (struct sr_link *)val;
100
b37eb79c
OD		 101 del_adj_sid(srl->nhlfe[0]);
102 del_adj_sid(srl->nhlfe[1]);
fd3b19f2 103 XFREE(MTYPE_OSPF_SR_PARAMS, val);
fd3b19f2
OD		 104}
105
106/* Functions to remove an SR Prefix */
107static void del_sr_pref(void *val)
108{
109 struct sr_prefix *srp = (struct sr_prefix *)val;
110
43e7abb5 111 ospf_zebra_delete_prefix_sid(srp);
cf9b9f77 112 XFREE(MTYPE_OSPF_SR_PARAMS, val);
cf9b9f77
OD		 113}
114
115/* Allocate new Segment Routine node */
116static struct sr_node *sr_node_new(struct in_addr *rid)
117{
118
119 if (rid == NULL)
120 return NULL;
121
122 struct sr_node *new;
123
124 /* Allocate Segment Routing node memory */
125 new = XCALLOC(MTYPE_OSPF_SR_PARAMS, sizeof(struct sr_node));
126
cf9b9f77
OD		 127 /* Default Algorithm, SRGB and MSD */
128 for (int i = 0; i < ALGORITHM_COUNT; i++)
fd3b19f2 129 new->algo[i] = SR_ALGORITHM_UNSET;
cf9b9f77
OD		 130
131 new->srgb.range_size = 0;
132 new->srgb.lower_bound = 0;
133 new->msd = 0;
134
135 /* Create Link, Prefix and Range TLVs list */
136 new->ext_link = list_new();
137 new->ext_prefix = list_new();
fd3b19f2
OD		 138 new->ext_link->del = del_sr_link;
139 new->ext_prefix->del = del_sr_pref;
cf9b9f77 140
cf9b9f77
OD		 141 IPV4_ADDR_COPY(&new->adv_router, rid);
142 new->neighbor = NULL;
143 new->instance = 0;
144
b37eb79c 145 osr_debug(" |- Created new SR node for %pI4", &new->adv_router);
cf9b9f77
OD		 146 return new;
147}
148
7fd0729f
G		 149/* Supposed to be used for testing */
150struct sr_node *ospf_sr_node_create(struct in_addr *rid)
151{
152 struct sr_node *srn;
153
154 srn = hash_get(OspfSR.neighbors, (void *)rid, (void *)sr_node_new);
155
156 return srn;
157}
158
cf9b9f77
OD		 159/* Delete Segment Routing node */
160static void sr_node_del(struct sr_node *srn)
161{
cf9b9f77
OD		 162 /* Sanity Check */
163 if (srn == NULL)
164 return;
165
b61264a8
OD		 166 osr_debug(" |- Delete SR node for %pI4", &srn->adv_router);
167
cf9b9f77 168 /* Clean Extended Link */
6a154c88 169 list_delete(&srn->ext_link);
cf9b9f77
OD		 170
171 /* Clean Prefix List */
6a154c88 172 list_delete(&srn->ext_prefix);
cf9b9f77
OD		 173
174 XFREE(MTYPE_OSPF_SR_PARAMS, srn);
175}
176
177/* Get SR Node for a given nexthop */
178static struct sr_node *get_sr_node_by_nexthop(struct ospf *ospf,
179 struct in_addr nexthop)
180{
181 struct ospf_interface *oi = NULL;
182 struct ospf_neighbor *nbr = NULL;
183 struct listnode *node;
184 struct route_node *rn;
185 struct sr_node *srn;
7743f2f8 186 bool found;
cf9b9f77
OD		 187
188 /* Sanity check */
189 if (OspfSR.neighbors == NULL)
190 return NULL;
191
b37eb79c 192 osr_debug(" |- Search SR-Node for nexthop %pI4", &nexthop);
cf9b9f77
OD		 193
194 /* First, search neighbor Router ID for this nexthop */
7743f2f8
OD		 195 found = false;
196 for (ALL_LIST_ELEMENTS_RO(ospf->oiflist, node, oi)) {
197 for (rn = route_top(oi->nbrs); rn; rn = route_next(rn)) {
198 nbr = rn->info;
199 if ((nbr) && (IPV4_ADDR_SAME(&nexthop, &nbr->src))) {
200 found = true;
cf9b9f77 201 break;
7743f2f8
OD		 202 }
203 }
204 if (found)
205 break;
206 }
cf9b9f77 207
7743f2f8 208 if (!found)
cf9b9f77
OD		 209 return NULL;
210
b37eb79c
OD		 211 osr_debug(" |- Found nexthop Router ID %pI4", &nbr->router_id);
212
cf9b9f77
OD		 213 /* Then, search SR Node */
214 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors, &nbr->router_id);
215
216 return srn;
217}
218
6f751f14
OD		 219/*
220 * Segment Routing Local Block management functions
221 */
222
223/**
224 * It is necessary to known which label is already allocated to manage the range
225 * of SRLB. This is particular useful when an interface flap (goes up / down
226 * frequently). Here, SR will release and then allocate label for the Adjacency
227 * for each concerned interface. If we don't care, there is a risk to run out of
228 * label.
229 *
230 * For that purpose, a similar principle as already provided to manage chunk of
231 * label is proposed. But, here, the label chunk has not a fix range of 64
232 * labels that could be easily manage with a single variable of 64 bits size.
233 * So, used_mark is used as a bit wise to mark label reserved (bit set) or not
234 * (bit unset). Its size is equal to the number of label of the SRLB range round
235 * up to 64 bits.
236 *
237 * - sr__local_block_init() computes the number of 64 bits variables that are
238 * needed to manage the SRLB range and allocates this number.
239 * - ospf_sr_local_block_request_label() pick up the first available label and
240 * set corresponding bit
241 * - ospf_sr_local_block_release_label() release label by reseting the
242 * corresponding bit and set the next label to the first free position
243 */
244
245/**
246 * Initialize Segment Routing Local Block from SRDB configuration and reserve
247 * block of bits to manage label allocation.
248 *
249 * @param lower_bound The lower bound of the SRLB range
250 * @param upper_bound The upper bound of the SRLB range
251 *
252 * @return 0 on success, -1 otherwise
253 */
254static int sr_local_block_init(uint32_t lower_bound, uint32_t upper_bound)
255{
256 struct sr_local_block *srlb = &OspfSR.srlb;
257 uint32_t size;
258
259 /* Check if SRLB is not already configured */
260 if (srlb->reserved)
261 return 0;
262
263 /*
264 * Request SRLB to the label manager. If the allocation fails, return
265 * an error to disable SR until a new SRLB is successfully allocated.
266 */
267 size = upper_bound - lower_bound + 1;
268 if (ospf_zebra_request_label_range(lower_bound, size)) {
daaebd39
FR		 269 zlog_err("SR: Error reserving SRLB [%u/%u] %u labels",
270 lower_bound, upper_bound, size);
6f751f14
OD		 271 return -1;
272 }
273
daaebd39
FR		 274 osr_debug("SR: Got new SRLB [%u/%u], %u labels", lower_bound,
275 upper_bound, size);
6f751f14
OD		 276
277 /* Initialize the SRLB */
278 srlb->start = lower_bound;
279 srlb->end = upper_bound;
280 srlb->current = 0;
daaebd39 281
6f751f14
OD		 282 /* Compute the needed Used Mark number and allocate them */
283 srlb->max_block = size / SRLB_BLOCK_SIZE;
284 if ((size % SRLB_BLOCK_SIZE) != 0)
285 srlb->max_block++;
286 srlb->used_mark = XCALLOC(MTYPE_OSPF_SR_PARAMS,
287 srlb->max_block * SRLB_BLOCK_SIZE);
288 srlb->reserved = true;
289
290 return 0;
291}
292
daaebd39
FR		 293static int sr_global_block_init(uint32_t start, uint32_t size)
294{
295 struct sr_global_block *srgb = &OspfSR.srgb;
296
297 /* Check if already configured */
298 if (srgb->reserved)
299 return 0;
300
301 /* request chunk */
302 uint32_t end = start + size - 1;
303 if (ospf_zebra_request_label_range(start, size) < 0) {
304 zlog_err("SR: Error reserving SRGB [%u/%u], %u labels", start,
305 end, size);
306 return -1;
307 }
308
309 osr_debug("SR: Got new SRGB [%u/%u], %u labels", start, end, size);
310
311 /* success */
312 srgb->start = start;
313 srgb->size = size;
314 srgb->reserved = true;
315 return 0;
316}
317
6f751f14
OD		 318/**
319 * Remove Segment Routing Local Block.
320 *
321 */
9fb83ab1 322static void sr_local_block_delete(void)
6f751f14
OD		 323{
324 struct sr_local_block *srlb = &OspfSR.srlb;
325
326 /* Check if SRLB is not already delete */
327 if (!srlb->reserved)
328 return;
329
330 osr_debug("SR (%s): Remove SRLB [%u/%u]", __func__, srlb->start,
331 srlb->end);
332
333 /* First release the label block */
334 ospf_zebra_release_label_range(srlb->start, srlb->end);
335
336 /* Then reset SRLB structure */
337 if (srlb->used_mark != NULL)
338 XFREE(MTYPE_OSPF_SR_PARAMS, srlb->used_mark);
c181efbe 339
6f751f14
OD		 340 srlb->reserved = false;
341}
342
c181efbe
FR		 343/**
344 * Remove Segment Routing Global block
345 */
346static void sr_global_block_delete(void)
347{
348 struct sr_global_block *srgb = &OspfSR.srgb;
349
350 if (!srgb->reserved)
351 return;
352
353 osr_debug("SR (%s): Remove SRGB [%u/%u]", __func__, srgb->start,
354 srgb->start + srgb->size - 1);
355
356 ospf_zebra_release_label_range(srgb->start,
357 srgb->start + srgb->size - 1);
358
359 srgb->reserved = false;
360}
361
362
6f751f14
OD		 363/**
364 * Request a label from the Segment Routing Local Block.
365 *
366 * @return First available label on success or MPLS_INVALID_LABEL if the
367 * block of labels is full
368 */
369mpls_label_t ospf_sr_local_block_request_label(void)
370{
371 struct sr_local_block *srlb = &OspfSR.srlb;
372 mpls_label_t label;
373 uint32_t index;
374 uint32_t pos;
37a331f8 375 uint32_t size = srlb->end - srlb->start + 1;
6f751f14
OD		 376
377 /* Check if we ran out of available labels */
37a331f8 378 if (srlb->current >= size)
6f751f14
OD		 379 return MPLS_INVALID_LABEL;
380
381 /* Get first available label and mark it used */
382 label = srlb->current + srlb->start;
383 index = srlb->current / SRLB_BLOCK_SIZE;
384 pos = 1ULL << (srlb->current % SRLB_BLOCK_SIZE);
385 srlb->used_mark[index] |= pos;
386
387 /* Jump to the next free position */
388 srlb->current++;
389 pos = srlb->current % SRLB_BLOCK_SIZE;
37a331f8 390 while (srlb->current < size) {
6f751f14
OD		 391 if (pos == 0)
392 index++;
393 if (!((1ULL << pos) & srlb->used_mark[index]))
394 break;
395 else {
396 srlb->current++;
397 pos = srlb->current % SRLB_BLOCK_SIZE;
398 }
399 }
400
37a331f8
FR		 401 if (srlb->current == size)
402 zlog_warn(
403 "SR: Warning, SRLB is depleted and next label request will fail");
404
6f751f14
OD		 405 return label;
406}
407
408/**
409 * Release label in the Segment Routing Local Block.
410 *
411 * @param label Label to be release
412 *
413 * @return 0 on success or -1 if label falls outside SRLB
414 */
415int ospf_sr_local_block_release_label(mpls_label_t label)
416{
417 struct sr_local_block *srlb = &OspfSR.srlb;
418 uint32_t index;
419 uint32_t pos;
420
421 /* Check that label falls inside the SRLB */
422 if ((label < srlb->start) || (label > srlb->end)) {
423 flog_warn(EC_OSPF_SR_SID_OVERFLOW,
424 "%s: Returning label %u is outside SRLB [%u/%u]",
425 __func__, label, srlb->start, srlb->end);
426 return -1;
427 }
428
429 index = (label - srlb->start) / SRLB_BLOCK_SIZE;
430 pos = 1ULL << ((label - srlb->start) % SRLB_BLOCK_SIZE);
431 srlb->used_mark[index] &= ~pos;
432 /* Reset current to the first available position */
433 for (index = 0; index < srlb->max_block; index++) {
434 if (srlb->used_mark[index] != 0xFFFFFFFFFFFFFFFF) {
435 for (pos = 0; pos < SRLB_BLOCK_SIZE; pos++)
436 if (!((1ULL << pos) & srlb->used_mark[index])) {
437 srlb->current =
438 index * SRLB_BLOCK_SIZE + pos;
439 break;
440 }
441 break;
442 }
443 }
444
445 return 0;
446}
447
cf9b9f77
OD		 448/*
449 * Segment Routing Initialization functions
450 */
451
d81b8e0e
OD		 452/**
453 * Thread function to re-attempt connection to the Label Manager and thus be
454 * able to start Segment Routing.
455 *
456 * @param start Thread structure that contains area as argument
457 *
458 * @return 1 on success
459 */
cc9f21da 460static void sr_start_label_manager(struct thread *start)
d81b8e0e
OD		 461{
462 struct ospf *ospf;
463
464 ospf = THREAD_ARG(start);
465
466 /* re-attempt to start SR & Label Manager connection */
467 ospf_sr_start(ospf);
d81b8e0e
OD		 468}
469
cf9b9f77
OD		 470/* Segment Routing starter function */
471static int ospf_sr_start(struct ospf *ospf)
472{
473 struct route_node *rn;
474 struct ospf_lsa *lsa;
475 struct sr_node *srn;
476 int rc = 0;
477
b37eb79c 478 osr_debug("SR (%s): Start Segment Routing", __func__);
cf9b9f77 479
d81b8e0e
OD		 480 /* Initialize self SR Node if not already done */
481 if (OspfSR.self == NULL) {
482 srn = hash_get(OspfSR.neighbors, (void *)&(ospf->router_id),
483 (void *)sr_node_new);
484
485 /* Complete & Store self SR Node */
6f751f14
OD		 486 srn->srgb.range_size = OspfSR.srgb.size;
487 srn->srgb.lower_bound = OspfSR.srgb.start;
488 srn->srlb.lower_bound = OspfSR.srlb.start;
489 srn->srlb.range_size = OspfSR.srlb.end - OspfSR.srlb.start + 1;
d81b8e0e
OD		 490 srn->algo[0] = OspfSR.algo[0];
491 srn->msd = OspfSR.msd;
492 OspfSR.self = srn;
493 }
494
495 /* Then, start Label Manager if not ready */
496 if (!ospf_zebra_label_manager_ready())
497 if (ospf_zebra_label_manager_connect() < 0) {
498 /* Re-attempt to connect to Label Manager in 1 sec. */
499 thread_add_timer(master, sr_start_label_manager, ospf,
500 1, &OspfSR.t_start_lm);
501 osr_debug(" |- Failed to start the Label Manager");
502 return -1;
503 }
504
505 /*
6f751f14
OD		 506 * Request SRLB & SGRB to the label manager if not already reserved.
507 * If the allocation fails, return an error to disable SR until a new
508 * SRLB and/or SRGB are successfully allocated.
d81b8e0e 509 */
daaebd39
FR		 510 if (sr_local_block_init(OspfSR.srlb.start, OspfSR.srlb.end) < 0)
511 return -1;
512
513 if (sr_global_block_init(OspfSR.srgb.start, OspfSR.srgb.size) < 0)
514 return -1;
cf9b9f77 515
d81b8e0e
OD		 516 /* SR is UP and ready to flood LSA */
517 OspfSR.status = SR_UP;
518
519 /* Set Router Information SR parameters */
520 osr_debug("SR: Activate SR for Router Information LSA");
521
6f751f14 522 ospf_router_info_update_sr(true, OspfSR.self);
d81b8e0e
OD		 523
524 /* Update Ext LSA */
525 osr_debug("SR: Activate SR for Extended Link/Prefix LSA");
526
527 ospf_ext_update_sr(true);
cf9b9f77 528
b37eb79c 529 osr_debug("SR (%s): Update SR-DB from LSDB", __func__);
cf9b9f77
OD		 530
531 /* Start by looking to Router Info & Extended LSA in lsdb */
532 if ((ospf != NULL) && (ospf->backbone != NULL)) {
996c9314 533 LSDB_LOOP (OPAQUE_AREA_LSDB(ospf->backbone), rn, lsa) {
cf9b9f77
OD		 534 if (IS_LSA_MAXAGE(lsa) || IS_LSA_SELF(lsa))
535 continue;
536 int lsa_id =
537 GET_OPAQUE_TYPE(ntohl(lsa->data->id.s_addr));
538 switch (lsa_id) {
539 case OPAQUE_TYPE_ROUTER_INFORMATION_LSA:
540 ospf_sr_ri_lsa_update(lsa);
541 break;
542 case OPAQUE_TYPE_EXTENDED_PREFIX_LSA:
543 ospf_sr_ext_prefix_lsa_update(lsa);
544 break;
545 case OPAQUE_TYPE_EXTENDED_LINK_LSA:
546 ospf_sr_ext_link_lsa_update(lsa);
547 break;
548 default:
549 break;
550 }
551 }
552 }
553
554 rc = 1;
555 return rc;
556}
557
cf9b9f77
OD		 558/* Stop Segment Routing */
559static void ospf_sr_stop(void)
560{
561
a351b3e4
OD		 562 if (OspfSR.status == SR_OFF)
563 return;
564
b37eb79c 565 osr_debug("SR (%s): Stop Segment Routing", __func__);
cf9b9f77 566
d81b8e0e 567 /* Disable any re-attempt to connect to Label Manager */
50478845 568 THREAD_OFF(OspfSR.t_start_lm);
d81b8e0e 569
c181efbe
FR		 570 /* Release SRGB if active */
571 sr_global_block_delete();
572
573 /* Release SRLB if active */
6f751f14
OD		 574 sr_local_block_delete();
575
7743f2f8
OD		 576 /*
577 * Remove all SR Nodes from the Hash table. Prefix and Link SID will
6a154c88 578 * be remove though list_delete() call. See sr_node_del()
7743f2f8 579 */
cf9b9f77 580 hash_clean(OspfSR.neighbors, (void *)sr_node_del);
21baf89a 581 OspfSR.self = NULL;
d81b8e0e 582 OspfSR.status = SR_OFF;
cf9b9f77
OD		 583}
584
585/*
586 * Segment Routing initialize function
587 *
588 * @param - nothing
589 *
590 * @return 0 if OK, -1 otherwise
591 */
592int ospf_sr_init(void)
593{
594 int rc = -1;
595
b37eb79c 596 osr_debug("SR (%s): Initialize SR Data Base", __func__);
cf9b9f77 597
6006b807 598 memset(&OspfSR, 0, sizeof(OspfSR));
d81b8e0e 599 OspfSR.status = SR_OFF;
cf9b9f77
OD		 600 /* Only AREA flooding is supported in this release */
601 OspfSR.scope = OSPF_OPAQUE_AREA_LSA;
602
6f751f14 603 /* Initialize Algorithms, SRGB, SRLB and MSD TLVs */
cf9b9f77
OD		 604 /* Only Algorithm SPF is supported */
605 OspfSR.algo[0] = SR_ALGORITHM_SPF;
606 for (int i = 1; i < ALGORITHM_COUNT; i++)
607 OspfSR.algo[i] = SR_ALGORITHM_UNSET;
608
6f751f14
OD		 609 OspfSR.srgb.size = DEFAULT_SRGB_SIZE;
610 OspfSR.srgb.start = DEFAULT_SRGB_LABEL;
611 OspfSR.srgb.reserved = false;
612
613 OspfSR.srlb.start = DEFAULT_SRLB_LABEL;
5bd62f05 614 OspfSR.srlb.end = DEFAULT_SRLB_END;
6f751f14 615 OspfSR.srlb.reserved = false;
7743f2f8 616 OspfSR.msd = 0;
cf9b9f77
OD		 617
618 /* Initialize Hash table for neighbor SR nodes */
619 OspfSR.neighbors = hash_create(sr_hash, sr_cmp, "OSPF_SR");
620 if (OspfSR.neighbors == NULL)
621 return rc;
622
cf9b9f77
OD		 623 /* Register Segment Routing VTY command */
624 ospf_sr_register_vty();
625
626 rc = 0;
627 return rc;
628}
629
630/*
631 * Segment Routing termination function
632 *
633 * @param - nothing
cf9b9f77
OD		 634 * @return - nothing
635 */
636void ospf_sr_term(void)
637{
638
639 /* Stop Segment Routing */
640 ospf_sr_stop();
641
d8bc11a5 642 hash_clean_and_free(&OspfSR.neighbors, (void *)sr_node_del);
bcf4475e
OD		 643}
644
645/*
646 * Segment Routing finish function
647 *
648 * @param - nothing
649 * @return - nothing
650 */
651void ospf_sr_finish(void)
652{
653 /* Stop Segment Routing */
654 ospf_sr_stop();
cf9b9f77
OD		 655}
656
657/*
658 * Following functions are used to manipulate the
659 * Next Hop Label Forwarding entry (NHLFE)
660 */
661
662/* Compute label from index */
6f751f14 663static mpls_label_t index2label(uint32_t index, struct sr_block srgb)
cf9b9f77
OD		 664{
665 mpls_label_t label;
666
667 label = srgb.lower_bound + index;
f786c4d7
OD		 668 if (label > (srgb.lower_bound + srgb.range_size)) {
669 flog_warn(EC_OSPF_SR_SID_OVERFLOW,
670 "%s: SID index %u falls outside SRGB range",
671 __func__, index);
cf9b9f77 672 return MPLS_INVALID_LABEL;
f786c4d7 673 } else
cf9b9f77
OD		 674 return label;
675}
676
7fd0729f
G		 677/* Get the prefix sid for a specific router id */
678mpls_label_t ospf_sr_get_prefix_sid_by_id(struct in_addr *id)
679{
680 struct sr_node *srn;
681 struct sr_prefix *srp;
682 mpls_label_t label;
683
684 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors, id);
685
686 if (srn) {
687 /*
688 * TODO: Here we assume that the SRGBs are the same,
689 * and that the node's prefix SID is at the head of
690 * the list, probably needs tweaking.
691 */
692 srp = listnode_head(srn->ext_prefix);
693 label = index2label(srp->sid, srn->srgb);
694 } else {
695 label = MPLS_INVALID_LABEL;
696 }
697
698 return label;
699}
700
cc1725bd
G		 701/* Get the adjacency sid for a specific 'root' id and 'neighbor' id */
702mpls_label_t ospf_sr_get_adj_sid_by_id(struct in_addr *root_id,
703 struct in_addr *neighbor_id)
704{
705 struct sr_node *srn;
706 struct sr_link *srl;
707 mpls_label_t label;
708 struct listnode *node;
709
710 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors, root_id);
711
712 label = MPLS_INVALID_LABEL;
713
714 if (srn) {
715 for (ALL_LIST_ELEMENTS_RO(srn->ext_link, node, srl)) {
716 if (srl->type == ADJ_SID
717 && srl->remote_id.s_addr == neighbor_id->s_addr) {
718 label = srl->sid[0];
719 break;
720 }
721 }
722 }
723
724 return label;
725}
726
cf9b9f77
OD		 727/* Get neighbor full structure from address */
728static struct ospf_neighbor *get_neighbor_by_addr(struct ospf *top,
729 struct in_addr addr)
730{
731 struct ospf_neighbor *nbr;
732 struct ospf_interface *oi;
733 struct listnode *node;
734 struct route_node *rn;
735
736 /* Sanity Check */
737 if (top == NULL)
738 return NULL;
739
740 for (ALL_LIST_ELEMENTS_RO(top->oiflist, node, oi))
7743f2f8
OD		 741 for (rn = route_top(oi->nbrs); rn; rn = route_next(rn)) {
742 nbr = rn->info;
fe61ceae
DS		 743 if (!nbr)
744 continue;
745
746 if (IPV4_ADDR_SAME(&nbr->address.u.prefix4, &addr) ||
747 IPV4_ADDR_SAME(&nbr->router_id, &addr)) {
748 route_unlock_node(rn);
749 return nbr;
750 }
7743f2f8 751 }
cf9b9f77
OD		 752 return NULL;
753}
754
755/* Get OSPF Path from address */
b37eb79c
OD		 756static struct ospf_route *get_nexthop_by_addr(struct ospf *top,
757 struct prefix_ipv4 p)
cf9b9f77 758{
cf9b9f77
OD		 759 struct route_node *rn;
760
761 /* Sanity Check */
9b50aa1f 762 if (top == NULL)
cf9b9f77
OD		 763 return NULL;
764
b37eb79c
OD		 765 osr_debug(" |- Search Nexthop for prefix %pFX",
766 (struct prefix *)&p);
cf9b9f77
OD		 767
768 rn = route_node_lookup(top->new_table, (struct prefix *)&p);
769
7743f2f8
OD		 770 /*
771 * Check if we found an OSPF route. May be NULL if SPF has not
772 * yet populate routing table for this prefix.
773 */
cf9b9f77
OD		 774 if (rn == NULL)
775 return NULL;
776
777 route_unlock_node(rn);
b37eb79c 778 return rn->info;
cf9b9f77
OD		 779}
780
781/* Compute NHLFE entry for Extended Link */
782static int compute_link_nhlfe(struct sr_link *srl)
783{
784 struct ospf *top = ospf_lookup_by_vrf_id(VRF_DEFAULT);
785 struct ospf_neighbor *nh;
786 int rc = 0;
787
b37eb79c 788 osr_debug(" |- Compute NHLFE for link %pI4", &srl->itf_addr);
cf9b9f77
OD		 789
790 /* First determine the OSPF Neighbor */
791 nh = get_neighbor_by_addr(top, srl->nhlfe[0].nexthop);
792
793 /* Neighbor could be not found when OSPF Adjacency just fire up
794 * because SPF don't yet populate routing table. This NHLFE will
795 * be fixed later when SR SPF schedule will be called.
796 */
797 if (nh == NULL)
798 return rc;
799
b37eb79c 800 osr_debug(" |- Found nexthop %pI4", &nh->router_id);
cf9b9f77
OD		 801
802 /* Set ifindex for this neighbor */
803 srl->nhlfe[0].ifindex = nh->oi->ifp->ifindex;
804 srl->nhlfe[1].ifindex = nh->oi->ifp->ifindex;
805
d922605d
OD		 806 /* Update neighbor address for LAN_ADJ_SID */
807 if (srl->type == LAN_ADJ_SID) {
808 IPV4_ADDR_COPY(&srl->nhlfe[0].nexthop, &nh->src);
809 IPV4_ADDR_COPY(&srl->nhlfe[1].nexthop, &nh->src);
810 }
811
cf9b9f77
OD		 812 /* Set Input & Output Label */
813 if (CHECK_FLAG(srl->flags[0], EXT_SUBTLV_LINK_ADJ_SID_VFLG))
814 srl->nhlfe[0].label_in = srl->sid[0];
815 else
816 srl->nhlfe[0].label_in =
817 index2label(srl->sid[0], srl->srn->srgb);
818 if (CHECK_FLAG(srl->flags[1], EXT_SUBTLV_LINK_ADJ_SID_VFLG))
819 srl->nhlfe[1].label_in = srl->sid[1];
820 else
821 srl->nhlfe[1].label_in =
822 index2label(srl->sid[1], srl->srn->srgb);
823
70e98a7f
DS		 824 srl->nhlfe[0].label_out = MPLS_LABEL_IMPLICIT_NULL;
825 srl->nhlfe[1].label_out = MPLS_LABEL_IMPLICIT_NULL;
cf9b9f77
OD		 826
827 rc = 1;
828 return rc;
829}
830
f786c4d7
OD		 831/**
832 * Compute output label for the given Prefix-SID.
833 *
834 * @param srp Segment Routing Prefix
835 * @param srnext Segment Routing nexthop node
836 *
837 * @return MPLS label or MPLS_INVALID_LABEL in case of error
838 */
839static mpls_label_t sr_prefix_out_label(const struct sr_prefix *srp,
840 const struct sr_node *srnext)
841{
842 /* Check if the nexthop SR Node is the last hop? */
843 if (srnext == srp->srn) {
844 /* SR-Node doesn't request NO-PHP. Return Implicit NULL label */
845 if (!CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_NPFLG))
846 return MPLS_LABEL_IMPLICIT_NULL;
847
848 /* SR-Node requests Explicit NULL Label */
849 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_EFLG))
850 return MPLS_LABEL_IPV4_EXPLICIT_NULL;
851 /* Fallthrough */
852 }
853
854 /* Return SID value as MPLS label if it is an Absolute SID */
855 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_VFLG
856 | EXT_SUBTLV_PREFIX_SID_LFLG)) {
857 /*
858 * V/L SIDs have local significance, so only adjacent routers
859 * can use them (RFC8665 section #5)
860 */
861 if (srp->srn != srnext)
862 return MPLS_INVALID_LABEL;
863 return srp->sid;
864 }
865
866 /* Return MPLS label as SRGB lower bound + SID index as per RFC 8665 */
867 return (index2label(srp->sid, srnext->srgb));
868}
869
cf9b9f77
OD		 870/*
871 * Compute NHLFE entry for Extended Prefix
872 *
873 * @param srp - Segment Routing Prefix
874 *
b37eb79c
OD		 875 * @return -1 if no route is found, 0 if there is no SR route ready
876 * and 1 if success or update
cf9b9f77
OD		 877 */
878static int compute_prefix_nhlfe(struct sr_prefix *srp)
879{
880 struct ospf *top = ospf_lookup_by_vrf_id(VRF_DEFAULT);
b37eb79c
OD		 881 struct ospf_path *path;
882 struct listnode *node;
cf9b9f77
OD		 883 struct sr_node *srnext;
884 int rc = -1;
885
b37eb79c
OD		 886 osr_debug(" |- Compute NHLFE for prefix %pFX",
887 (struct prefix *)&srp->prefv4);
888
cf9b9f77
OD		 889
890 /* First determine the nexthop */
b61264a8 891 srp->route = get_nexthop_by_addr(top, srp->prefv4);
cf9b9f77
OD		 892
893 /* Nexthop could be not found when OSPF Adjacency just fire up
894 * because SPF don't yet populate routing table. This NHLFE will
895 * be fixed later when SR SPF schedule will be called.
896 */
b61264a8 897 if (srp->route == NULL)
cf9b9f77
OD		 898 return rc;
899
b37eb79c 900 /* Compute Input Label with self SRGB */
6f751f14 901 srp->label_in = index2label(srp->sid, OspfSR.self->srgb);
cf9b9f77 902
b37eb79c 903 rc = 0;
b61264a8 904 for (ALL_LIST_ELEMENTS_RO(srp->route->paths, node, path)) {
7743f2f8 905
b37eb79c
OD		 906 osr_debug(" |- Process new route via %pI4 for this prefix",
907 &path->nexthop);
cf9b9f77 908
b37eb79c
OD		 909 /*
910 * Get SR-Node for this nexthop. Could be not yet available
911 * as Extended Link / Prefix and Router Information are flooded
912 * after LSA Type 1 & 2 which populate the OSPF Route Table
913 */
914 srnext = get_sr_node_by_nexthop(top, path->nexthop);
915 if (srnext == NULL)
916 continue;
cf9b9f77 917
b37eb79c
OD		 918 /* And store this information for later update */
919 srnext->neighbor = OspfSR.self;
f786c4d7 920 path->srni.nexthop = srnext;
cf9b9f77 921
b37eb79c
OD		 922 /*
923 * SR Node could be known, but SRGB could be not initialize
924 * This is due to the fact that Extended Link / Prefix could
925 * be received before corresponding Router Information LSA
926 */
b61264a8 927 if (srnext == NULL || srnext->srgb.lower_bound == 0
56981b40
OD		 928 || srnext->srgb.range_size == 0) {
929 osr_debug(
930 " |- SR-Node %pI4 not ready. Stop process",
931 &srnext->adv_router);
932 path->srni.label_out = MPLS_INVALID_LABEL;
b37eb79c 933 continue;
56981b40 934 }
cf9b9f77 935
b37eb79c
OD		 936 osr_debug(" |- Found SRGB %u/%u for next hop SR-Node %pI4",
937 srnext->srgb.range_size, srnext->srgb.lower_bound,
938 &srnext->adv_router);
cf9b9f77 939
f786c4d7
OD		 940 /* Compute Output Label with Nexthop SR Node SRGB */
941 path->srni.label_out = sr_prefix_out_label(srp, srnext);
cf9b9f77 942
b37eb79c
OD		 943 osr_debug(" |- Computed new labels in: %u out: %u",
944 srp->label_in, path->srni.label_out);
945 rc = 1;
946 }
cf9b9f77
OD		 947 return rc;
948}
949
b37eb79c
OD		 950/* Add new NHLFE entry for Adjacency SID */
951static inline void add_adj_sid(struct sr_nhlfe nhlfe)
cf9b9f77 952{
b37eb79c 953 if (nhlfe.label_in != 0)
43e7abb5 954 ospf_zebra_send_adjacency_sid(ZEBRA_MPLS_LABELS_ADD, nhlfe);
cf9b9f77
OD		 955}
956
b37eb79c
OD		 957/* Remove NHLFE entry for Adjacency SID */
958static inline void del_adj_sid(struct sr_nhlfe nhlfe)
cf9b9f77 959{
b37eb79c 960 if (nhlfe.label_in != 0)
43e7abb5 961 ospf_zebra_send_adjacency_sid(ZEBRA_MPLS_LABELS_DELETE, nhlfe);
cf9b9f77
OD		 962}
963
b37eb79c
OD		 964/* Update NHLFE entry for Adjacency SID */
965static inline void update_adj_sid(struct sr_nhlfe n1, struct sr_nhlfe n2)
cf9b9f77 966{
b37eb79c
OD		 967 del_adj_sid(n1);
968 add_adj_sid(n2);
969}
970
cf9b9f77
OD		 971/*
972 * Functions to parse and get Extended Link / Prefix
973 * TLVs and SubTLVs
974 */
975
976/* Extended Link SubTLVs Getter */
8db278b5 977static struct sr_link *get_ext_link_sid(struct tlv_header *tlvh, size_t size)
cf9b9f77
OD		 978{
979
980 struct sr_link *srl;
981 struct ext_tlv_link *link = (struct ext_tlv_link *)tlvh;
982 struct ext_subtlv_adj_sid *adj_sid;
983 struct ext_subtlv_lan_adj_sid *lan_sid;
984 struct ext_subtlv_rmt_itf_addr *rmt_itf;
985
986 struct tlv_header *sub_tlvh;
93f0a26e 987 uint16_t length = 0, sum = 0, i = 0;
cf9b9f77 988
8db278b5
OD		 989 /* Check TLV size */
990 if ((ntohs(tlvh->length) > size)
991 || ntohs(tlvh->length) < EXT_TLV_LINK_SIZE) {
992 zlog_warn("Wrong Extended Link TLV size. Abort!");
993 return NULL;
994 }
995
cf9b9f77
OD		 996 srl = XCALLOC(MTYPE_OSPF_SR_PARAMS, sizeof(struct sr_link));
997
cf9b9f77
OD		 998 /* Initialize TLV browsing */
999 length = ntohs(tlvh->length) - EXT_TLV_LINK_SIZE;
1000 sub_tlvh = (struct tlv_header *)((char *)(tlvh) + TLV_HDR_SIZE
1001 + EXT_TLV_LINK_SIZE);
8db278b5 1002 for (; sum < length && sub_tlvh; sub_tlvh = TLV_HDR_NEXT(sub_tlvh)) {
cf9b9f77
OD		 1003 switch (ntohs(sub_tlvh->type)) {
1004 case EXT_SUBTLV_ADJ_SID:
1005 adj_sid = (struct ext_subtlv_adj_sid *)sub_tlvh;
1006 srl->type = ADJ_SID;
1007 i = CHECK_FLAG(adj_sid->flags,
1008 EXT_SUBTLV_LINK_ADJ_SID_BFLG)
1009 ? 1
1010 : 0;
1011 srl->flags[i] = adj_sid->flags;
1012 if (CHECK_FLAG(adj_sid->flags,
1013 EXT_SUBTLV_LINK_ADJ_SID_VFLG))
1014 srl->sid[i] = GET_LABEL(ntohl(adj_sid->value));
1015 else
1016 srl->sid[i] = ntohl(adj_sid->value);
1017 IPV4_ADDR_COPY(&srl->nhlfe[i].nexthop, &link->link_id);
1018 break;
1019 case EXT_SUBTLV_LAN_ADJ_SID:
1020 lan_sid = (struct ext_subtlv_lan_adj_sid *)sub_tlvh;
1021 srl->type = LAN_ADJ_SID;
1022 i = CHECK_FLAG(lan_sid->flags,
1023 EXT_SUBTLV_LINK_ADJ_SID_BFLG)
1024 ? 1
1025 : 0;
1026 srl->flags[i] = lan_sid->flags;
1027 if (CHECK_FLAG(lan_sid->flags,
1028 EXT_SUBTLV_LINK_ADJ_SID_VFLG))
1029 srl->sid[i] = GET_LABEL(ntohl(lan_sid->value));
1030 else
1031 srl->sid[i] = ntohl(lan_sid->value);
1032 IPV4_ADDR_COPY(&srl->nhlfe[i].nexthop,
1033 &lan_sid->neighbor_id);
1034 break;
1035 case EXT_SUBTLV_RMT_ITF_ADDR:
1036 rmt_itf = (struct ext_subtlv_rmt_itf_addr *)sub_tlvh;
1037 IPV4_ADDR_COPY(&srl->nhlfe[0].nexthop, &rmt_itf->value);
1038 IPV4_ADDR_COPY(&srl->nhlfe[1].nexthop, &rmt_itf->value);
1039 break;
1040 default:
1041 break;
1042 }
1043 sum += TLV_SIZE(sub_tlvh);
1044 }
1045
b37eb79c 1046 IPV4_ADDR_COPY(&srl->itf_addr, &link->link_data);
cf9b9f77 1047
b37eb79c
OD		 1048 osr_debug(" |- Found primary %u and backup %u Adj/Lan Sid for %pI4",
1049 srl->sid[0], srl->sid[1], &srl->itf_addr);
cf9b9f77
OD		 1050
1051 return srl;
1052}
1053
1054/* Extended Prefix SubTLVs Getter */
8db278b5
OD		 1055static struct sr_prefix *get_ext_prefix_sid(struct tlv_header *tlvh,
1056 size_t size)
cf9b9f77
OD		 1057{
1058
1059 struct sr_prefix *srp;
1060 struct ext_tlv_prefix *pref = (struct ext_tlv_prefix *)tlvh;
1061 struct ext_subtlv_prefix_sid *psid;
1062
1063 struct tlv_header *sub_tlvh;
93f0a26e 1064 uint16_t length = 0, sum = 0;
cf9b9f77 1065
8db278b5
OD		 1066 /* Check TLV size */
1067 if ((ntohs(tlvh->length) > size)
1068 || ntohs(tlvh->length) < EXT_TLV_PREFIX_SIZE) {
1069 zlog_warn("Wrong Extended Link TLV size. Abort!");
1070 return NULL;
1071 }
1072
cf9b9f77
OD		 1073 srp = XCALLOC(MTYPE_OSPF_SR_PARAMS, sizeof(struct sr_prefix));
1074
cf9b9f77
OD		 1075 /* Initialize TLV browsing */
1076 length = ntohs(tlvh->length) - EXT_TLV_PREFIX_SIZE;
1077 sub_tlvh = (struct tlv_header *)((char *)(tlvh) + TLV_HDR_SIZE
1078 + EXT_TLV_PREFIX_SIZE);
8db278b5 1079 for (; sum < length && sub_tlvh; sub_tlvh = TLV_HDR_NEXT(sub_tlvh)) {
cf9b9f77
OD		 1080 switch (ntohs(sub_tlvh->type)) {
1081 case EXT_SUBTLV_PREFIX_SID:
1082 psid = (struct ext_subtlv_prefix_sid *)sub_tlvh;
1083 if (psid->algorithm != SR_ALGORITHM_SPF) {
cf444bcf 1084 flog_err(EC_OSPF_INVALID_ALGORITHM,
ade6974d
QY		 1085 "SR (%s): Unsupported Algorithm",
1086 __func__);
cf9b9f77
OD		 1087 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
1088 return NULL;
1089 }
1090 srp->type = PREF_SID;
1091 srp->flags = psid->flags;
1092 if (CHECK_FLAG(psid->flags, EXT_SUBTLV_PREFIX_SID_VFLG))
1093 srp->sid = GET_LABEL(ntohl(psid->value));
1094 else
1095 srp->sid = ntohl(psid->value);
b61264a8 1096 IPV4_ADDR_COPY(&srp->prefv4.prefix, &pref->address);
b37eb79c
OD		 1097 srp->prefv4.prefixlen = pref->pref_length;
1098 srp->prefv4.family = AF_INET;
1099 apply_mask_ipv4(&srp->prefv4);
cf9b9f77
OD		 1100 break;
1101 default:
1102 break;
1103 }
1104 sum += TLV_SIZE(sub_tlvh);
1105 }
1106
b37eb79c
OD		 1107 osr_debug(" |- Found SID %u for prefix %pFX", srp->sid,
1108 (struct prefix *)&srp->prefv4);
1109
cf9b9f77
OD		 1110 return srp;
1111}
1112
1113/*
1114 * Functions to manipulate Segment Routing Link & Prefix structures
1115 */
1116
1117/* Compare two Segment Link: return 0 if equal, 1 otherwise */
1118static inline int sr_link_cmp(struct sr_link *srl1, struct sr_link *srl2)
1119{
1120 if ((srl1->sid[0] == srl2->sid[0]) && (srl1->sid[1] == srl2->sid[1])
1121 && (srl1->type == srl2->type) && (srl1->flags[0] == srl2->flags[0])
1122 && (srl1->flags[1] == srl2->flags[1]))
1123 return 0;
1124 else
1125 return 1;
1126}
1127
1128/* Compare two Segment Prefix: return 0 if equal, 1 otherwise */
1129static inline int sr_prefix_cmp(struct sr_prefix *srp1, struct sr_prefix *srp2)
1130{
1131 if ((srp1->sid == srp2->sid) && (srp1->flags == srp2->flags))
1132 return 0;
1133 else
1134 return 1;
1135}
1136
1137/* Update Segment Link of given Segment Routing Node */
1138static void update_ext_link_sid(struct sr_node *srn, struct sr_link *srl,
d7c0a89a 1139 uint8_t lsa_flags)
cf9b9f77
OD		 1140{
1141 struct listnode *node;
1142 struct sr_link *lk;
1143 bool found = false;
edb368e9 1144 bool config = true;
cf9b9f77
OD		 1145
1146 /* Sanity check */
1147 if ((srn == NULL) || (srl == NULL))
1148 return;
1149
b37eb79c 1150 osr_debug(" |- Process Extended Link Adj/Lan-SID");
cf9b9f77 1151
edb368e9 1152 /* Detect if Adj/Lan_Adj SID must be configured */
b61264a8
OD		 1153 if (!CHECK_FLAG(lsa_flags, OSPF_LSA_SELF)
1154 && (CHECK_FLAG(srl->flags[0], EXT_SUBTLV_LINK_ADJ_SID_LFLG)
1155 || CHECK_FLAG(srl->flags[1], EXT_SUBTLV_LINK_ADJ_SID_LFLG)))
edb368e9 1156 config = false;
cf9b9f77
OD		 1157
1158 /* Search for existing Segment Link */
1159 for (ALL_LIST_ELEMENTS_RO(srn->ext_link, node, lk))
1160 if (lk->instance == srl->instance) {
1161 found = true;
1162 break;
1163 }
1164
b37eb79c
OD		 1165 osr_debug(" |- %s SR Link 8.0.0.%u for SR node %pI4",
1166 found ? "Update" : "Add", GET_OPAQUE_ID(srl->instance),
1167 &srn->adv_router);
cf9b9f77
OD		 1168
1169 /* if not found, add new Segment Link and install NHLFE */
1170 if (!found) {
1171 /* Complete SR-Link and add it to SR-Node list */
1172 srl->srn = srn;
1173 IPV4_ADDR_COPY(&srl->adv_router, &srn->adv_router);
1174 listnode_add(srn->ext_link, srl);
1175 /* Try to set MPLS table */
edb368e9 1176 if (config && compute_link_nhlfe(srl)) {
b37eb79c
OD		 1177 add_adj_sid(srl->nhlfe[0]);
1178 add_adj_sid(srl->nhlfe[1]);
cf9b9f77
OD		 1179 }
1180 } else {
edb368e9 1181 /* Update SR-Link if they are different */
cf9b9f77 1182 if (sr_link_cmp(lk, srl)) {
edb368e9
OD		 1183 /* Try to set MPLS table */
1184 if (config) {
1185 if (compute_link_nhlfe(srl)) {
1186 update_adj_sid(lk->nhlfe[0],
1187 srl->nhlfe[0]);
1188 update_adj_sid(lk->nhlfe[1],
1189 srl->nhlfe[1]);
1190 } else {
1191 del_adj_sid(lk->nhlfe[0]);
1192 del_adj_sid(lk->nhlfe[1]);
1193 }
cf9b9f77 1194 }
edb368e9
OD		 1195 /* Replace SR-Link in SR-Node Adjacency List */
1196 listnode_delete(srn->ext_link, lk);
1197 XFREE(MTYPE_OSPF_SR_PARAMS, lk);
1198 srl->srn = srn;
1199 IPV4_ADDR_COPY(&srl->adv_router, &srn->adv_router);
1200 listnode_add(srn->ext_link, srl);
cf9b9f77 1201 } else {
7743f2f8
OD		 1202 /*
1203 * This is just an LSA refresh.
1204 * Stop processing and free SR Link
1205 */
cf9b9f77
OD		 1206 XFREE(MTYPE_OSPF_SR_PARAMS, srl);
1207 }
1208 }
1209}
1210
1211/* Update Segment Prefix of given Segment Routing Node */
1212static void update_ext_prefix_sid(struct sr_node *srn, struct sr_prefix *srp)
1213{
1214
1215 struct listnode *node;
1216 struct sr_prefix *pref;
1217 bool found = false;
1218
1219 /* Sanity check */
1220 if (srn == NULL || srp == NULL)
1221 return;
1222
b37eb79c 1223 osr_debug(" |- Process Extended Prefix SID %u", srp->sid);
cf9b9f77
OD		 1224
1225 /* Process only Global Prefix SID */
1226 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_LFLG))
1227 return;
1228
1229 /* Search for existing Segment Prefix */
1230 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, pref))
d97e415d
FR		 1231 if (pref->instance == srp->instance
1232 && prefix_same((struct prefix *)&srp->prefv4,
1233 &pref->prefv4)) {
cf9b9f77
OD		 1234 found = true;
1235 break;
1236 }
1237
b37eb79c
OD		 1238 osr_debug(" |- %s SR LSA ID 7.0.0.%u for SR node %pI4",
1239 found ? "Update" : "Add", GET_OPAQUE_ID(srp->instance),
1240 &srn->adv_router);
cf9b9f77 1241
270e66a2
OD		 1242 /* Complete SR-Prefix */
1243 srp->srn = srn;
1244 IPV4_ADDR_COPY(&srp->adv_router, &srn->adv_router);
1245
cf9b9f77
OD		 1246 /* if not found, add new Segment Prefix and install NHLFE */
1247 if (!found) {
270e66a2 1248 /* Add it to SR-Node list ... */
cf9b9f77 1249 listnode_add(srn->ext_prefix, srp);
270e66a2 1250 /* ... and try to set MPLS table */
7743f2f8 1251 if (compute_prefix_nhlfe(srp) == 1)
43e7abb5 1252 ospf_zebra_update_prefix_sid(srp);
cf9b9f77 1253 } else {
270e66a2
OD		 1254 /*
1255 * An old SR prefix exist. Check if something changes or if it
1256 * is just a refresh.
1257 */
cf9b9f77
OD		 1258 if (sr_prefix_cmp(pref, srp)) {
1259 if (compute_prefix_nhlfe(srp) == 1) {
43e7abb5 1260 ospf_zebra_delete_prefix_sid(pref);
cf9b9f77
OD		 1261 /* Replace Segment Prefix */
1262 listnode_delete(srn->ext_prefix, pref);
1263 XFREE(MTYPE_OSPF_SR_PARAMS, pref);
cf9b9f77 1264 listnode_add(srn->ext_prefix, srp);
43e7abb5 1265 ospf_zebra_update_prefix_sid(srp);
cf9b9f77
OD		 1266 } else {
1267 /* New NHLFE was not found.
7743f2f8
OD		 1268 * Just free the SR Prefix
1269 */
cf9b9f77
OD		 1270 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
1271 }
1272 } else {
1273 /* This is just an LSA refresh.
7743f2f8
OD		 1274 * Stop processing and free SR Prefix
1275 */
cf9b9f77
OD		 1276 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
1277 }
1278 }
1279}
1280
1281/*
1282 * When change the FRR Self SRGB, update the NHLFE Input Label
1283 * for all Extended Prefix with SID index through hash_iterate()
1284 */
e3b78da8 1285static void update_in_nhlfe(struct hash_bucket *bucket, void *args)
cf9b9f77
OD		 1286{
1287 struct listnode *node;
e3b78da8 1288 struct sr_node *srn = (struct sr_node *)bucket->data;
cf9b9f77 1289 struct sr_prefix *srp;
cf9b9f77 1290
cf9b9f77
OD		 1291 /* Process Every Extended Prefix for this SR-Node */
1292 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, srp)) {
7743f2f8
OD		 1293 /* Process Self SRN only if NO-PHP is requested */
1294 if ((srn == OspfSR.self)
1295 && !CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_NPFLG))
1296 continue;
1297
cf9b9f77
OD		 1298 /* Process only SID Index */
1299 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_VFLG))
1300 continue;
7743f2f8 1301
6f751f14
OD		 1302 /* First, remove old MPLS table entries ... */
1303 ospf_zebra_delete_prefix_sid(srp);
1304 /* ... then compute new input label ... */
1305 srp->label_in = index2label(srp->sid, OspfSR.self->srgb);
1306 /* ... and install new MPLS LFIB */
43e7abb5 1307 ospf_zebra_update_prefix_sid(srp);
cf9b9f77
OD		 1308 }
1309}
1310
1311/*
1312 * When SRGB has changed, update NHLFE Output Label for all Extended Prefix
56981b40 1313 * with SID index which use the given SR-Node as nexthop through hash_iterate()
cf9b9f77 1314 */
e3b78da8 1315static void update_out_nhlfe(struct hash_bucket *bucket, void *args)
cf9b9f77 1316{
b37eb79c 1317 struct listnode *node, *pnode;
e3b78da8 1318 struct sr_node *srn = (struct sr_node *)bucket->data;
cf9b9f77
OD		 1319 struct sr_node *srnext = (struct sr_node *)args;
1320 struct sr_prefix *srp;
b37eb79c 1321 struct ospf_path *path;
cf9b9f77 1322
56981b40
OD		 1323 /* Skip Self SR-Node */
1324 if (srn == OspfSR.self)
1325 return;
1326
1327 osr_debug("SR (%s): Update Out NHLFE for neighbor SR-Node %pI4",
1328 __func__, &srn->adv_router);
1329
cf9b9f77 1330 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, srp)) {
56981b40 1331 /* Skip Prefix that has not yet a valid route */
b61264a8 1332 if (srp->route == NULL)
cf9b9f77 1333 continue;
b37eb79c 1334
b61264a8 1335 for (ALL_LIST_ELEMENTS_RO(srp->route->paths, pnode, path)) {
56981b40
OD		 1336 /* Skip path that has not next SR-Node as nexthop */
1337 if (path->srni.nexthop != srnext)
b37eb79c 1338 continue;
56981b40
OD		 1339
1340 /* Compute new Output Label */
1341 path->srni.label_out = sr_prefix_out_label(srp, srnext);
b37eb79c 1342 }
56981b40
OD		 1343
1344 /* Finally update MPLS table */
1345 ospf_zebra_update_prefix_sid(srp);
cf9b9f77
OD		 1346 }
1347}
1348
1349/*
1350 * Following functions are call when new Segment Routing LSA are received
1351 * - Router Information: ospf_sr_ri_lsa_update() & ospf_sr_ri_lsa_delete()
1352 * - Extended Link: ospf_sr_ext_link_update() & ospf_sr_ext_link_delete()
1353 * - Extended Prefix: ospf_ext_prefix_update() & ospf_sr_ext_prefix_delete()
1354 */
1355
1356/* Update Segment Routing from Router Information LSA */
1357void ospf_sr_ri_lsa_update(struct ospf_lsa *lsa)
1358{
1359 struct sr_node *srn;
1360 struct tlv_header *tlvh;
c4efd0f4 1361 struct lsa_header *lsah = lsa->data;
b61264a8 1362 struct ri_sr_tlv_sid_label_range *ri_srgb = NULL;
6f751f14 1363 struct ri_sr_tlv_sid_label_range *ri_srlb = NULL;
b61264a8 1364 struct ri_sr_tlv_sr_algorithm *algo = NULL;
6f751f14 1365 struct sr_block srgb;
93f0a26e 1366 uint16_t length = 0, sum = 0;
b61264a8 1367 uint8_t msd = 0;
cf9b9f77 1368
b37eb79c
OD		 1369 osr_debug("SR (%s): Process Router Information LSA 4.0.0.%u from %pI4",
1370 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1371 &lsah->adv_router);
cf9b9f77
OD		 1372
1373 /* Sanity check */
1374 if (IS_LSA_SELF(lsa))
1375 return;
1376
1377 if (OspfSR.neighbors == NULL) {
cf444bcf 1378 flog_err(EC_OSPF_SR_INVALID_DB,
dbb93f1b 1379 "SR (%s): Abort! no valid SR DataBase", __func__);
cf9b9f77
OD		 1380 return;
1381 }
1382
b61264a8
OD		 1383 /* Search SR Node in hash table from Router ID */
1384 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors,
1385 &lsah->adv_router);
cf9b9f77 1386
cf9b9f77
OD		 1387
1388 /* Collect Router Information Sub TLVs */
1389 /* Initialize TLV browsing */
8db278b5 1390 length = lsa->size - OSPF_LSA_HEADER_SIZE;
cf9b9f77
OD		 1391 srgb.range_size = 0;
1392 srgb.lower_bound = 0;
1393
6aaf0fdd 1394 for (tlvh = TLV_HDR_TOP(lsah); (sum < length) && (tlvh != NULL);
cf9b9f77
OD		 1395 tlvh = TLV_HDR_NEXT(tlvh)) {
1396 switch (ntohs(tlvh->type)) {
1397 case RI_SR_TLV_SR_ALGORITHM:
1398 algo = (struct ri_sr_tlv_sr_algorithm *)tlvh;
cf9b9f77 1399 break;
6f751f14 1400 case RI_SR_TLV_SRGB_LABEL_RANGE:
cf9b9f77 1401 ri_srgb = (struct ri_sr_tlv_sid_label_range *)tlvh;
cf9b9f77 1402 break;
6f751f14
OD		 1403 case RI_SR_TLV_SRLB_LABEL_RANGE:
1404 ri_srlb = (struct ri_sr_tlv_sid_label_range *)tlvh;
6f751f14 1405 break;
cf9b9f77 1406 case RI_SR_TLV_NODE_MSD:
b61264a8 1407 msd = ((struct ri_sr_tlv_node_msd *)(tlvh))->value;
cf9b9f77
OD		 1408 break;
1409 default:
cf9b9f77
OD		 1410 break;
1411 }
8db278b5 1412 sum += TLV_SIZE(tlvh);
cf9b9f77
OD		 1413 }
1414
b61264a8
OD		 1415 /* Check if Segment Routing Capabilities has been found */
1416 if (ri_srgb == NULL) {
1417 /* Skip Router Information without SR capabilities
1418 * advertise by a non SR Node */
1419 if (srn == NULL) {
1420 return;
1421 } else {
1422 /* Remove SR Node that advertise Router Information
1423 * without SR capabilities. This could correspond to a
1424 * Node stopping Segment Routing */
1425 hash_release(OspfSR.neighbors, &(srn->adv_router));
1426 sr_node_del(srn);
1427 return;
1428 }
1429 }
1430
1431 /* Check that RI LSA belongs to the correct SR Node */
1432 if ((srn != NULL) && (srn->instance != 0)
1433 && (srn->instance != ntohl(lsah->id.s_addr))) {
1434 flog_err(EC_OSPF_SR_INVALID_LSA_ID,
3efd0893 1435 "SR (%s): Abort! Wrong LSA ID 4.0.0.%u for SR node %pI4/%u",
b61264a8
OD		 1436 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1437 &lsah->adv_router, srn->instance);
cf9b9f77
OD		 1438 return;
1439 }
1440
b61264a8
OD		 1441 /* OK. All things look good. Get SRGB */
1442 srgb.range_size = GET_RANGE_SIZE(ntohl(ri_srgb->size));
1443 srgb.lower_bound = GET_LABEL(ntohl(ri_srgb->lower.value));
1444
cf9b9f77 1445 /* Check if it is a new SR Node or not */
b61264a8
OD		 1446 if (srn == NULL) {
1447 /* Get a new SR Node in hash table from Router ID */
1448 srn = (struct sr_node *)hash_get(OspfSR.neighbors,
1449 &lsah->adv_router,
1450 (void *)sr_node_new);
cf9b9f77
OD		 1451 /* update LSA ID */
1452 srn->instance = ntohl(lsah->id.s_addr);
6f751f14
OD		 1453 /* Copy SRGB */
1454 srn->srgb.range_size = srgb.range_size;
1455 srn->srgb.lower_bound = srgb.lower_bound;
cf9b9f77
OD		 1456 }
1457
6f751f14 1458 /* Update Algorithm, SRLB and MSD if present */
29df0fc7
G		 1459 if (algo != NULL) {
1460 int i;
1461 for (i = 0; i < ntohs(algo->header.length); i++)
1462 srn->algo[i] = algo->value[0];
1463 for (; i < ALGORITHM_COUNT; i++)
1464 srn->algo[i] = SR_ALGORITHM_UNSET;
1465 } else {
1466 srn->algo[0] = SR_ALGORITHM_SPF;
1467 }
29df0fc7 1468 srn->msd = msd;
6f751f14
OD		 1469 if (ri_srlb != NULL) {
1470 srn->srlb.range_size = GET_RANGE_SIZE(ntohl(ri_srlb->size));
1471 srn->srlb.lower_bound = GET_LABEL(ntohl(ri_srlb->lower.value));
1472 }
1473
6f751f14
OD		 1474 /* Check if SRGB has changed */
1475 if ((srn->srgb.range_size == srgb.range_size)
1476 && (srn->srgb.lower_bound == srgb.lower_bound))
1477 return;
29df0fc7
G		 1478
1479 /* Copy SRGB */
b61264a8
OD		 1480 srn->srgb.range_size = srgb.range_size;
1481 srn->srgb.lower_bound = srgb.lower_bound;
29df0fc7 1482
56981b40
OD		 1483 osr_debug(" |- Update SR-Node[%pI4], SRGB[%u/%u], SRLB[%u/%u], Algo[%u], MSD[%u]",
1484 &srn->adv_router, srn->srgb.lower_bound, srn->srgb.range_size,
1485 srn->srlb.lower_bound, srn->srlb.range_size, srn->algo[0],
1486 srn->msd);
1487
b61264a8
OD		 1488 /* ... and NHLFE if it is a neighbor SR node */
1489 if (srn->neighbor == OspfSR.self)
1490 hash_iterate(OspfSR.neighbors, update_out_nhlfe, srn);
cf9b9f77
OD		 1491}
1492
1493/*
1494 * Delete SR Node entry in hash table information corresponding to an expired
1495 * Router Information LSA
1496 */
1497void ospf_sr_ri_lsa_delete(struct ospf_lsa *lsa)
1498{
1499 struct sr_node *srn;
c4efd0f4 1500 struct lsa_header *lsah = lsa->data;
cf9b9f77 1501
b61264a8
OD		 1502 osr_debug("SR (%s): Remove SR node %pI4 from lsa_id 4.0.0.%u", __func__,
1503 &lsah->adv_router, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)));
cf9b9f77
OD		 1504
1505 /* Sanity check */
1506 if (OspfSR.neighbors == NULL) {
cf444bcf 1507 flog_err(EC_OSPF_SR_INVALID_DB,
dbb93f1b 1508 "SR (%s): Abort! no valid SR Data Base", __func__);
cf9b9f77
OD		 1509 return;
1510 }
1511
1512 /* Release Router ID entry in SRDB hash table */
1513 srn = hash_release(OspfSR.neighbors, &(lsah->adv_router));
1514
1515 /* Sanity check */
1516 if (srn == NULL) {
cf444bcf 1517 flog_err(EC_OSPF_SR_NODE_CREATE,
b61264a8
OD		 1518 "SR (%s): Abort! no entry in SRDB for SR Node %pI4",
1519 __func__, &lsah->adv_router);
cf9b9f77
OD		 1520 return;
1521 }
1522
1523 if ((srn->instance != 0) && (srn->instance != ntohl(lsah->id.s_addr))) {
b61264a8
OD		 1524 flog_err(
1525 EC_OSPF_SR_INVALID_LSA_ID,
1526 "SR (%s): Abort! Wrong LSA ID 4.0.0.%u for SR node %pI4",
1527 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1528 &lsah->adv_router);
cf9b9f77
OD		 1529 return;
1530 }
1531
1532 /* Remove SR node */
1533 sr_node_del(srn);
cf9b9f77
OD		 1534}
1535
1536/* Update Segment Routing from Extended Link LSA */
1537void ospf_sr_ext_link_lsa_update(struct ospf_lsa *lsa)
1538{
1539 struct sr_node *srn;
1540 struct tlv_header *tlvh;
c4efd0f4 1541 struct lsa_header *lsah = lsa->data;
cf9b9f77
OD		 1542 struct sr_link *srl;
1543
8db278b5 1544 int length;
cf9b9f77 1545
b37eb79c
OD		 1546 osr_debug("SR (%s): Process Extended Link LSA 8.0.0.%u from %pI4",
1547 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1548 &lsah->adv_router);
cf9b9f77
OD		 1549
1550 /* Sanity check */
1551 if (OspfSR.neighbors == NULL) {
cf444bcf 1552 flog_err(EC_OSPF_SR_INVALID_DB,
dbb93f1b 1553 "SR (%s): Abort! no valid SR DataBase", __func__);
cf9b9f77
OD		 1554 return;
1555 }
1556
1557 /* Get SR Node in hash table from Router ID */
1558 srn = (struct sr_node *)hash_get(OspfSR.neighbors,
1559 (void *)&(lsah->adv_router),
1560 (void *)sr_node_new);
1561
cf9b9f77 1562 /* Initialize TLV browsing */
8db278b5
OD		 1563 length = lsa->size - OSPF_LSA_HEADER_SIZE;
1564 for (tlvh = TLV_HDR_TOP(lsah); length > 0 && tlvh;
cf9b9f77
OD		 1565 tlvh = TLV_HDR_NEXT(tlvh)) {
1566 if (ntohs(tlvh->type) == EXT_TLV_LINK) {
1567 /* Got Extended Link information */
8db278b5 1568 srl = get_ext_link_sid(tlvh, length);
cf9b9f77
OD		 1569 /* Update SID if not null */
1570 if (srl != NULL) {
1571 srl->instance = ntohl(lsah->id.s_addr);
1572 update_ext_link_sid(srn, srl, lsa->flags);
1573 }
1574 }
8db278b5 1575 length -= TLV_SIZE(tlvh);
cf9b9f77
OD		 1576 }
1577}
1578
1579/* Delete Segment Routing from Extended Link LSA */
1580void ospf_sr_ext_link_lsa_delete(struct ospf_lsa *lsa)
1581{
1582 struct listnode *node;
1583 struct sr_link *srl;
1584 struct sr_node *srn;
b61264a8 1585 struct lsa_header *lsah = lsa->data;
93f0a26e 1586 uint32_t instance = ntohl(lsah->id.s_addr);
cf9b9f77 1587
b37eb79c
OD		 1588 osr_debug("SR (%s): Remove Extended Link LSA 8.0.0.%u from %pI4",
1589 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1590 &lsah->adv_router);
cf9b9f77
OD		 1591
1592 /* Sanity check */
1593 if (OspfSR.neighbors == NULL) {
cf444bcf 1594 flog_err(EC_OSPF_SR_INVALID_DB,
dbb93f1b 1595 "SR (%s): Abort! no valid SR DataBase", __func__);
cf9b9f77
OD		 1596 return;
1597 }
1598
1599 /* Search SR Node in hash table from Router ID */
1600 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors,
1601 (void *)&(lsah->adv_router));
1602
7743f2f8
OD		 1603 /*
1604 * SR-Node may be NULL if it has been remove previously when
1605 * processing Router Information LSA deletion
1606 */
cf9b9f77 1607 if (srn == NULL) {
cf444bcf 1608 flog_err(EC_OSPF_SR_INVALID_DB,
b61264a8
OD		 1609 "SR (%s): Stop! no entry in SRDB for SR Node %pI4",
1610 __func__, &lsah->adv_router);
cf9b9f77
OD		 1611 return;
1612 }
1613
1614 /* Search for corresponding Segment Link */
1615 for (ALL_LIST_ELEMENTS_RO(srn->ext_link, node, srl))
1616 if (srl->instance == instance)
1617 break;
1618
b61264a8
OD		 1619 /* Remove Segment Link if found. Note that for Neighbors, only Global
1620 * Adj/Lan-Adj SID are stored in the SR-DB */
fd3b19f2 1621 if ((srl != NULL) && (srl->instance == instance)) {
b37eb79c
OD		 1622 del_adj_sid(srl->nhlfe[0]);
1623 del_adj_sid(srl->nhlfe[1]);
cf9b9f77
OD		 1624 listnode_delete(srn->ext_link, srl);
1625 XFREE(MTYPE_OSPF_SR_PARAMS, srl);
cf9b9f77 1626 }
cf9b9f77
OD		 1627}
1628
21baf89a
OD		 1629/* Add (LAN)Adjacency-SID from Extended Link Information */
1630void ospf_sr_ext_itf_add(struct ext_itf *exti)
1631{
1632 struct sr_node *srn = OspfSR.self;
1633 struct sr_link *srl;
1634
1635 osr_debug("SR (%s): Add Extended Link LSA 8.0.0.%u from self", __func__,
1636 exti->instance);
1637
1638 /* Sanity check */
1639 if (srn == NULL)
1640 return;
1641
1642 /* Initialize new Segment Routing Link */
1643 srl = XCALLOC(MTYPE_OSPF_SR_PARAMS, sizeof(struct sr_link));
1644 srl->srn = srn;
1645 srl->adv_router = srn->adv_router;
1646 srl->itf_addr = exti->link.link_data;
1647 srl->instance =
1648 SET_OPAQUE_LSID(OPAQUE_TYPE_EXTENDED_LINK_LSA, exti->instance);
cc1725bd 1649 srl->remote_id = exti->link.link_id;
21baf89a
OD		 1650 switch (exti->stype) {
1651 case ADJ_SID:
1652 srl->type = ADJ_SID;
1653 /* Primary information */
1654 srl->flags[0] = exti->adj_sid[0].flags;
1655 if (CHECK_FLAG(exti->adj_sid[0].flags,
1656 EXT_SUBTLV_LINK_ADJ_SID_VFLG))
1657 srl->sid[0] = GET_LABEL(ntohl(exti->adj_sid[0].value));
1658 else
1659 srl->sid[0] = ntohl(exti->adj_sid[0].value);
1660 if (exti->rmt_itf_addr.header.type == 0)
1661 srl->nhlfe[0].nexthop = exti->link.link_id;
1662 else
1663 srl->nhlfe[0].nexthop = exti->rmt_itf_addr.value;
1664 /* Backup Information if set */
1665 if (exti->adj_sid[1].header.type == 0)
1666 break;
1667 srl->flags[1] = exti->adj_sid[1].flags;
1668 if (CHECK_FLAG(exti->adj_sid[1].flags,
1669 EXT_SUBTLV_LINK_ADJ_SID_VFLG))
1670 srl->sid[1] = GET_LABEL(ntohl(exti->adj_sid[1].value));
1671 else
1672 srl->sid[1] = ntohl(exti->adj_sid[1].value);
1673 if (exti->rmt_itf_addr.header.type == 0)
1674 srl->nhlfe[1].nexthop = exti->link.link_id;
1675 else
1676 srl->nhlfe[1].nexthop = exti->rmt_itf_addr.value;
1677 break;
1678 case LAN_ADJ_SID:
1679 srl->type = LAN_ADJ_SID;
1680 /* Primary information */
1681 srl->flags[0] = exti->lan_sid[0].flags;
1682 if (CHECK_FLAG(exti->lan_sid[0].flags,
1683 EXT_SUBTLV_LINK_ADJ_SID_VFLG))
1684 srl->sid[0] = GET_LABEL(ntohl(exti->lan_sid[0].value));
1685 else
1686 srl->sid[0] = ntohl(exti->lan_sid[0].value);
1687 if (exti->rmt_itf_addr.header.type == 0)
1688 srl->nhlfe[0].nexthop = exti->lan_sid[0].neighbor_id;
1689 else
1690 srl->nhlfe[0].nexthop = exti->rmt_itf_addr.value;
1691 /* Backup Information if set */
1692 if (exti->lan_sid[1].header.type == 0)
1693 break;
1694 srl->flags[1] = exti->lan_sid[1].flags;
1695 if (CHECK_FLAG(exti->lan_sid[1].flags,
1696 EXT_SUBTLV_LINK_ADJ_SID_VFLG))
1697 srl->sid[1] = GET_LABEL(ntohl(exti->lan_sid[1].value));
1698 else
1699 srl->sid[1] = ntohl(exti->lan_sid[1].value);
1700 if (exti->rmt_itf_addr.header.type == 0)
1701 srl->nhlfe[1].nexthop = exti->lan_sid[1].neighbor_id;
1702 else
1703 srl->nhlfe[1].nexthop = exti->rmt_itf_addr.value;
1704 break;
5d8c8d0b
DS		 1705 case PREF_SID:
1706 case LOCAL_SID:
21baf89a
OD		 1707 /* Wrong SID Type. Abort! */
1708 XFREE(MTYPE_OSPF_SR_PARAMS, srl);
1709 return;
1710 }
1711
1712 /* Segment Routing Link is ready, update it */
1713 update_ext_link_sid(srn, srl, OSPF_LSA_SELF);
1714}
1715
1716/* Delete Prefix or (LAN)Adjacency-SID from Extended Link Information */
1717void ospf_sr_ext_itf_delete(struct ext_itf *exti)
1718{
1719 struct listnode *node;
1720 struct sr_node *srn = OspfSR.self;
1721 struct sr_prefix *srp = NULL;
1722 struct sr_link *srl = NULL;
1723 uint32_t instance;
1724
1725 osr_debug("SR (%s): Remove Extended LSA %u.0.0.%u from self",
1726 __func__, exti->stype == PREF_SID ? 7 : 8, exti->instance);
1727
1728 /* Sanity check: SR-Node and Extended Prefix/Link list may have been
1729 * removed earlier when stopping OSPF or OSPF-SR */
1730 if (srn == NULL || srn->ext_prefix == NULL || srn->ext_link == NULL)
1731 return;
1732
1733 if (exti->stype == PREF_SID) {
1734 instance = SET_OPAQUE_LSID(OPAQUE_TYPE_EXTENDED_PREFIX_LSA,
1735 exti->instance);
1736 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, srp))
1737 if (srp->instance == instance)
1738 break;
1739
1740 /* Uninstall Segment Prefix SID if found */
1741 if ((srp != NULL) && (srp->instance == instance))
43e7abb5 1742 ospf_zebra_delete_prefix_sid(srp);
21baf89a
OD		 1743 } else {
1744 /* Search for corresponding Segment Link for self SR-Node */
1745 instance = SET_OPAQUE_LSID(OPAQUE_TYPE_EXTENDED_LINK_LSA,
1746 exti->instance);
1747 for (ALL_LIST_ELEMENTS_RO(srn->ext_link, node, srl))
1748 if (srl->instance == instance)
1749 break;
1750
1751 /* Remove Segment Link if found */
1752 if ((srl != NULL) && (srl->instance == instance)) {
1753 del_adj_sid(srl->nhlfe[0]);
1754 del_adj_sid(srl->nhlfe[1]);
1755 listnode_delete(srn->ext_link, srl);
1756 XFREE(MTYPE_OSPF_SR_PARAMS, srl);
1757 }
1758 }
1759}
1760
cf9b9f77
OD		 1761/* Update Segment Routing from Extended Prefix LSA */
1762void ospf_sr_ext_prefix_lsa_update(struct ospf_lsa *lsa)
1763{
1764 struct sr_node *srn;
1765 struct tlv_header *tlvh;
b61264a8 1766 struct lsa_header *lsah = (struct lsa_header *)lsa->data;
cf9b9f77
OD		 1767 struct sr_prefix *srp;
1768
8db278b5 1769 int length;
cf9b9f77 1770
b37eb79c
OD		 1771 osr_debug("SR (%s): Process Extended Prefix LSA 7.0.0.%u from %pI4",
1772 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1773 &lsah->adv_router);
cf9b9f77
OD		 1774
1775 /* Sanity check */
1776 if (OspfSR.neighbors == NULL) {
cf444bcf 1777 flog_err(EC_OSPF_SR_INVALID_DB,
dbb93f1b 1778 "SR (%s): Abort! no valid SR DataBase", __func__);
cf9b9f77
OD		 1779 return;
1780 }
1781
1782 /* Get SR Node in hash table from Router ID */
1783 srn = (struct sr_node *)hash_get(OspfSR.neighbors,
1784 (void *)&(lsah->adv_router),
1785 (void *)sr_node_new);
cf9b9f77 1786 /* Initialize TLV browsing */
8db278b5
OD		 1787 length = lsa->size - OSPF_LSA_HEADER_SIZE;
1788 for (tlvh = TLV_HDR_TOP(lsah); length > 0 && tlvh;
cf9b9f77
OD		 1789 tlvh = TLV_HDR_NEXT(tlvh)) {
1790 if (ntohs(tlvh->type) == EXT_TLV_LINK) {
1791 /* Got Extended Link information */
8db278b5 1792 srp = get_ext_prefix_sid(tlvh, length);
cf9b9f77
OD		 1793 /* Update SID if not null */
1794 if (srp != NULL) {
1795 srp->instance = ntohl(lsah->id.s_addr);
1796 update_ext_prefix_sid(srn, srp);
1797 }
1798 }
8db278b5 1799 length -= TLV_SIZE(tlvh);
cf9b9f77
OD		 1800 }
1801}
1802
1803/* Delete Segment Routing from Extended Prefix LSA */
1804void ospf_sr_ext_prefix_lsa_delete(struct ospf_lsa *lsa)
1805{
1806 struct listnode *node;
1807 struct sr_prefix *srp;
1808 struct sr_node *srn;
1809 struct lsa_header *lsah = (struct lsa_header *)lsa->data;
93f0a26e 1810 uint32_t instance = ntohl(lsah->id.s_addr);
cf9b9f77 1811
b37eb79c
OD		 1812 osr_debug("SR (%s): Remove Extended Prefix LSA 7.0.0.%u from %pI4",
1813 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
1814 &lsah->adv_router);
cf9b9f77
OD		 1815
1816 /* Sanity check */
1817 if (OspfSR.neighbors == NULL) {
cf444bcf 1818 flog_err(EC_OSPF_SR_INVALID_DB,
dbb93f1b 1819 "SR (%s): Abort! no valid SR DataBase", __func__);
cf9b9f77
OD		 1820 return;
1821 }
1822
1823 /* Search SR Node in hash table from Router ID */
1824 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors,
1825 (void *)&(lsah->adv_router));
1826
7743f2f8
OD		 1827 /*
1828 * SR-Node may be NULL if it has been remove previously when
1829 * processing Router Information LSA deletion
1830 */
cf9b9f77 1831 if (srn == NULL) {
cf444bcf 1832 flog_err(EC_OSPF_SR_INVALID_DB,
b61264a8
OD		 1833 "SR (%s): Stop! no entry in SRDB for SR Node %pI4",
1834 __func__, &lsah->adv_router);
cf9b9f77
OD		 1835 return;
1836 }
1837
b61264a8 1838 /* Search for corresponding Segment Prefix */
cf9b9f77
OD		 1839 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, srp))
1840 if (srp->instance == instance)
1841 break;
1842
b37eb79c 1843 /* Remove Prefix if found */
fd3b19f2 1844 if ((srp != NULL) && (srp->instance == instance)) {
43e7abb5 1845 ospf_zebra_delete_prefix_sid(srp);
b37eb79c 1846 listnode_delete(srn->ext_prefix, srp);
cf9b9f77
OD		 1847 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
1848 } else {
dbb93f1b 1849 flog_err(
cf444bcf 1850 EC_OSPF_SR_INVALID_DB,
b61264a8 1851 "SR (%s): Didn't found corresponding SR Prefix 7.0.0.%u for SR Node %pI4",
996c9314 1852 __func__, GET_OPAQUE_ID(ntohl(lsah->id.s_addr)),
b61264a8 1853 &lsah->adv_router);
cf9b9f77 1854 }
cf9b9f77
OD		 1855}
1856
7743f2f8
OD		 1857/*
1858 * Update Prefix SID. Call by ospf_ext_pref_ism_change to
b37eb79c 1859 * complete initial CLI command at startup.
7743f2f8
OD		 1860 *
1861 * @param ifp - Loopback interface
1862 * @param pref - Prefix address of this interface
1863 *
1864 * @return - void
1865 */
b37eb79c 1866void ospf_sr_update_local_prefix(struct interface *ifp, struct prefix *p)
7743f2f8
OD		 1867{
1868 struct listnode *node;
1869 struct sr_prefix *srp;
7743f2f8
OD		 1870
1871 /* Sanity Check */
1872 if ((ifp == NULL) || (p == NULL))
1873 return;
1874
1875 /*
1876 * Search if there is a Segment Prefix that correspond to this
1877 * interface or prefix, and update it if found
1878 */
1879 for (ALL_LIST_ELEMENTS_RO(OspfSR.self->ext_prefix, node, srp)) {
1880 if ((srp->nhlfe.ifindex == ifp->ifindex)
b61264a8 1881 || ((IPV4_ADDR_SAME(&srp->prefv4.prefix, &p->u.prefix4))
b37eb79c 1882 && (srp->prefv4.prefixlen == p->prefixlen))) {
7743f2f8
OD		 1883
1884 /* Update Interface & Prefix info */
1885 srp->nhlfe.ifindex = ifp->ifindex;
b37eb79c
OD		 1886 IPV4_ADDR_COPY(&srp->prefv4.prefix, &p->u.prefix4);
1887 srp->prefv4.prefixlen = p->prefixlen;
1888 srp->prefv4.family = p->family;
7743f2f8
OD		 1889 IPV4_ADDR_COPY(&srp->nhlfe.nexthop, &p->u.prefix4);
1890
1891 /* OK. Let's Schedule Extended Prefix LSA */
996c9314 1892 srp->instance = ospf_ext_schedule_prefix_index(
b37eb79c
OD		 1893 ifp, srp->sid, &srp->prefv4, srp->flags);
1894
b61264a8
OD		 1895 osr_debug(
1896 " |- Update Node SID %pFX - %u for self SR Node",
1897 (struct prefix *)&srp->prefv4, srp->sid);
7743f2f8 1898
f786c4d7
OD		 1899 /* Install SID if NO-PHP is set and not EXPLICIT-NULL */
1900 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_NPFLG)
1901 && !CHECK_FLAG(srp->flags,
1902 EXT_SUBTLV_PREFIX_SID_EFLG)) {
b61264a8
OD		 1903 srp->label_in = index2label(srp->sid,
1904 OspfSR.self->srgb);
70e98a7f 1905 srp->nhlfe.label_out = MPLS_LABEL_IMPLICIT_NULL;
43e7abb5 1906 ospf_zebra_update_prefix_sid(srp);
7743f2f8
OD		 1907 }
1908 }
1909 }
1910}
1911
cf9b9f77
OD		 1912/*
1913 * Following functions are used to update MPLS LFIB after a SPF run
1914 */
1915
e3b78da8 1916static void ospf_sr_nhlfe_update(struct hash_bucket *bucket, void *args)
cf9b9f77
OD		 1917{
1918
e3b78da8 1919 struct sr_node *srn = (struct sr_node *)bucket->data;
cf9b9f77
OD		 1920 struct listnode *node;
1921 struct sr_prefix *srp;
b37eb79c 1922 bool old;
cf9b9f77
OD		 1923 int rc;
1924
b37eb79c 1925 osr_debug(" |- Update Prefix for SR Node %pI4", &srn->adv_router);
cf9b9f77 1926
7743f2f8
OD		 1927 /* Skip Self SR Node */
1928 if (srn == OspfSR.self)
cf9b9f77 1929 return;
cf9b9f77
OD		 1930
1931 /* Update Extended Prefix */
1932 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, srp)) {
1933
b37eb79c
OD		 1934 /* Keep track of valid route */
1935 old = srp->route != NULL;
cf9b9f77
OD		 1936
1937 /* Compute the new NHLFE */
1938 rc = compute_prefix_nhlfe(srp);
1939
1940 /* Check computation result */
1941 switch (rc) {
b37eb79c 1942 /* Routes are not know, remove old NHLFE if any to avoid loop */
cf9b9f77 1943 case -1:
b37eb79c 1944 if (old)
43e7abb5 1945 ospf_zebra_delete_prefix_sid(srp);
cf9b9f77 1946 break;
b37eb79c 1947 /* Routes exist but are not ready, skip it */
cf9b9f77
OD		 1948 case 0:
1949 break;
b37eb79c 1950 /* There is at least one route, update NHLFE */
cf9b9f77 1951 case 1:
43e7abb5 1952 ospf_zebra_update_prefix_sid(srp);
cf9b9f77
OD		 1953 break;
1954 default:
1955 break;
1956 }
1957 }
1958}
1959
b37eb79c 1960void ospf_sr_update_task(struct ospf *ospf)
cf9b9f77
OD		 1961{
1962
cf9b9f77
OD		 1963 struct timeval start_time, stop_time;
1964
a351b3e4
OD		 1965 /* Check ospf and SR status */
1966 if ((ospf == NULL) || (OspfSR.status != SR_UP))
b37eb79c 1967 return;
cf9b9f77
OD		 1968
1969 monotime(&start_time);
1970
b37eb79c 1971 osr_debug("SR (%s): Start SPF update", __func__);
cf9b9f77 1972
e3b78da8 1973 hash_iterate(OspfSR.neighbors, (void (*)(struct hash_bucket *,
cf9b9f77
OD		 1974 void *))ospf_sr_nhlfe_update,
1975 NULL);
1976
1977 monotime(&stop_time);
1978
b37eb79c
OD		 1979 osr_debug("SR (%s): SPF Processing Time(usecs): %lld", __func__,
1980 (stop_time.tv_sec - start_time.tv_sec) * 1000000LL
b61264a8 1981 + (stop_time.tv_usec - start_time.tv_usec));
cf9b9f77
OD		 1982}
1983
7743f2f8
OD		 1984/*
1985 * --------------------------------------
78dfa0c7 1986 * Following are vty command functions.
7743f2f8
OD		 1987 * --------------------------------------
1988 */
cf9b9f77
OD		 1989
1990/*
1991 * Segment Routing Router configuration
1992 *
1993 * Must be centralize as it concerns both Extended Link/Prefix LSA
1994 * and Router Information LSA. Choose to call it from Extended Prefix
1995 * write_config() call back.
1996 *
1997 * @param vty VTY output
1998 *
1999 * @return none
2000 */
2001void ospf_sr_config_write_router(struct vty *vty)
2002{
2003 struct listnode *node;
2004 struct sr_prefix *srp;
6f751f14 2005 uint32_t upper;
cf9b9f77 2006
6443a4be 2007 if (OspfSR.status == SR_UP)
cf9b9f77
OD		 2008 vty_out(vty, " segment-routing on\n");
2009
6443a4be
EDP		 2010 upper = OspfSR.srgb.start + OspfSR.srgb.size - 1;
2011 if ((OspfSR.srgb.start != DEFAULT_SRGB_LABEL)
2012 || (OspfSR.srgb.size != DEFAULT_SRGB_SIZE))
2013 vty_out(vty, " segment-routing global-block %u %u",
2014 OspfSR.srgb.start, upper);
6f751f14 2015
7bd1ec94
PG		 2016 if ((OspfSR.srlb.start != DEFAULT_SRLB_LABEL) ||
2017 (OspfSR.srlb.end != DEFAULT_SRLB_END)) {
2018 if ((OspfSR.srgb.start == DEFAULT_SRGB_LABEL) &&
2019 (OspfSR.srgb.size == DEFAULT_SRGB_SIZE))
2020 vty_out(vty, " segment-routing global-block %u %u",
2021 OspfSR.srgb.start, upper);
6443a4be
EDP		 2022 vty_out(vty, " local-block %u %u\n", OspfSR.srlb.start,
2023 OspfSR.srlb.end);
7bd1ec94 2024 } else
6443a4be 2025 vty_out(vty, "\n");
6f751f14 2026
6443a4be
EDP		 2027 if (OspfSR.msd != 0)
2028 vty_out(vty, " segment-routing node-msd %u\n", OspfSR.msd);
cf9b9f77 2029
6443a4be
EDP		 2030 if (OspfSR.self != NULL) {
2031 for (ALL_LIST_ELEMENTS_RO(OspfSR.self->ext_prefix, node, srp)) {
2032 vty_out(vty, " segment-routing prefix %pFX index %u",
2033 &srp->prefv4, srp->sid);
2034 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_EFLG))
2035 vty_out(vty, " explicit-null\n");
2036 else if (CHECK_FLAG(srp->flags,
2037 EXT_SUBTLV_PREFIX_SID_NPFLG))
2038 vty_out(vty, " no-php-flag\n");
2039 else
2040 vty_out(vty, "\n");
cf9b9f77
OD		 2041 }
2042 }
2043}
2044
2045DEFUN(ospf_sr_enable,
2046 ospf_sr_enable_cmd,
2047 "segment-routing on",
2048 SR_STR
2049 "Enable Segment Routing\n")
2050{
2051
2052 VTY_DECLVAR_INSTANCE_CONTEXT(ospf, ospf);
2053
d81b8e0e 2054 if (OspfSR.status != SR_OFF)
cf9b9f77
OD		 2055 return CMD_SUCCESS;
2056
7726c479 2057 if (ospf->vrf_id != VRF_DEFAULT) {
996c9314 2058 vty_out(vty,
3efd0893 2059 "Segment Routing is only supported in default VRF\n");
7726c479
OD		 2060 return CMD_WARNING_CONFIG_FAILED;
2061 }
2062
b37eb79c 2063 osr_debug("SR: Segment Routing: OFF -> ON");
cf9b9f77
OD		 2064
2065 /* Start Segment Routing */
d81b8e0e 2066 OspfSR.status = SR_ON;
266469eb 2067 ospf_sr_start(ospf);
cf9b9f77 2068
cf9b9f77
OD		 2069 return CMD_SUCCESS;
2070}
2071
2072DEFUN (no_ospf_sr_enable,
2073 no_ospf_sr_enable_cmd,
2074 "no segment-routing [on]",
2075 NO_STR
2076 SR_STR
2077 "Disable Segment Routing\n")
2078{
2079
d81b8e0e 2080 if (OspfSR.status == SR_OFF)
cf9b9f77
OD		 2081 return CMD_SUCCESS;
2082
b37eb79c 2083 osr_debug("SR: Segment Routing: ON -> OFF");
cf9b9f77
OD		 2084
2085 /* Start by Disabling Extended Link & Prefix LSA */
2086 ospf_ext_update_sr(false);
2087
2088 /* then, disable Router Information SR parameters */
6f751f14 2089 ospf_router_info_update_sr(false, OspfSR.self);
cf9b9f77
OD		 2090
2091 /* Finally, stop Segment Routing */
2092 ospf_sr_stop();
cf9b9f77
OD		 2093
2094 return CMD_SUCCESS;
2095}
2096
2097static int ospf_sr_enabled(struct vty *vty)
2098{
d81b8e0e 2099 if (OspfSR.status != SR_OFF)
cf9b9f77
OD		 2100 return 1;
2101
2102 if (vty)
2103 vty_out(vty, "%% OSPF SR is not turned on\n");
2104
2105 return 0;
2106}
2107
4e10b4df
FR		 2108/* tell if two ranges [r1_lower, r1_upper] and [r2_lower,r2_upper] overlap */
2109static bool ranges_overlap(uint32_t r1_lower, uint32_t r1_upper,
2110 uint32_t r2_lower, uint32_t r2_upper)
2111{
2112 return !((r1_upper < r2_lower) || (r1_lower > r2_upper));
2113}
2114
6c57d010
FR		 2115
2116/* tell if a range is valid */
2117static bool sr_range_is_valid(uint32_t lower, uint32_t upper, uint32_t min_size)
2118{
2119 return (upper >= lower + min_size);
2120}
2121
d81b8e0e 2122/**
6443a4be 2123 * Update SRGB and/or SRLB using new CLI values.
d81b8e0e 2124 *
6443a4be
EDP		 2125 * @param gb_lower Lower bound of the SRGB
2126 * @param gb_upper Upper bound of the SRGB
2127 * @param lb_lower Lower bound of the SRLB
2128 * @param lb_upper Upper bound of the SRLB
d81b8e0e 2129 *
6443a4be 2130 * @return 0 on success, -1 otherwise
d81b8e0e 2131 */
6443a4be
EDP		 2132static int update_sr_blocks(uint32_t gb_lower, uint32_t gb_upper,
2133 uint32_t lb_lower, uint32_t lb_upper)
d81b8e0e
OD		 2134{
2135
2136 /* Check if values have changed */
6443a4be
EDP		 2137 bool gb_changed, lb_changed;
2138 uint32_t gb_size = gb_upper - gb_lower + 1;
2139 uint32_t lb_size = lb_upper - lb_lower + 1;
2140
2141 gb_changed =
2142 (OspfSR.srgb.size != gb_size || OspfSR.srgb.start != gb_lower);
2143 lb_changed =
2144 (OspfSR.srlb.end != lb_upper || OspfSR.srlb.start != lb_lower);
2145 if (!gb_changed && !lb_changed)
d81b8e0e
OD		 2146 return 0;
2147
6443a4be
EDP		 2148 /* Check if SR is correctly started i.e. Label Manager connected */
2149 if (OspfSR.status != SR_UP) {
2150 OspfSR.srgb.size = gb_size;
2151 OspfSR.srgb.start = gb_lower;
2152 OspfSR.srlb.end = lb_upper;
2153 OspfSR.srlb.start = lb_lower;
2154 return 0;
d81b8e0e
OD		 2155 }
2156
6443a4be
EDP		 2157 /* Release old SRGB if it has changed and is active. */
2158 if (gb_changed) {
c181efbe
FR		 2159
2160 sr_global_block_delete();
6443a4be
EDP		 2161
2162 /* Set new SRGB values - but do not reserve yet (we need to
2163 * release the SRLB too) */
2164 OspfSR.srgb.size = gb_size;
2165 OspfSR.srgb.start = gb_lower;
2166 if (OspfSR.self != NULL) {
2167 OspfSR.self->srgb.range_size = gb_size;
2168 OspfSR.self->srgb.lower_bound = gb_lower;
2169 }
d81b8e0e 2170 }
6443a4be
EDP		 2171 /* Release old SRLB if it has changed and reserve new block as needed.
2172 */
2173 if (lb_changed) {
c181efbe
FR		 2174
2175 sr_local_block_delete();
d81b8e0e 2176
6443a4be
EDP		 2177 /* Set new SRLB values */
2178 if (sr_local_block_init(lb_lower, lb_upper) < 0) {
2179 ospf_sr_stop();
2180 return -1;
2181 }
2182 if (OspfSR.self != NULL) {
2183 OspfSR.self->srlb.lower_bound = lb_lower;
2184 OspfSR.self->srlb.range_size = lb_size;
2185 }
2186 }
d81b8e0e
OD		 2187
2188 /*
6443a4be
EDP		 2189 * Try to reserve the new SRGB from the Label Manger. If the
2190 * allocation fails, disable SR until new blocks are successfully
2191 * allocated.
d81b8e0e 2192 */
6443a4be 2193 if (gb_changed) {
daaebd39 2194 if (sr_global_block_init(OspfSR.srgb.start, OspfSR.srgb.size)
6443a4be 2195 < 0) {
6443a4be
EDP		 2196 ospf_sr_stop();
2197 return -1;
daaebd39 2198 }
6443a4be 2199 }
d81b8e0e 2200
83df36e8
OD		 2201 /* Update Self SR-Node */
2202 if (OspfSR.self != NULL) {
2203 /* SRGB is reserved, set Router Information parameters */
2204 ospf_router_info_update_sr(true, OspfSR.self);
d81b8e0e 2205
83df36e8 2206 /* and update NHLFE entries */
6443a4be
EDP		 2207 if (gb_changed)
2208 hash_iterate(OspfSR.neighbors,
2209 (void (*)(struct hash_bucket *,
2210 void *))update_in_nhlfe,
2211 NULL);
2212
2213 /* and update (LAN)-Adjacency SID */
2214 if (lb_changed)
2215 ospf_ext_link_srlb_update();
83df36e8 2216 }
d81b8e0e
OD		 2217
2218 return 0;
2219}
2220
6443a4be
EDP		 2221DEFUN(sr_global_label_range, sr_global_label_range_cmd,
2222 "segment-routing global-block (16-1048575) (16-1048575) [local-block (16-1048575) (16-1048575)]",
2223 SR_STR
2224 "Segment Routing Global Block label range\n"
2225 "Lower-bound range in decimal (16-1048575)\n"
2226 "Upper-bound range in decimal (16-1048575)\n"
2227 "Segment Routing Local Block label range\n"
2228 "Lower-bound range in decimal (16-1048575)\n"
2229 "Upper-bound range in decimal (16-1048575)\n")
cf9b9f77 2230{
6443a4be
EDP		 2231 uint32_t lb_upper, lb_lower;
2232 uint32_t gb_upper, gb_lower;
2233 int idx_gb_low = 2, idx_gb_up = 3;
2234 int idx_lb_low = 5, idx_lb_up = 6;
2235
2236 /* Get lower and upper bound for mandatory global-block */
2237 gb_lower = strtoul(argv[idx_gb_low]->arg, NULL, 10);
2238 gb_upper = strtoul(argv[idx_gb_up]->arg, NULL, 10);
6c57d010 2239
6443a4be
EDP		 2240 /* SRLB values are taken from vtysh if there, else use the known ones */
2241 lb_upper = argc > idx_lb_up ? strtoul(argv[idx_lb_up]->arg, NULL, 10)
2242 : OspfSR.srlb.end;
2243 lb_lower = argc > idx_lb_low ? strtoul(argv[idx_lb_low]->arg, NULL, 10)
2244 : OspfSR.srlb.start;
cf9b9f77 2245
6c57d010
FR		 2246 /* check correctness of input SRGB */
2247 if (!sr_range_is_valid(gb_lower, gb_upper, MIN_SRGB_SIZE)) {
2248 vty_out(vty, "Invalid SRGB range\n");
2249 return CMD_WARNING_CONFIG_FAILED;
2250 }
2251
2252 /* check correctness of SRLB */
2253 if (!sr_range_is_valid(lb_lower, lb_upper, MIN_SRLB_SIZE)) {
2254 vty_out(vty, "Invalid SRLB range\n");
2255 return CMD_WARNING_CONFIG_FAILED;
2256 }
2257
6f751f14 2258 /* Validate SRGB against SRLB */
4e10b4df 2259 if (ranges_overlap(gb_lower, gb_upper, lb_lower, lb_upper)) {
6f751f14 2260 vty_out(vty,
4e10b4df 2261 "New SR Global Block (%u/%u) conflicts with Local Block (%u/%u)\n",
6443a4be 2262 gb_lower, gb_upper, lb_lower, lb_upper);
6f751f14
OD		 2263 return CMD_WARNING_CONFIG_FAILED;
2264 }
2265
6443a4be 2266 if (update_sr_blocks(gb_lower, gb_upper, lb_lower, lb_upper) < 0)
cf9b9f77 2267 return CMD_WARNING_CONFIG_FAILED;
d81b8e0e 2268 else
7743f2f8 2269 return CMD_SUCCESS;
cf9b9f77
OD		 2270}
2271
6443a4be
EDP		 2272DEFUN(no_sr_global_label_range, no_sr_global_label_range_cmd,
2273 "no segment-routing global-block [(16-1048575) (16-1048575) local-block (16-1048575) (16-1048575)]",
2274 NO_STR SR_STR
2275 "Segment Routing Global Block label range\n"
2276 "Lower-bound range in decimal (16-1048575)\n"
2277 "Upper-bound range in decimal (16-1048575)\n"
2278 "Segment Routing Local Block label range\n"
2279 "Lower-bound range in decimal (16-1048575)\n"
2280 "Upper-bound range in decimal (16-1048575)\n")
cf9b9f77 2281{
6443a4be
EDP		 2282 if (update_sr_blocks(DEFAULT_SRGB_LABEL, DEFAULT_SRGB_END,
2283 DEFAULT_SRLB_LABEL, DEFAULT_SRLB_END)
2284 < 0)
d81b8e0e
OD		 2285 return CMD_WARNING_CONFIG_FAILED;
2286 else
2287 return CMD_SUCCESS;
cf9b9f77
OD		 2288}
2289
2290DEFUN (sr_node_msd,
2291 sr_node_msd_cmd,
2292 "segment-routing node-msd (1-16)",
2293 SR_STR
2294 "Maximum Stack Depth for this router\n"
2295 "Maximum number of label that could be stack (1-16)\n")
2296{
93f0a26e 2297 uint32_t msd;
62c99790 2298 int idx = 1;
cf9b9f77
OD		 2299
2300 if (!ospf_sr_enabled(vty))
2301 return CMD_WARNING_CONFIG_FAILED;
2302
7743f2f8
OD		 2303 /* Get MSD */
2304 argv_find(argv, argc, "(1-16)", &idx);
2305 msd = strtoul(argv[idx]->arg, NULL, 10);
cf9b9f77 2306 if (msd < 1 || msd > MPLS_MAX_LABELS) {
7743f2f8 2307 vty_out(vty, "MSD must be comprise between 1 and %u\n",
cf9b9f77
OD		 2308 MPLS_MAX_LABELS);
2309 return CMD_WARNING_CONFIG_FAILED;
2310 }
2311
7743f2f8
OD		 2312 /* Check if value has changed */
2313 if (OspfSR.msd == msd)
2314 return CMD_SUCCESS;
2315
cf9b9f77
OD		 2316 /* Set this router MSD */
2317 OspfSR.msd = msd;
83df36e8 2318 if (OspfSR.self != NULL) {
7743f2f8 2319 OspfSR.self->msd = msd;
cf9b9f77 2320
83df36e8
OD		 2321 /* Set Router Information parameters if SR is UP */
2322 if (OspfSR.status == SR_UP)
2323 ospf_router_info_update_sr(true, OspfSR.self);
2324 }
cf9b9f77
OD		 2325
2326 return CMD_SUCCESS;
2327}
2328
2329DEFUN (no_sr_node_msd,
2330 no_sr_node_msd_cmd,
7743f2f8 2331 "no segment-routing node-msd [(1-16)]",
cf9b9f77
OD		 2332 NO_STR
2333 SR_STR
7743f2f8
OD		 2334 "Maximum Stack Depth for this router\n"
2335 "Maximum number of label that could be stack (1-16)\n")
cf9b9f77
OD		 2336{
2337
2338 if (!ospf_sr_enabled(vty))
2339 return CMD_WARNING_CONFIG_FAILED;
2340
2341 /* unset this router MSD */
2342 OspfSR.msd = 0;
83df36e8 2343 if (OspfSR.self != NULL) {
7743f2f8 2344 OspfSR.self->msd = 0;
cf9b9f77 2345
83df36e8
OD		 2346 /* Set Router Information parameters if SR is UP */
2347 if (OspfSR.status == SR_UP)
2348 ospf_router_info_update_sr(true, OspfSR.self);
2349 }
cf9b9f77
OD		 2350
2351 return CMD_SUCCESS;
2352}
2353
2354DEFUN (sr_prefix_sid,
2355 sr_prefix_sid_cmd,
f786c4d7 2356 "segment-routing prefix A.B.C.D/M index (0-65535) [no-php-flag|explicit-null]",
cf9b9f77
OD		 2357 SR_STR
2358 "Prefix SID\n"
2359 "IPv4 Prefix as A.B.C.D/M\n"
2360 "SID index for this prefix in decimal (0-65535)\n"
7743f2f8 2361 "Index value inside SRGB (lower_bound < index < upper_bound)\n"
f786c4d7
OD		 2362 "Don't request Penultimate Hop Popping (PHP)\n"
2363 "Upstream neighbor must replace prefix-sid with explicit null label\n")
cf9b9f77 2364{
7743f2f8 2365 int idx = 0;
d1db7359 2366 struct prefix p, pexist;
cf9b9f77
OD		 2367 uint32_t index;
2368 struct listnode *node;
d1db7359 2369 struct sr_prefix *srp, *exist = NULL;
cf9b9f77 2370 struct interface *ifp;
d1db7359
FR		 2371 bool no_php_flag = false;
2372 bool exp_null = false;
2373 bool index_in_use = false;
2374 uint8_t desired_flags = 0;
cf9b9f77
OD		 2375
2376 if (!ospf_sr_enabled(vty))
2377 return CMD_WARNING_CONFIG_FAILED;
2378
2379 /* Get network prefix */
7743f2f8 2380 argv_find(argv, argc, "A.B.C.D/M", &idx);
6aaf0fdd 2381 if (!str2prefix(argv[idx]->arg, &p)) {
996c9314 2382 vty_out(vty, "Invalid prefix format %s\n", argv[idx]->arg);
7743f2f8
OD		 2383 return CMD_WARNING_CONFIG_FAILED;
2384 }
cf9b9f77
OD		 2385
2386 /* Get & verify index value */
7743f2f8
OD		 2387 argv_find(argv, argc, "(0-65535)", &idx);
2388 index = strtoul(argv[idx]->arg, NULL, 10);
6f751f14 2389 if (index > OspfSR.srgb.size - 1) {
7743f2f8 2390 vty_out(vty, "Index %u must be lower than range size %u\n",
6f751f14 2391 index, OspfSR.srgb.size);
cf9b9f77
OD		 2392 return CMD_WARNING_CONFIG_FAILED;
2393 }
2394
d1db7359
FR		 2395 /* Get options */
2396 no_php_flag = argv_find(argv, argc, "no-php-flag", &idx);
2397 exp_null = argv_find(argv, argc, "explicit-null", &idx);
2398
2399 desired_flags |= no_php_flag ? EXT_SUBTLV_PREFIX_SID_NPFLG : 0;
2400 desired_flags |= exp_null ? EXT_SUBTLV_PREFIX_SID_NPFLG : 0;
2401 desired_flags |= exp_null ? EXT_SUBTLV_PREFIX_SID_EFLG : 0;
2402
f786c4d7 2403 /* Search for an existing Prefix-SID */
cf9b9f77 2404 for (ALL_LIST_ELEMENTS_RO(OspfSR.self->ext_prefix, node, srp)) {
d1db7359
FR		 2405 if (prefix_same((struct prefix *)&srp->prefv4, &p))
2406 exist = srp;
cf9b9f77 2407 if (srp->sid == index) {
d1db7359
FR		 2408 index_in_use = true;
2409 pexist = p;
cf9b9f77
OD		 2410 }
2411 }
2412
d1db7359
FR		 2413 /* done if prefix segment already there with same index and flags */
2414 if (exist && exist->sid == index && exist->flags == desired_flags)
2415 return CMD_SUCCESS;
2416
2417 /* deny if index is already in use by a distinct prefix */
2418 if (!exist && index_in_use) {
2419 vty_out(vty, "Index %u is already used by %pFX\n", index,
2420 &pexist);
2421 return CMD_WARNING_CONFIG_FAILED;
f786c4d7
OD		 2422 }
2423
270e66a2 2424 /* First, remove old NHLFE if installed */
d1db7359
FR		 2425 if (exist && CHECK_FLAG(exist->flags, EXT_SUBTLV_PREFIX_SID_NPFLG)
2426 && !CHECK_FLAG(exist->flags, EXT_SUBTLV_PREFIX_SID_EFLG))
2427 ospf_zebra_delete_prefix_sid(exist);
270e66a2 2428
d1db7359
FR		 2429 /* Create new Extended Prefix to SRDB if not found */
2430 if (exist == NULL) {
2431 srp = XCALLOC(MTYPE_OSPF_SR_PARAMS, sizeof(struct sr_prefix));
2432 IPV4_ADDR_COPY(&srp->prefv4.prefix, &p.u.prefix4);
2433 srp->prefv4.prefixlen = p.prefixlen;
2434 srp->prefv4.family = p.family;
2435 srp->sid = index;
2436 srp->type = LOCAL_SID;
2437 } else {
2438 /* we work on the existing SR prefix */
2439 srp = exist;
6aaf0fdd 2440 }
d1db7359
FR		 2441
2442 /* Reset labels to handle flag update */
2443 srp->label_in = 0;
2444 srp->nhlfe.label_out = 0;
2445 srp->sid = index;
2446 srp->flags = desired_flags;
2447
2448 /* If NO PHP flag is present, compute NHLFE and set label */
2449 if (no_php_flag) {
2450 srp->label_in = index2label(srp->sid, OspfSR.self->srgb);
2451 srp->nhlfe.label_out = MPLS_LABEL_IMPLICIT_NULL;
f786c4d7 2452 }
7743f2f8 2453
b61264a8 2454 osr_debug("SR (%s): Add new index %u to Prefix %pFX", __func__, index,
d1db7359 2455 (struct prefix *)&srp->prefv4);
7743f2f8 2456
cf9b9f77
OD		 2457 /* Get Interface and check if it is a Loopback */
2458 ifp = if_lookup_prefix(&p, VRF_DEFAULT);
2459 if (ifp == NULL) {
7743f2f8
OD		 2460 /*
2461 * Interface could be not yet available i.e. when this
cf9b9f77
OD		 2462 * command is in the configuration file, OSPF is not yet
2463 * ready. In this case, store the prefix SID for latter
7743f2f8
OD		 2464 * update of this Extended Prefix
2465 */
d1db7359
FR		 2466 if (exist == NULL)
2467 listnode_add(OspfSR.self->ext_prefix, srp);
266469eb 2468 zlog_info(
3efd0893 2469 "Interface for prefix %pFX not found. Deferred LSA flooding",
b61264a8 2470 &p);
cf9b9f77
OD		 2471 return CMD_SUCCESS;
2472 }
7743f2f8 2473
cf9b9f77
OD		 2474 if (!if_is_loopback(ifp)) {
2475 vty_out(vty, "interface %s is not a Loopback\n", ifp->name);
d1db7359 2476 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
cf9b9f77
OD		 2477 return CMD_WARNING_CONFIG_FAILED;
2478 }
d1db7359 2479 srp->nhlfe.ifindex = ifp->ifindex;
cf9b9f77 2480
d1db7359
FR		 2481 /* Add SR Prefix if new */
2482 if (!exist)
2483 listnode_add(OspfSR.self->ext_prefix, srp);
7743f2f8 2484
270e66a2 2485 /* Update Prefix SID if SR is UP */
f786c4d7 2486 if (OspfSR.status == SR_UP) {
d1db7359
FR		 2487 if (no_php_flag && !exp_null)
2488 ospf_zebra_update_prefix_sid(srp);
f786c4d7 2489 } else
d81b8e0e
OD		 2490 return CMD_SUCCESS;
2491
2492 /* Finally, update Extended Prefix LSA id SR is UP */
d1db7359
FR		 2493 srp->instance = ospf_ext_schedule_prefix_index(
2494 ifp, srp->sid, &srp->prefv4, srp->flags);
2495 if (srp->instance == 0) {
96b663a3
MS		 2496 vty_out(vty, "Unable to set index %u for prefix %pFX\n",
2497 index, &p);
cf9b9f77
OD		 2498 return CMD_WARNING;
2499 }
2500
2501 return CMD_SUCCESS;
2502}
2503
2504DEFUN (no_sr_prefix_sid,
2505 no_sr_prefix_sid_cmd,
f786c4d7 2506 "no segment-routing prefix A.B.C.D/M [index (0-65535)|no-php-flag|explicit-null]",
cf9b9f77
OD		 2507 NO_STR
2508 SR_STR
2509 "Prefix SID\n"
7743f2f8
OD		 2510 "IPv4 Prefix as A.B.C.D/M\n"
2511 "SID index for this prefix in decimal (0-65535)\n"
2512 "Index value inside SRGB (lower_bound < index < upper_bound)\n"
f786c4d7
OD		 2513 "Don't request Penultimate Hop Popping (PHP)\n"
2514 "Upstream neighbor must replace prefix-sid with explicit null label\n")
cf9b9f77 2515{
7743f2f8 2516 int idx = 0;
cf9b9f77
OD		 2517 struct prefix p;
2518 struct listnode *node;
2519 struct sr_prefix *srp;
2520 struct interface *ifp;
2521 bool found = false;
7743f2f8 2522 int rc;
cf9b9f77 2523
98c06e86
RW		 2524 if (!ospf_sr_enabled(vty))
2525 return CMD_WARNING_CONFIG_FAILED;
2526
d81b8e0e
OD		 2527 if (OspfSR.status != SR_UP)
2528 return CMD_SUCCESS;
2529
cf9b9f77 2530 /* Get network prefix */
7743f2f8
OD		 2531 argv_find(argv, argc, "A.B.C.D/M", &idx);
2532 rc = str2prefix(argv[idx]->arg, &p);
2533 if (!rc) {
996c9314 2534 vty_out(vty, "Invalid prefix format %s\n", argv[idx]->arg);
7743f2f8
OD		 2535 return CMD_WARNING_CONFIG_FAILED;
2536 }
cf9b9f77
OD		 2537
2538 /* check that the prefix is already set */
2539 for (ALL_LIST_ELEMENTS_RO(OspfSR.self->ext_prefix, node, srp))
b37eb79c
OD		 2540 if (IPV4_ADDR_SAME(&srp->prefv4.prefix, &p.u.prefix4)
2541 && (srp->prefv4.prefixlen == p.prefixlen)) {
cf9b9f77 2542 found = true;
7743f2f8
OD		 2543 break;
2544 }
cf9b9f77
OD		 2545
2546 if (!found) {
2547 vty_out(vty, "Prefix %s is not found. Abort!\n",
7743f2f8 2548 argv[idx]->arg);
cf9b9f77
OD		 2549 return CMD_WARNING_CONFIG_FAILED;
2550 }
2551
052a0cd0
PG		 2552 osr_debug("SR (%s): Remove Prefix %pFX with index %u", __func__,
2553 (struct prefix *)&srp->prefv4, srp->sid);
2554
7743f2f8
OD		 2555 /* Get Interface */
2556 ifp = if_lookup_by_index(srp->nhlfe.ifindex, VRF_DEFAULT);
cf9b9f77
OD		 2557 if (ifp == NULL) {
2558 vty_out(vty, "interface for prefix %s not found.\n",
7743f2f8 2559 argv[idx]->arg);
052a0cd0
PG		 2560 /* silently remove from list */
2561 listnode_delete(OspfSR.self->ext_prefix, srp);
2562 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
2563 return CMD_SUCCESS;
cf9b9f77 2564 }
7743f2f8 2565
cf9b9f77 2566 /* Update Extended Prefix LSA */
7743f2f8 2567 if (!ospf_ext_schedule_prefix_index(ifp, 0, NULL, 0)) {
cf9b9f77
OD		 2568 vty_out(vty, "No corresponding loopback interface. Abort!\n");
2569 return CMD_WARNING;
2570 }
2571
f786c4d7
OD		 2572 /* Delete NHLFE if NO-PHP is set and EXPLICIT NULL not set */
2573 if (CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_NPFLG)
2574 && !CHECK_FLAG(srp->flags, EXT_SUBTLV_PREFIX_SID_EFLG))
43e7abb5 2575 ospf_zebra_delete_prefix_sid(srp);
7743f2f8
OD		 2576
2577 /* OK, all is clean, remove SRP from SRDB */
2578 listnode_delete(OspfSR.self->ext_prefix, srp);
2579 XFREE(MTYPE_OSPF_SR_PARAMS, srp);
2580
cf9b9f77
OD		 2581 return CMD_SUCCESS;
2582}
2583
7743f2f8 2584
b37eb79c
OD		 2585static char *sr_op2str(char *buf, size_t size, mpls_label_t label_in,
2586 mpls_label_t label_out)
2587{
2588 if (size < 24)
2589 return NULL;
2590
2591 switch (label_out) {
2592 case MPLS_LABEL_IMPLICIT_NULL:
2593 snprintf(buf, size, "Pop(%u)", label_in);
2594 break;
2595 case MPLS_LABEL_IPV4_EXPLICIT_NULL:
f786c4d7
OD		 2596 if (label_in == MPLS_LABEL_IPV4_EXPLICIT_NULL)
2597 snprintf(buf, size, "no-op.");
2598 else
2599 snprintf(buf, size, "Swap(%u, null)", label_in);
b37eb79c
OD		 2600 break;
2601 case MPLS_INVALID_LABEL:
2602 snprintf(buf, size, "no-op.");
2603 break;
2604 default:
2605 snprintf(buf, size, "Swap(%u, %u)", label_in, label_out);
2606 break;
2607 }
2608 return buf;
2609}
2610
2611static void show_sr_prefix(struct sbuf *sbuf, struct json_object *json,
2612 struct sr_prefix *srp)
2613{
2614
2615 struct listnode *node;
2616 struct ospf_path *path;
2617 struct interface *itf;
2618 json_object *json_route = NULL, *json_obj;
2619 char pref[19];
2620 char sid[22];
2621 char op[32];
96b663a3 2622 char buf[PREFIX_STRLEN];
b37eb79c
OD		 2623 int indent = 0;
2624
b61264a8 2625 snprintfrr(pref, 19, "%pFX", (struct prefix *)&srp->prefv4);
b37eb79c
OD		 2626 snprintf(sid, 22, "SR Pfx (idx %u)", srp->sid);
2627 if (json) {
2628 json_object_string_add(json, "prefix", pref);
2629 json_object_int_add(json, "sid", srp->sid);
2630 json_object_int_add(json, "inputLabel", srp->label_in);
2631 } else {
2632 sbuf_push(sbuf, 0, "%18s %21s ", pref, sid);
2633 }
2634
2635 /* Check if it is a Local Node SID */
2636 if (srp->type == LOCAL_SID) {
2637 itf = if_lookup_by_index(srp->nhlfe.ifindex, VRF_DEFAULT);
2638 if (json) {
2639 if (!json_route) {
2640 json_route = json_object_new_array();
2641 json_object_object_add(json, "prefixRoute",
2642 json_route);
2643 }
2644 json_obj = json_object_new_object();
2645 json_object_int_add(json_obj, "outputLabel",
2646 srp->nhlfe.label_out);
2647 json_object_string_add(json_obj, "interface",
2648 itf ? itf->name : "-");
20308be3
DA		 2649 json_object_string_addf(json_obj, "nexthop", "%pI4",
2650 &srp->nhlfe.nexthop);
b37eb79c
OD		 2651 json_object_array_add(json_route, json_obj);
2652 } else {
2653 sbuf_push(sbuf, 0, "%20s %9s %15s\n",
b61264a8
OD		 2654 sr_op2str(op, 32, srp->label_in,
2655 srp->nhlfe.label_out),
2656 itf ? itf->name : "-",
96b663a3
MS		 2657 inet_ntop(AF_INET, &srp->nhlfe.nexthop,
2658 buf, sizeof(buf)));
b37eb79c
OD		 2659 }
2660 return;
2661 }
2662
2663 /* Check if we have a valid path for this prefix */
b61264a8 2664 if (srp->route == NULL) {
b37eb79c
OD		 2665 if (!json) {
2666 sbuf_push(sbuf, 0, "\n");
2667 }
2668 return;
2669 }
2670
2671 /* Process list of OSPF paths */
b61264a8 2672 for (ALL_LIST_ELEMENTS_RO(srp->route->paths, node, path)) {
b37eb79c
OD		 2673 itf = if_lookup_by_index(path->ifindex, VRF_DEFAULT);
2674 if (json) {
2675 if (!json_route) {
2676 json_route = json_object_new_array();
2677 json_object_object_add(json, "prefixRoute",
b61264a8 2678 json_route);
b37eb79c
OD		 2679 }
2680 json_obj = json_object_new_object();
2681 json_object_int_add(json_obj, "outputLabel",
b61264a8 2682 path->srni.label_out);
b37eb79c
OD		 2683 json_object_string_add(json_obj, "interface",
2684 itf ? itf->name : "-");
20308be3
DA		 2685 json_object_string_addf(json_obj, "nexthop", "%pI4",
2686 &path->nexthop);
b37eb79c
OD		 2687 json_object_array_add(json_route, json_obj);
2688 } else {
2689 sbuf_push(sbuf, indent, "%20s %9s %15s\n",
b61264a8
OD		 2690 sr_op2str(op, 32, srp->label_in,
2691 path->srni.label_out),
2692 itf ? itf->name : "-",
96b663a3
MS		 2693 inet_ntop(AF_INET, &path->nexthop, buf,
2694 sizeof(buf)));
b37eb79c
OD		 2695 /* Offset to align information for ECMP */
2696 indent = 43;
2697 }
2698 }
2699}
2700
76665890 2701static void show_sr_node(struct vty *vty, struct json_object *json,
996c9314 2702 struct sr_node *srn)
cf9b9f77
OD		 2703{
2704
2705 struct listnode *node;
2706 struct sr_link *srl;
2707 struct sr_prefix *srp;
2708 struct interface *itf;
b37eb79c 2709 struct sbuf sbuf;
76665890 2710 char pref[19];
7743f2f8 2711 char sid[22];
b37eb79c 2712 char op[32];
96b663a3 2713 char buf[PREFIX_STRLEN];
6f751f14 2714 uint32_t upper;
76665890
OD		 2715 json_object *json_node = NULL, *json_algo, *json_obj;
2716 json_object *json_prefix = NULL, *json_link = NULL;
cf9b9f77
OD		 2717
2718 /* Sanity Check */
2719 if (srn == NULL)
2720 return;
2721
b37eb79c
OD		 2722 sbuf_init(&sbuf, NULL, 0);
2723
76665890
OD		 2724 if (json) {
2725 json_node = json_object_new_object();
20308be3
DA		 2726 json_object_string_addf(json_node, "routerID", "%pI4",
2727 &srn->adv_router);
76665890 2728 json_object_int_add(json_node, "srgbSize",
996c9314 2729 srn->srgb.range_size);
76665890 2730 json_object_int_add(json_node, "srgbLabel",
996c9314 2731 srn->srgb.lower_bound);
6f751f14
OD		 2732 json_object_int_add(json_node, "srlbSize",
2733 srn->srlb.range_size);
2734 json_object_int_add(json_node, "srlbLabel",
2735 srn->srlb.lower_bound);
76665890
OD		 2736 json_algo = json_object_new_array();
2737 json_object_object_add(json_node, "algorithms", json_algo);
2738 for (int i = 0; i < ALGORITHM_COUNT; i++) {
2739 if (srn->algo[i] == SR_ALGORITHM_UNSET)
2740 continue;
2741 json_obj = json_object_new_object();
2742 char tmp[2];
2743
772270f3 2744 snprintf(tmp, sizeof(tmp), "%u", i);
76665890 2745 json_object_string_add(json_obj, tmp,
996c9314
LB		 2746 srn->algo[i] == SR_ALGORITHM_SPF
2747 ? "SPF"
2748 : "S-SPF");
76665890
OD		 2749 json_object_array_add(json_algo, json_obj);
2750 }
2751 if (srn->msd != 0)
2752 json_object_int_add(json_node, "nodeMsd", srn->msd);
2753 } else {
96b663a3 2754 sbuf_push(&sbuf, 0, "SR-Node: %pI4", &srn->adv_router);
6f751f14
OD		 2755 upper = srn->srgb.lower_bound + srn->srgb.range_size - 1;
2756 sbuf_push(&sbuf, 0, "\tSRGB: [%u/%u]",
2757 srn->srgb.lower_bound, upper);
2758 upper = srn->srlb.lower_bound + srn->srlb.range_size - 1;
2759 sbuf_push(&sbuf, 0, "\tSRLB: [%u/%u]",
2760 srn->srlb.lower_bound, upper);
2761 sbuf_push(&sbuf, 0, "\tAlgo.(s): %s",
b61264a8 2762 srn->algo[0] == SR_ALGORITHM_SPF ? "SPF" : "S-SPF");
76665890
OD		 2763 for (int i = 1; i < ALGORITHM_COUNT; i++) {
2764 if (srn->algo[i] == SR_ALGORITHM_UNSET)
2765 continue;
b37eb79c 2766 sbuf_push(&sbuf, 0, "/%s",
b61264a8
OD		 2767 srn->algo[i] == SR_ALGORITHM_SPF ? "SPF"
2768 : "S-SPF");
76665890
OD		 2769 }
2770 if (srn->msd != 0)
b37eb79c 2771 sbuf_push(&sbuf, 0, "\tMSD: %u", srn->msd);
76665890
OD		 2772 }
2773
2774 if (!json) {
b37eb79c 2775 sbuf_push(&sbuf, 0,
3efd0893 2776 "\n\n Prefix or Link Node or Adj. SID Label Operation Interface Nexthop\n");
b61264a8 2777 sbuf_push(&sbuf, 0,
3efd0893 2778 "------------------ --------------------- -------------------- --------- ---------------\n");
76665890 2779 }
cf9b9f77 2780 for (ALL_LIST_ELEMENTS_RO(srn->ext_prefix, node, srp)) {
76665890
OD		 2781 if (json) {
2782 if (!json_prefix) {
2783 json_prefix = json_object_new_array();
2784 json_object_object_add(json_node,
996c9314
LB		 2785 "extendedPrefix",
2786 json_prefix);
76665890
OD		 2787 }
2788 json_obj = json_object_new_object();
b37eb79c 2789 show_sr_prefix(NULL, json_obj, srp);
76665890
OD		 2790 json_object_array_add(json_prefix, json_obj);
2791 } else {
b37eb79c 2792 show_sr_prefix(&sbuf, NULL, srp);
76665890 2793 }
cf9b9f77
OD		 2794 }
2795
2796 for (ALL_LIST_ELEMENTS_RO(srn->ext_link, node, srl)) {
b61264a8 2797 snprintfrr(pref, 19, "%pI4/32", &srl->itf_addr);
b37eb79c 2798 snprintf(sid, 22, "SR Adj. (lbl %u)", srl->sid[0]);
cf9b9f77 2799 itf = if_lookup_by_index(srl->nhlfe[0].ifindex, VRF_DEFAULT);
76665890
OD		 2800 if (json) {
2801 if (!json_link) {
2802 json_link = json_object_new_array();
996c9314
LB		 2803 json_object_object_add(
2804 json_node, "extendedLink", json_link);
76665890
OD		 2805 }
2806 /* Primary Link */
2807 json_obj = json_object_new_object();
2808 json_object_string_add(json_obj, "prefix", pref);
2809 json_object_int_add(json_obj, "sid", srl->sid[0]);
2810 json_object_int_add(json_obj, "inputLabel",
996c9314 2811 srl->nhlfe[0].label_in);
b37eb79c
OD		 2812 json_object_int_add(json_obj, "outputLabel",
2813 srl->nhlfe[0].label_out);
76665890 2814 json_object_string_add(json_obj, "interface",
996c9314 2815 itf ? itf->name : "-");
20308be3
DA		 2816 json_object_string_addf(json_obj, "nexthop", "%pI4",
2817 &srl->nhlfe[0].nexthop);
76665890
OD		 2818 json_object_array_add(json_link, json_obj);
2819 /* Backup Link */
2820 json_obj = json_object_new_object();
b37eb79c 2821 snprintf(sid, 22, "SR Adj. (lbl %u)", srl->sid[1]);
76665890
OD		 2822 json_object_string_add(json_obj, "prefix", pref);
2823 json_object_int_add(json_obj, "sid", srl->sid[1]);
2824 json_object_int_add(json_obj, "inputLabel",
996c9314 2825 srl->nhlfe[1].label_in);
b37eb79c
OD		 2826 json_object_int_add(json_obj, "outputLabel",
2827 srl->nhlfe[1].label_out);
76665890 2828 json_object_string_add(json_obj, "interface",
996c9314 2829 itf ? itf->name : "-");
20308be3
DA		 2830 json_object_string_addf(json_obj, "nexthop", "%pI4",
2831 &srl->nhlfe[1].nexthop);
76665890
OD		 2832 json_object_array_add(json_link, json_obj);
2833 } else {
b37eb79c 2834 sbuf_push(&sbuf, 0, "%18s %21s %20s %9s %15s\n",
b61264a8
OD		 2835 pref, sid,
2836 sr_op2str(op, 32, srl->nhlfe[0].label_in,
2837 srl->nhlfe[0].label_out),
2838 itf ? itf->name : "-",
96b663a3
MS		 2839 inet_ntop(AF_INET, &srl->nhlfe[0].nexthop,
2840 buf, sizeof(buf)));
b37eb79c
OD		 2841 snprintf(sid, 22, "SR Adj. (lbl %u)", srl->sid[1]);
2842 sbuf_push(&sbuf, 0, "%18s %21s %20s %9s %15s\n",
b61264a8
OD		 2843 pref, sid,
2844 sr_op2str(op, 32, srl->nhlfe[1].label_in,
2845 srl->nhlfe[1].label_out),
2846 itf ? itf->name : "-",
96b663a3
MS		 2847 inet_ntop(AF_INET, &srl->nhlfe[1].nexthop,
2848 buf, sizeof(buf)));
76665890 2849 }
cf9b9f77 2850 }
76665890
OD		 2851 if (json)
2852 json_object_array_add(json, json_node);
2853 else
b37eb79c
OD		 2854 vty_out(vty, "%s\n", sbuf_buf(&sbuf));
2855
2856 sbuf_free(&sbuf);
cf9b9f77
OD		 2857}
2858
e3b78da8 2859static void show_vty_srdb(struct hash_bucket *bucket, void *args)
cf9b9f77
OD		 2860{
2861 struct vty *vty = (struct vty *)args;
e3b78da8 2862 struct sr_node *srn = (struct sr_node *)bucket->data;
cf9b9f77 2863
76665890
OD		 2864 show_sr_node(vty, NULL, srn);
2865}
2866
e3b78da8 2867static void show_json_srdb(struct hash_bucket *bucket, void *args)
76665890
OD		 2868{
2869 struct json_object *json = (struct json_object *)args;
e3b78da8 2870 struct sr_node *srn = (struct sr_node *)bucket->data;
76665890
OD		 2871
2872 show_sr_node(NULL, json, srn);
cf9b9f77
OD		 2873}
2874
2875DEFUN (show_ip_opsf_srdb,
2876 show_ip_ospf_srdb_cmd,
76665890 2877 "show ip ospf database segment-routing [adv-router A.B.C.D|self-originate] [json]",
cf9b9f77
OD		 2878 SHOW_STR
2879 IP_STR
2880 OSPF_STR
2881 "Database summary\n"
2882 "Show Segment Routing Data Base\n"
2883 "Advertising SR node\n"
2884 "Advertising SR node ID (as an IP address)\n"
76665890
OD		 2885 "Self-originated SR node\n"
2886 JSON_STR)
cf9b9f77 2887{
7743f2f8 2888 int idx = 0;
cf9b9f77
OD		 2889 struct in_addr rid;
2890 struct sr_node *srn;
088f1098 2891 bool uj = use_json(argc, argv);
76665890 2892 json_object *json = NULL, *json_node_array = NULL;
cf9b9f77 2893
d81b8e0e 2894 if (OspfSR.status == SR_OFF) {
cf9b9f77 2895 vty_out(vty, "Segment Routing is disabled on this router\n");
7726c479 2896 return CMD_WARNING;
cf9b9f77
OD		 2897 }
2898
76665890
OD		 2899 if (uj) {
2900 json = json_object_new_object();
2901 json_node_array = json_object_new_array();
20308be3
DA		 2902 json_object_string_addf(json, "srdbID", "%pI4",
2903 &OspfSR.self->adv_router);
76665890
OD		 2904 json_object_object_add(json, "srNodes", json_node_array);
2905 } else {
2906 vty_out(vty,
96b663a3
MS		 2907 "\n\t\tOSPF Segment Routing database for ID %pI4\n\n",
2908 &OspfSR.self->adv_router);
76665890 2909 }
cf9b9f77 2910
7743f2f8
OD		 2911 if (argv_find(argv, argc, "self-originate", &idx)) {
2912 srn = OspfSR.self;
76665890 2913 show_sr_node(vty, json_node_array, srn);
c48349e3 2914 if (uj)
92ef0078 2915 vty_json(vty, json);
7743f2f8
OD		 2916 return CMD_SUCCESS;
2917 }
2918
2919 if (argv_find(argv, argc, "A.B.C.D", &idx)) {
2920 if (!inet_aton(argv[idx]->arg, &rid)) {
996c9314 2921 vty_out(vty, "Specified Router ID %s is invalid\n",
7743f2f8
OD		 2922 argv[idx]->arg);
2923 return CMD_WARNING_CONFIG_FAILED;
cf9b9f77 2924 }
7743f2f8
OD		 2925 /* Get the SR Node from the SRDB */
2926 srn = (struct sr_node *)hash_lookup(OspfSR.neighbors,
2927 (void *)&rid);
76665890 2928 show_sr_node(vty, json_node_array, srn);
c48349e3 2929 if (uj)
92ef0078 2930 vty_json(vty, json);
7743f2f8 2931 return CMD_SUCCESS;
cf9b9f77 2932 }
7743f2f8
OD		 2933
2934 /* No parameters have been provided, Iterate through all the SRDB */
76665890 2935 if (uj) {
e3b78da8 2936 hash_iterate(OspfSR.neighbors, (void (*)(struct hash_bucket *,
996c9314
LB		 2937 void *))show_json_srdb,
2938 (void *)json_node_array);
92ef0078 2939 vty_json(vty, json);
76665890 2940 } else {
e3b78da8 2941 hash_iterate(OspfSR.neighbors, (void (*)(struct hash_bucket *,
996c9314
LB		 2942 void *))show_vty_srdb,
2943 (void *)vty);
76665890 2944 }
cf9b9f77
OD		 2945 return CMD_SUCCESS;
2946}
2947
2948/* Install new CLI commands */
2949void ospf_sr_register_vty(void)
2950{
2951 install_element(VIEW_NODE, &show_ip_ospf_srdb_cmd);
2952
2953 install_element(OSPF_NODE, &ospf_sr_enable_cmd);
2954 install_element(OSPF_NODE, &no_ospf_sr_enable_cmd);
6f751f14
OD		 2955 install_element(OSPF_NODE, &sr_global_label_range_cmd);
2956 install_element(OSPF_NODE, &no_sr_global_label_range_cmd);
cf9b9f77
OD		 2957 install_element(OSPF_NODE, &sr_node_msd_cmd);
2958 install_element(OSPF_NODE, &no_sr_node_msd_cmd);
2959 install_element(OSPF_NODE, &sr_prefix_sid_cmd);
2960 install_element(OSPF_NODE, &no_sr_prefix_sid_cmd);
cf9b9f77 2961}
FRRouting mirror