2 * IS-IS TLV Serializer/Deserializer
4 * Copyright (C) 2015,2017 Christian Franke
6 * This file is part of FRR.
8 * FRR is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2, or (at your option) any
13 * FRR is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with FRR; see the file COPYING. If not, write to the Free
20 * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA
30 #include "isisd/isisd.h"
31 #include "isisd/isis_memory.h"
32 #include "isisd/isis_tlvs.h"
33 #include "isisd/isis_common.h"
34 #include "isisd/isis_mt.h"
35 #include "isisd/isis_misc.h"
36 #include "isisd/isis_adjacency.h"
37 #include "isisd/isis_circuit.h"
38 #include "isisd/isis_pdu.h"
39 #include "isisd/isis_lsp.h"
40 #include "isisd/isis_te.h"
42 DEFINE_MTYPE_STATIC(ISISD
, ISIS_TLV
, "ISIS TLVs")
43 DEFINE_MTYPE_STATIC(ISISD
, ISIS_SUBTLV
, "ISIS Sub-TLVs")
44 DEFINE_MTYPE_STATIC(ISISD
, ISIS_MT_ITEM_LIST
, "ISIS MT Item Lists")
46 typedef int (*unpack_tlv_func
)(enum isis_tlv_context context
, uint8_t tlv_type
,
47 uint8_t tlv_len
, struct stream
*s
,
48 struct sbuf
*log
, void *dest
, int indent
);
49 typedef int (*pack_item_func
)(struct isis_item
*item
, struct stream
*s
);
50 typedef void (*free_item_func
)(struct isis_item
*i
);
51 typedef int (*unpack_item_func
)(uint16_t mtid
, uint8_t len
, struct stream
*s
,
52 struct sbuf
*log
, void *dest
, int indent
);
53 typedef void (*format_item_func
)(uint16_t mtid
, struct isis_item
*i
,
54 struct sbuf
*buf
, int indent
);
55 typedef struct isis_item
*(*copy_item_func
)(struct isis_item
*i
);
59 unpack_tlv_func unpack
;
61 pack_item_func pack_item
;
62 free_item_func free_item
;
63 unpack_item_func unpack_item
;
64 format_item_func format_item
;
65 copy_item_func copy_item
;
73 struct pack_order_entry
{
74 enum isis_tlv_context context
;
75 enum isis_tlv_type type
;
76 enum how_to_pack how_to_pack
;
79 #define PACK_ENTRY(t, h, w) \
81 .context = ISIS_CONTEXT_LSP, .type = ISIS_TLV_##t, \
83 .what_to_pack = offsetof(struct isis_tlvs, w), \
86 static struct pack_order_entry pack_order
[] = {
87 PACK_ENTRY(OLDSTYLE_REACH
, ISIS_ITEMS
, oldstyle_reach
),
88 PACK_ENTRY(LAN_NEIGHBORS
, ISIS_ITEMS
, lan_neighbor
),
89 PACK_ENTRY(LSP_ENTRY
, ISIS_ITEMS
, lsp_entries
),
90 PACK_ENTRY(EXTENDED_REACH
, ISIS_ITEMS
, extended_reach
),
91 PACK_ENTRY(MT_REACH
, ISIS_MT_ITEMS
, mt_reach
),
92 PACK_ENTRY(OLDSTYLE_IP_REACH
, ISIS_ITEMS
, oldstyle_ip_reach
),
93 PACK_ENTRY(OLDSTYLE_IP_REACH_EXT
, ISIS_ITEMS
, oldstyle_ip_reach_ext
),
94 PACK_ENTRY(IPV4_ADDRESS
, ISIS_ITEMS
, ipv4_address
),
95 PACK_ENTRY(IPV6_ADDRESS
, ISIS_ITEMS
, ipv6_address
),
96 PACK_ENTRY(EXTENDED_IP_REACH
, ISIS_ITEMS
, extended_ip_reach
),
97 PACK_ENTRY(MT_IP_REACH
, ISIS_MT_ITEMS
, mt_ip_reach
),
98 PACK_ENTRY(IPV6_REACH
, ISIS_ITEMS
, ipv6_reach
),
99 PACK_ENTRY(MT_IPV6_REACH
, ISIS_MT_ITEMS
, mt_ipv6_reach
)};
101 /* This is a forward definition. The table is actually initialized
102 * in at the bottom. */
103 static const struct tlv_ops
*tlv_table
[ISIS_CONTEXT_MAX
][ISIS_TLV_MAX
];
105 /* End of _ops forward definition. */
108 static void append_item(struct isis_item_list
*dest
, struct isis_item
*item
);
110 /* Functions for Sub-TLV 3 SR Prefix-SID */
112 static struct isis_item
*copy_item_prefix_sid(struct isis_item
*i
)
114 struct isis_prefix_sid
*sid
= (struct isis_prefix_sid
*)i
;
115 struct isis_prefix_sid
*rv
= XCALLOC(MTYPE_ISIS_SUBTLV
, sizeof(*rv
));
117 rv
->flags
= sid
->flags
;
118 rv
->algorithm
= sid
->algorithm
;
119 rv
->value
= sid
->value
;
120 return (struct isis_item
*)rv
;
123 static void format_item_prefix_sid(uint16_t mtid
, struct isis_item
*i
,
124 struct sbuf
*buf
, int indent
)
126 struct isis_prefix_sid
*sid
= (struct isis_prefix_sid
*)i
;
128 sbuf_push(buf
, indent
, "SR Prefix-SID:\n");
129 sbuf_push(buf
, indent
, " Flags:%s%s%s%s%s%s\n",
130 sid
->flags
& ISIS_PREFIX_SID_READVERTISED
? " READVERTISED" : "",
131 sid
->flags
& ISIS_PREFIX_SID_NODE
? " NODE" : "",
132 sid
->flags
& ISIS_PREFIX_SID_NO_PHP
? " NO_PHP" : "",
133 sid
->flags
& ISIS_PREFIX_SID_EXPLICIT_NULL
? " EXPLICIT-NULL" : "",
134 sid
->flags
& ISIS_PREFIX_SID_VALUE
? " VALUE" : "",
135 sid
->flags
& ISIS_PREFIX_SID_LOCAL
? " LOCAL" : "");
136 sbuf_push(buf
, indent
, " Algorithm: %" PRIu8
"\n", sid
->algorithm
);
137 if (sid
->flags
& ISIS_PREFIX_SID_VALUE
) {
138 sbuf_push(buf
, indent
, "Label: %" PRIu32
"\n", sid
->value
);
140 sbuf_push(buf
, indent
, "Index: %" PRIu32
"\n", sid
->value
);
144 static void free_item_prefix_sid(struct isis_item
*i
)
146 XFREE(MTYPE_ISIS_SUBTLV
, i
);
149 static int pack_item_prefix_sid(struct isis_item
*i
, struct stream
*s
)
151 struct isis_prefix_sid
*sid
= (struct isis_prefix_sid
*)i
;
153 uint8_t size
= (sid
->flags
& ISIS_PREFIX_SID_VALUE
) ? 5 : 6;
155 if (STREAM_WRITEABLE(s
) < size
)
158 stream_putc(s
, sid
->flags
);
159 stream_putc(s
, sid
->algorithm
);
161 if (sid
->flags
& ISIS_PREFIX_SID_VALUE
) {
162 stream_put3(s
, sid
->value
);
164 stream_putl(s
, sid
->value
);
170 static int unpack_item_prefix_sid(uint16_t mtid
, uint8_t len
, struct stream
*s
,
171 struct sbuf
*log
, void *dest
, int indent
)
173 struct isis_subtlvs
*subtlvs
= dest
;
174 struct isis_prefix_sid sid
= {
177 sbuf_push(log
, indent
, "Unpacking SR Prefix-SID...\n");
180 sbuf_push(log
, indent
,
181 "Not enough data left. (expected 5 or more bytes, got %" PRIu8
")\n",
186 sid
.flags
= stream_getc(s
);
187 if ((sid
.flags
& ISIS_PREFIX_SID_VALUE
)
188 != (sid
.flags
& ISIS_PREFIX_SID_LOCAL
)) {
189 sbuf_push(log
, indent
, "Flags inplausible: Local Flag needs to match Value Flag\n");
193 sid
.algorithm
= stream_getc(s
);
195 uint8_t expected_size
= (sid
.flags
& ISIS_PREFIX_SID_VALUE
) ? 5 : 6;
196 if (len
!= expected_size
) {
197 sbuf_push(log
, indent
,
198 "TLV size differs from expected size. "
199 "(expected %u but got %" PRIu8
")\n",
204 if (sid
.flags
& ISIS_PREFIX_SID_VALUE
) {
205 sid
.value
= stream_get3(s
);
207 sid
.value
= stream_getl(s
);
210 format_item_prefix_sid(mtid
, (struct isis_item
*)&sid
, log
, indent
+ 2);
211 append_item(&subtlvs
->prefix_sids
, copy_item_prefix_sid((struct isis_item
*)&sid
));
215 /* Functions for Sub-TVL ??? IPv6 Source Prefix */
217 static struct prefix_ipv6
*copy_subtlv_ipv6_source_prefix(struct prefix_ipv6
*p
)
222 struct prefix_ipv6
*rv
= XCALLOC(MTYPE_ISIS_SUBTLV
, sizeof(*rv
));
223 rv
->family
= p
->family
;
224 rv
->prefixlen
= p
->prefixlen
;
225 memcpy(&rv
->prefix
, &p
->prefix
, sizeof(rv
->prefix
));
229 static void format_subtlv_ipv6_source_prefix(struct prefix_ipv6
*p
,
230 struct sbuf
*buf
, int indent
)
235 char prefixbuf
[PREFIX2STR_BUFFER
];
236 sbuf_push(buf
, indent
, "IPv6 Source Prefix: %s\n",
237 prefix2str(p
, prefixbuf
, sizeof(prefixbuf
)));
240 static int pack_subtlv_ipv6_source_prefix(struct prefix_ipv6
*p
,
246 if (STREAM_WRITEABLE(s
) < 3 + (unsigned)PSIZE(p
->prefixlen
))
249 stream_putc(s
, ISIS_SUBTLV_IPV6_SOURCE_PREFIX
);
250 stream_putc(s
, 1 + PSIZE(p
->prefixlen
));
251 stream_putc(s
, p
->prefixlen
);
252 stream_put(s
, &p
->prefix
, PSIZE(p
->prefixlen
));
256 static int unpack_subtlv_ipv6_source_prefix(enum isis_tlv_context context
,
257 uint8_t tlv_type
, uint8_t tlv_len
,
258 struct stream
*s
, struct sbuf
*log
,
259 void *dest
, int indent
)
261 struct isis_subtlvs
*subtlvs
= dest
;
262 struct prefix_ipv6 p
= {
266 sbuf_push(log
, indent
, "Unpacking IPv6 Source Prefix Sub-TLV...\n");
269 sbuf_push(log
, indent
,
270 "Not enough data left. (expected 1 or more bytes, got %" PRIu8
")\n",
275 p
.prefixlen
= stream_getc(s
);
276 if (p
.prefixlen
> 128) {
277 sbuf_push(log
, indent
, "Prefixlen %u is inplausible for IPv6\n",
282 if (tlv_len
!= 1 + PSIZE(p
.prefixlen
)) {
285 "TLV size differs from expected size for the prefixlen. "
286 "(expected %u but got %" PRIu8
")\n",
287 1 + PSIZE(p
.prefixlen
), tlv_len
);
291 stream_get(&p
.prefix
, s
, PSIZE(p
.prefixlen
));
293 if (subtlvs
->source_prefix
) {
296 "WARNING: source prefix Sub-TLV present multiple times.\n");
297 /* Ignore all but first occurrence of the source prefix Sub-TLV
302 subtlvs
->source_prefix
= XCALLOC(MTYPE_ISIS_SUBTLV
, sizeof(p
));
303 memcpy(subtlvs
->source_prefix
, &p
, sizeof(p
));
306 static void init_item_list(struct isis_item_list
*items
);
307 static struct isis_item
*copy_item(enum isis_tlv_context context
,
308 enum isis_tlv_type type
,
309 struct isis_item
*item
);
310 static void copy_items(enum isis_tlv_context context
, enum isis_tlv_type type
,
311 struct isis_item_list
*src
, struct isis_item_list
*dest
);
312 static void format_items_(uint16_t mtid
, enum isis_tlv_context context
,
313 enum isis_tlv_type type
, struct isis_item_list
*items
,
314 struct sbuf
*buf
, int indent
);
315 #define format_items(...) format_items_(ISIS_MT_IPV4_UNICAST, __VA_ARGS__)
316 static void free_items(enum isis_tlv_context context
, enum isis_tlv_type type
,
317 struct isis_item_list
*items
);
318 static int pack_items_(uint16_t mtid
, enum isis_tlv_context context
,
319 enum isis_tlv_type type
, struct isis_item_list
*items
,
320 struct stream
*s
, struct isis_tlvs
**fragment_tlvs
,
321 struct pack_order_entry
*pe
,
322 struct isis_tlvs
*(*new_fragment
)(struct list
*l
),
323 struct list
*new_fragment_arg
);
324 #define pack_items(...) pack_items_(ISIS_MT_IPV4_UNICAST, __VA_ARGS__)
326 /* Functions related to subtlvs */
328 static struct isis_subtlvs
*isis_alloc_subtlvs(enum isis_tlv_context context
)
330 struct isis_subtlvs
*result
;
332 result
= XCALLOC(MTYPE_ISIS_SUBTLV
, sizeof(*result
));
333 result
->context
= context
;
335 init_item_list(&result
->prefix_sids
);
340 static struct isis_subtlvs
*copy_subtlvs(struct isis_subtlvs
*subtlvs
)
345 struct isis_subtlvs
*rv
= XCALLOC(MTYPE_ISIS_SUBTLV
, sizeof(*rv
));
347 rv
->context
= subtlvs
->context
;
349 copy_items(subtlvs
->context
, ISIS_SUBTLV_PREFIX_SID
,
350 &subtlvs
->prefix_sids
, &rv
->prefix_sids
);
353 copy_subtlv_ipv6_source_prefix(subtlvs
->source_prefix
);
357 static void format_subtlvs(struct isis_subtlvs
*subtlvs
, struct sbuf
*buf
,
360 format_items(subtlvs
->context
, ISIS_SUBTLV_PREFIX_SID
,
361 &subtlvs
->prefix_sids
, buf
, indent
);
363 format_subtlv_ipv6_source_prefix(subtlvs
->source_prefix
, buf
, indent
);
366 static void isis_free_subtlvs(struct isis_subtlvs
*subtlvs
)
371 free_items(subtlvs
->context
, ISIS_SUBTLV_PREFIX_SID
,
372 &subtlvs
->prefix_sids
);
374 XFREE(MTYPE_ISIS_SUBTLV
, subtlvs
->source_prefix
);
376 XFREE(MTYPE_ISIS_SUBTLV
, subtlvs
);
379 static int pack_subtlvs(struct isis_subtlvs
*subtlvs
, struct stream
*s
)
382 size_t subtlv_len_pos
= stream_get_endp(s
);
384 if (STREAM_WRITEABLE(s
) < 1)
387 stream_putc(s
, 0); /* Put 0 as subtlvs length, filled in later */
389 rv
= pack_items(subtlvs
->context
, ISIS_SUBTLV_PREFIX_SID
,
390 &subtlvs
->prefix_sids
, s
, NULL
, NULL
, NULL
, NULL
);
394 rv
= pack_subtlv_ipv6_source_prefix(subtlvs
->source_prefix
, s
);
398 size_t subtlv_len
= stream_get_endp(s
) - subtlv_len_pos
- 1;
399 if (subtlv_len
> 255)
402 stream_putc_at(s
, subtlv_len_pos
, subtlv_len
);
406 static int unpack_tlvs(enum isis_tlv_context context
, size_t avail_len
,
407 struct stream
*stream
, struct sbuf
*log
, void *dest
,
410 /* Functions related to TLVs 1 Area Addresses */
412 static struct isis_item
*copy_item_area_address(struct isis_item
*i
)
414 struct isis_area_address
*addr
= (struct isis_area_address
*)i
;
415 struct isis_area_address
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
418 memcpy(rv
->addr
, addr
->addr
, addr
->len
);
419 return (struct isis_item
*)rv
;
422 static void format_item_area_address(uint16_t mtid
, struct isis_item
*i
,
423 struct sbuf
*buf
, int indent
)
425 struct isis_area_address
*addr
= (struct isis_area_address
*)i
;
427 sbuf_push(buf
, indent
, "Area Address: %s\n",
428 isonet_print(addr
->addr
, addr
->len
));
431 static void free_item_area_address(struct isis_item
*i
)
433 XFREE(MTYPE_ISIS_TLV
, i
);
436 static int pack_item_area_address(struct isis_item
*i
, struct stream
*s
)
438 struct isis_area_address
*addr
= (struct isis_area_address
*)i
;
440 if (STREAM_WRITEABLE(s
) < (unsigned)1 + addr
->len
)
442 stream_putc(s
, addr
->len
);
443 stream_put(s
, addr
->addr
, addr
->len
);
447 static int unpack_item_area_address(uint16_t mtid
, uint8_t len
,
448 struct stream
*s
, struct sbuf
*log
,
449 void *dest
, int indent
)
451 struct isis_tlvs
*tlvs
= dest
;
452 struct isis_area_address
*rv
= NULL
;
454 sbuf_push(log
, indent
, "Unpack area address...\n");
458 "Not enough data left. (Expected 1 byte of address length, got %" PRIu8
464 rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
465 rv
->len
= stream_getc(s
);
467 if (len
< 1 + rv
->len
) {
468 sbuf_push(log
, indent
, "Not enough data left. (Expected %" PRIu8
469 " bytes of address, got %" PRIu8
")\n",
474 if (rv
->len
< 1 || rv
->len
> 20) {
475 sbuf_push(log
, indent
,
476 "Implausible area address length %" PRIu8
"\n",
481 stream_get(rv
->addr
, s
, rv
->len
);
483 format_item_area_address(ISIS_MT_IPV4_UNICAST
, (struct isis_item
*)rv
,
485 append_item(&tlvs
->area_addresses
, (struct isis_item
*)rv
);
488 XFREE(MTYPE_ISIS_TLV
, rv
);
492 /* Functions related to TLV 2 (Old-Style) IS Reach */
493 static struct isis_item
*copy_item_oldstyle_reach(struct isis_item
*i
)
495 struct isis_oldstyle_reach
*r
= (struct isis_oldstyle_reach
*)i
;
496 struct isis_oldstyle_reach
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
498 memcpy(rv
->id
, r
->id
, 7);
499 rv
->metric
= r
->metric
;
500 return (struct isis_item
*)rv
;
503 static void format_item_oldstyle_reach(uint16_t mtid
, struct isis_item
*i
,
504 struct sbuf
*buf
, int indent
)
506 struct isis_oldstyle_reach
*r
= (struct isis_oldstyle_reach
*)i
;
508 sbuf_push(buf
, indent
, "IS Reachability: %s (Metric: %" PRIu8
")\n",
509 isis_format_id(r
->id
, 7), r
->metric
);
512 static void free_item_oldstyle_reach(struct isis_item
*i
)
514 XFREE(MTYPE_ISIS_TLV
, i
);
517 static int pack_item_oldstyle_reach(struct isis_item
*i
, struct stream
*s
)
519 struct isis_oldstyle_reach
*r
= (struct isis_oldstyle_reach
*)i
;
521 if (STREAM_WRITEABLE(s
) < 11)
524 stream_putc(s
, r
->metric
);
525 stream_putc(s
, 0x80); /* delay metric - unsupported */
526 stream_putc(s
, 0x80); /* expense metric - unsupported */
527 stream_putc(s
, 0x80); /* error metric - unsupported */
528 stream_put(s
, r
->id
, 7);
533 static int unpack_item_oldstyle_reach(uint16_t mtid
, uint8_t len
,
534 struct stream
*s
, struct sbuf
*log
,
535 void *dest
, int indent
)
537 struct isis_tlvs
*tlvs
= dest
;
539 sbuf_push(log
, indent
, "Unpack oldstyle reach...\n");
543 "Not enough data left.(Expected 11 bytes of reach information, got %" PRIu8
549 struct isis_oldstyle_reach
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
550 rv
->metric
= stream_getc(s
);
551 if ((rv
->metric
& 0x3f) != rv
->metric
) {
552 sbuf_push(log
, indent
, "Metric has unplausible format\n");
555 stream_forward_getp(s
, 3); /* Skip other metrics */
556 stream_get(rv
->id
, s
, 7);
558 format_item_oldstyle_reach(mtid
, (struct isis_item
*)rv
, log
,
560 append_item(&tlvs
->oldstyle_reach
, (struct isis_item
*)rv
);
564 /* Functions related to TLV 6 LAN Neighbors */
565 static struct isis_item
*copy_item_lan_neighbor(struct isis_item
*i
)
567 struct isis_lan_neighbor
*n
= (struct isis_lan_neighbor
*)i
;
568 struct isis_lan_neighbor
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
570 memcpy(rv
->mac
, n
->mac
, 6);
571 return (struct isis_item
*)rv
;
574 static void format_item_lan_neighbor(uint16_t mtid
, struct isis_item
*i
,
575 struct sbuf
*buf
, int indent
)
577 struct isis_lan_neighbor
*n
= (struct isis_lan_neighbor
*)i
;
579 sbuf_push(buf
, indent
, "LAN Neighbor: %s\n", isis_format_id(n
->mac
, 6));
582 static void free_item_lan_neighbor(struct isis_item
*i
)
584 XFREE(MTYPE_ISIS_TLV
, i
);
587 static int pack_item_lan_neighbor(struct isis_item
*i
, struct stream
*s
)
589 struct isis_lan_neighbor
*n
= (struct isis_lan_neighbor
*)i
;
591 if (STREAM_WRITEABLE(s
) < 6)
594 stream_put(s
, n
->mac
, 6);
599 static int unpack_item_lan_neighbor(uint16_t mtid
, uint8_t len
,
600 struct stream
*s
, struct sbuf
*log
,
601 void *dest
, int indent
)
603 struct isis_tlvs
*tlvs
= dest
;
605 sbuf_push(log
, indent
, "Unpack LAN neighbor...\n");
609 "Not enough data left.(Expected 6 bytes of mac, got %" PRIu8
615 struct isis_lan_neighbor
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
616 stream_get(rv
->mac
, s
, 6);
618 format_item_lan_neighbor(mtid
, (struct isis_item
*)rv
, log
, indent
+ 2);
619 append_item(&tlvs
->lan_neighbor
, (struct isis_item
*)rv
);
623 /* Functions related to TLV 9 LSP Entry */
624 static struct isis_item
*copy_item_lsp_entry(struct isis_item
*i
)
626 struct isis_lsp_entry
*e
= (struct isis_lsp_entry
*)i
;
627 struct isis_lsp_entry
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
629 rv
->rem_lifetime
= e
->rem_lifetime
;
630 memcpy(rv
->id
, e
->id
, sizeof(rv
->id
));
631 rv
->seqno
= e
->seqno
;
632 rv
->checksum
= e
->checksum
;
634 return (struct isis_item
*)rv
;
637 static void format_item_lsp_entry(uint16_t mtid
, struct isis_item
*i
,
638 struct sbuf
*buf
, int indent
)
640 struct isis_lsp_entry
*e
= (struct isis_lsp_entry
*)i
;
642 sbuf_push(buf
, indent
,
643 "LSP Entry: %s, seq 0x%08" PRIx32
", cksum 0x%04" PRIx16
644 ", lifetime %" PRIu16
"s\n",
645 isis_format_id(e
->id
, 8), e
->seqno
, e
->checksum
,
649 static void free_item_lsp_entry(struct isis_item
*i
)
651 XFREE(MTYPE_ISIS_TLV
, i
);
654 static int pack_item_lsp_entry(struct isis_item
*i
, struct stream
*s
)
656 struct isis_lsp_entry
*e
= (struct isis_lsp_entry
*)i
;
658 if (STREAM_WRITEABLE(s
) < 16)
661 stream_putw(s
, e
->rem_lifetime
);
662 stream_put(s
, e
->id
, 8);
663 stream_putl(s
, e
->seqno
);
664 stream_putw(s
, e
->checksum
);
669 static int unpack_item_lsp_entry(uint16_t mtid
, uint8_t len
, struct stream
*s
,
670 struct sbuf
*log
, void *dest
, int indent
)
672 struct isis_tlvs
*tlvs
= dest
;
674 sbuf_push(log
, indent
, "Unpack LSP entry...\n");
678 "Not enough data left. (Expected 16 bytes of LSP info, got %" PRIu8
,
683 struct isis_lsp_entry
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
684 rv
->rem_lifetime
= stream_getw(s
);
685 stream_get(rv
->id
, s
, 8);
686 rv
->seqno
= stream_getl(s
);
687 rv
->checksum
= stream_getw(s
);
689 format_item_lsp_entry(mtid
, (struct isis_item
*)rv
, log
, indent
+ 2);
690 append_item(&tlvs
->lsp_entries
, (struct isis_item
*)rv
);
694 /* Functions related to TLVs 22/222 Extended Reach/MT Reach */
696 static struct isis_item
*copy_item_extended_reach(struct isis_item
*i
)
698 struct isis_extended_reach
*r
= (struct isis_extended_reach
*)i
;
699 struct isis_extended_reach
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
701 memcpy(rv
->id
, r
->id
, 7);
702 rv
->metric
= r
->metric
;
704 if (r
->subtlvs
&& r
->subtlv_len
) {
705 rv
->subtlvs
= XCALLOC(MTYPE_ISIS_TLV
, r
->subtlv_len
);
706 memcpy(rv
->subtlvs
, r
->subtlvs
, r
->subtlv_len
);
707 rv
->subtlv_len
= r
->subtlv_len
;
710 return (struct isis_item
*)rv
;
713 static void format_item_extended_reach(uint16_t mtid
, struct isis_item
*i
,
714 struct sbuf
*buf
, int indent
)
716 struct isis_extended_reach
*r
= (struct isis_extended_reach
*)i
;
718 sbuf_push(buf
, indent
, "%s Reachability: %s (Metric: %u)",
719 (mtid
== ISIS_MT_IPV4_UNICAST
) ? "Extended" : "MT",
720 isis_format_id(r
->id
, 7), r
->metric
);
721 if (mtid
!= ISIS_MT_IPV4_UNICAST
)
722 sbuf_push(buf
, 0, " %s", isis_mtid2str(mtid
));
723 sbuf_push(buf
, 0, "\n");
725 if (r
->subtlv_len
&& r
->subtlvs
)
726 mpls_te_print_detail(buf
, indent
+ 2, r
->subtlvs
,
730 static void free_item_extended_reach(struct isis_item
*i
)
732 struct isis_extended_reach
*item
= (struct isis_extended_reach
*)i
;
733 XFREE(MTYPE_ISIS_TLV
, item
->subtlvs
);
734 XFREE(MTYPE_ISIS_TLV
, item
);
737 static int pack_item_extended_reach(struct isis_item
*i
, struct stream
*s
)
739 struct isis_extended_reach
*r
= (struct isis_extended_reach
*)i
;
741 if (STREAM_WRITEABLE(s
) < 11 + (unsigned)r
->subtlv_len
)
743 stream_put(s
, r
->id
, sizeof(r
->id
));
744 stream_put3(s
, r
->metric
);
745 stream_putc(s
, r
->subtlv_len
);
746 stream_put(s
, r
->subtlvs
, r
->subtlv_len
);
750 static int unpack_item_extended_reach(uint16_t mtid
, uint8_t len
,
751 struct stream
*s
, struct sbuf
*log
,
752 void *dest
, int indent
)
754 struct isis_tlvs
*tlvs
= dest
;
755 struct isis_extended_reach
*rv
= NULL
;
757 struct isis_item_list
*items
;
759 if (mtid
== ISIS_MT_IPV4_UNICAST
) {
760 items
= &tlvs
->extended_reach
;
762 items
= isis_get_mt_items(&tlvs
->mt_reach
, mtid
);
765 sbuf_push(log
, indent
, "Unpacking %s reachability...\n",
766 (mtid
== ISIS_MT_IPV4_UNICAST
) ? "extended" : "mt");
769 sbuf_push(log
, indent
,
770 "Not enough data left. (expected 11 or more bytes, got %"
776 rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
777 stream_get(rv
->id
, s
, 7);
778 rv
->metric
= stream_get3(s
);
779 subtlv_len
= stream_getc(s
);
781 format_item_extended_reach(mtid
, (struct isis_item
*)rv
, log
,
784 if ((size_t)len
< ((size_t)11) + subtlv_len
) {
785 sbuf_push(log
, indent
,
786 "Not enough data left for subtlv size %" PRIu8
787 ", there are only %" PRIu8
" bytes left.\n",
788 subtlv_len
, len
- 11);
792 sbuf_push(log
, indent
, "Storing %" PRIu8
" bytes of subtlvs\n",
796 size_t subtlv_start
= stream_get_getp(s
);
798 if (unpack_tlvs(ISIS_CONTEXT_SUBTLV_NE_REACH
, subtlv_len
, s
,
799 log
, NULL
, indent
+ 4)) {
803 stream_set_getp(s
, subtlv_start
);
805 rv
->subtlvs
= XCALLOC(MTYPE_ISIS_TLV
, subtlv_len
);
806 stream_get(rv
->subtlvs
, s
, subtlv_len
);
807 rv
->subtlv_len
= subtlv_len
;
810 append_item(items
, (struct isis_item
*)rv
);
814 free_item_extended_reach((struct isis_item
*)rv
);
819 /* Functions related to TLV 128 (Old-Style) IP Reach */
820 static struct isis_item
*copy_item_oldstyle_ip_reach(struct isis_item
*i
)
822 struct isis_oldstyle_ip_reach
*r
= (struct isis_oldstyle_ip_reach
*)i
;
823 struct isis_oldstyle_ip_reach
*rv
=
824 XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
826 rv
->metric
= r
->metric
;
827 rv
->prefix
= r
->prefix
;
828 return (struct isis_item
*)rv
;
831 static void format_item_oldstyle_ip_reach(uint16_t mtid
, struct isis_item
*i
,
832 struct sbuf
*buf
, int indent
)
834 struct isis_oldstyle_ip_reach
*r
= (struct isis_oldstyle_ip_reach
*)i
;
835 char prefixbuf
[PREFIX2STR_BUFFER
];
837 sbuf_push(buf
, indent
, "IP Reachability: %s (Metric: %" PRIu8
")\n",
838 prefix2str(&r
->prefix
, prefixbuf
, sizeof(prefixbuf
)),
842 static void free_item_oldstyle_ip_reach(struct isis_item
*i
)
844 XFREE(MTYPE_ISIS_TLV
, i
);
847 static int pack_item_oldstyle_ip_reach(struct isis_item
*i
, struct stream
*s
)
849 struct isis_oldstyle_ip_reach
*r
= (struct isis_oldstyle_ip_reach
*)i
;
851 if (STREAM_WRITEABLE(s
) < 12)
854 stream_putc(s
, r
->metric
);
855 stream_putc(s
, 0x80); /* delay metric - unsupported */
856 stream_putc(s
, 0x80); /* expense metric - unsupported */
857 stream_putc(s
, 0x80); /* error metric - unsupported */
858 stream_put(s
, &r
->prefix
.prefix
, 4);
861 masklen2ip(r
->prefix
.prefixlen
, &mask
);
862 stream_put(s
, &mask
, sizeof(mask
));
867 static int unpack_item_oldstyle_ip_reach(uint16_t mtid
, uint8_t len
,
868 struct stream
*s
, struct sbuf
*log
,
869 void *dest
, int indent
)
871 sbuf_push(log
, indent
, "Unpack oldstyle ip reach...\n");
875 "Not enough data left.(Expected 12 bytes of reach information, got %" PRIu8
881 struct isis_oldstyle_ip_reach
*rv
=
882 XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
883 rv
->metric
= stream_getc(s
);
884 if ((rv
->metric
& 0x7f) != rv
->metric
) {
885 sbuf_push(log
, indent
, "Metric has unplausible format\n");
888 stream_forward_getp(s
, 3); /* Skip other metrics */
889 rv
->prefix
.family
= AF_INET
;
890 stream_get(&rv
->prefix
.prefix
, s
, 4);
893 stream_get(&mask
, s
, 4);
894 rv
->prefix
.prefixlen
= ip_masklen(mask
);
896 format_item_oldstyle_ip_reach(mtid
, (struct isis_item
*)rv
, log
,
898 append_item(dest
, (struct isis_item
*)rv
);
903 /* Functions related to TLV 129 protocols supported */
905 static void copy_tlv_protocols_supported(struct isis_protocols_supported
*src
,
906 struct isis_protocols_supported
*dest
)
908 if (!src
->protocols
|| !src
->count
)
910 dest
->count
= src
->count
;
911 dest
->protocols
= XCALLOC(MTYPE_ISIS_TLV
, src
->count
);
912 memcpy(dest
->protocols
, src
->protocols
, src
->count
);
915 static void format_tlv_protocols_supported(struct isis_protocols_supported
*p
,
916 struct sbuf
*buf
, int indent
)
918 if (!p
|| !p
->count
|| !p
->protocols
)
921 sbuf_push(buf
, indent
, "Protocols Supported: ");
922 for (uint8_t i
= 0; i
< p
->count
; i
++) {
923 sbuf_push(buf
, 0, "%s%s", nlpid2str(p
->protocols
[i
]),
924 (i
+ 1 < p
->count
) ? ", " : "");
926 sbuf_push(buf
, 0, "\n");
929 static void free_tlv_protocols_supported(struct isis_protocols_supported
*p
)
931 XFREE(MTYPE_ISIS_TLV
, p
->protocols
);
934 static int pack_tlv_protocols_supported(struct isis_protocols_supported
*p
,
937 if (!p
|| !p
->count
|| !p
->protocols
)
940 if (STREAM_WRITEABLE(s
) < (unsigned)(p
->count
+ 2))
943 stream_putc(s
, ISIS_TLV_PROTOCOLS_SUPPORTED
);
944 stream_putc(s
, p
->count
);
945 stream_put(s
, p
->protocols
, p
->count
);
949 static int unpack_tlv_protocols_supported(enum isis_tlv_context context
,
950 uint8_t tlv_type
, uint8_t tlv_len
,
951 struct stream
*s
, struct sbuf
*log
,
952 void *dest
, int indent
)
954 struct isis_tlvs
*tlvs
= dest
;
956 sbuf_push(log
, indent
, "Unpacking Protocols Supported TLV...\n");
958 sbuf_push(log
, indent
, "WARNING: No protocols included\n");
961 if (tlvs
->protocols_supported
.protocols
) {
964 "WARNING: protocols supported TLV present multiple times.\n");
965 stream_forward_getp(s
, tlv_len
);
969 tlvs
->protocols_supported
.count
= tlv_len
;
970 tlvs
->protocols_supported
.protocols
= XCALLOC(MTYPE_ISIS_TLV
, tlv_len
);
971 stream_get(tlvs
->protocols_supported
.protocols
, s
, tlv_len
);
973 format_tlv_protocols_supported(&tlvs
->protocols_supported
, log
,
978 /* Functions related to TLV 132 IPv4 Interface addresses */
979 static struct isis_item
*copy_item_ipv4_address(struct isis_item
*i
)
981 struct isis_ipv4_address
*a
= (struct isis_ipv4_address
*)i
;
982 struct isis_ipv4_address
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
985 return (struct isis_item
*)rv
;
988 static void format_item_ipv4_address(uint16_t mtid
, struct isis_item
*i
,
989 struct sbuf
*buf
, int indent
)
991 struct isis_ipv4_address
*a
= (struct isis_ipv4_address
*)i
;
992 char addrbuf
[INET_ADDRSTRLEN
];
994 inet_ntop(AF_INET
, &a
->addr
, addrbuf
, sizeof(addrbuf
));
995 sbuf_push(buf
, indent
, "IPv4 Interface Address: %s\n", addrbuf
);
998 static void free_item_ipv4_address(struct isis_item
*i
)
1000 XFREE(MTYPE_ISIS_TLV
, i
);
1003 static int pack_item_ipv4_address(struct isis_item
*i
, struct stream
*s
)
1005 struct isis_ipv4_address
*a
= (struct isis_ipv4_address
*)i
;
1007 if (STREAM_WRITEABLE(s
) < 4)
1010 stream_put(s
, &a
->addr
, 4);
1015 static int unpack_item_ipv4_address(uint16_t mtid
, uint8_t len
,
1016 struct stream
*s
, struct sbuf
*log
,
1017 void *dest
, int indent
)
1019 struct isis_tlvs
*tlvs
= dest
;
1021 sbuf_push(log
, indent
, "Unpack IPv4 Interface address...\n");
1025 "Not enough data left.(Expected 4 bytes of IPv4 address, got %" PRIu8
1031 struct isis_ipv4_address
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1032 stream_get(&rv
->addr
, s
, 4);
1034 format_item_ipv4_address(mtid
, (struct isis_item
*)rv
, log
, indent
+ 2);
1035 append_item(&tlvs
->ipv4_address
, (struct isis_item
*)rv
);
1040 /* Functions related to TLV 232 IPv6 Interface addresses */
1041 static struct isis_item
*copy_item_ipv6_address(struct isis_item
*i
)
1043 struct isis_ipv6_address
*a
= (struct isis_ipv6_address
*)i
;
1044 struct isis_ipv6_address
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1047 return (struct isis_item
*)rv
;
1050 static void format_item_ipv6_address(uint16_t mtid
, struct isis_item
*i
,
1051 struct sbuf
*buf
, int indent
)
1053 struct isis_ipv6_address
*a
= (struct isis_ipv6_address
*)i
;
1054 char addrbuf
[INET6_ADDRSTRLEN
];
1056 inet_ntop(AF_INET6
, &a
->addr
, addrbuf
, sizeof(addrbuf
));
1057 sbuf_push(buf
, indent
, "IPv6 Interface Address: %s\n", addrbuf
);
1060 static void free_item_ipv6_address(struct isis_item
*i
)
1062 XFREE(MTYPE_ISIS_TLV
, i
);
1065 static int pack_item_ipv6_address(struct isis_item
*i
, struct stream
*s
)
1067 struct isis_ipv6_address
*a
= (struct isis_ipv6_address
*)i
;
1069 if (STREAM_WRITEABLE(s
) < 16)
1072 stream_put(s
, &a
->addr
, 16);
1077 static int unpack_item_ipv6_address(uint16_t mtid
, uint8_t len
,
1078 struct stream
*s
, struct sbuf
*log
,
1079 void *dest
, int indent
)
1081 struct isis_tlvs
*tlvs
= dest
;
1083 sbuf_push(log
, indent
, "Unpack IPv6 Interface address...\n");
1087 "Not enough data left.(Expected 16 bytes of IPv6 address, got %" PRIu8
1093 struct isis_ipv6_address
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1094 stream_get(&rv
->addr
, s
, 16);
1096 format_item_ipv6_address(mtid
, (struct isis_item
*)rv
, log
, indent
+ 2);
1097 append_item(&tlvs
->ipv6_address
, (struct isis_item
*)rv
);
1102 /* Functions related to TLV 229 MT Router information */
1103 static struct isis_item
*copy_item_mt_router_info(struct isis_item
*i
)
1105 struct isis_mt_router_info
*info
= (struct isis_mt_router_info
*)i
;
1106 struct isis_mt_router_info
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1108 rv
->overload
= info
->overload
;
1109 rv
->attached
= info
->attached
;
1110 rv
->mtid
= info
->mtid
;
1111 return (struct isis_item
*)rv
;
1114 static void format_item_mt_router_info(uint16_t mtid
, struct isis_item
*i
,
1115 struct sbuf
*buf
, int indent
)
1117 struct isis_mt_router_info
*info
= (struct isis_mt_router_info
*)i
;
1119 sbuf_push(buf
, indent
, "MT Router Info: %s%s%s\n",
1120 isis_mtid2str(info
->mtid
),
1121 info
->overload
? " Overload" : "",
1122 info
->attached
? " Attached" : "");
1125 static void free_item_mt_router_info(struct isis_item
*i
)
1127 XFREE(MTYPE_ISIS_TLV
, i
);
1130 static int pack_item_mt_router_info(struct isis_item
*i
, struct stream
*s
)
1132 struct isis_mt_router_info
*info
= (struct isis_mt_router_info
*)i
;
1134 if (STREAM_WRITEABLE(s
) < 2)
1137 uint16_t entry
= info
->mtid
;
1140 entry
|= ISIS_MT_OL_MASK
;
1142 entry
|= ISIS_MT_AT_MASK
;
1144 stream_putw(s
, entry
);
1149 static int unpack_item_mt_router_info(uint16_t mtid
, uint8_t len
,
1150 struct stream
*s
, struct sbuf
*log
,
1151 void *dest
, int indent
)
1153 struct isis_tlvs
*tlvs
= dest
;
1155 sbuf_push(log
, indent
, "Unpack MT Router info...\n");
1159 "Not enough data left.(Expected 2 bytes of MT info, got %" PRIu8
1165 struct isis_mt_router_info
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1167 uint16_t entry
= stream_getw(s
);
1168 rv
->overload
= entry
& ISIS_MT_OL_MASK
;
1169 rv
->attached
= entry
& ISIS_MT_AT_MASK
;
1170 rv
->mtid
= entry
& ISIS_MT_MASK
;
1172 format_item_mt_router_info(mtid
, (struct isis_item
*)rv
, log
,
1174 append_item(&tlvs
->mt_router_info
, (struct isis_item
*)rv
);
1178 /* Functions related to TLV 134 TE Router ID */
1180 static struct in_addr
*copy_tlv_te_router_id(const struct in_addr
*id
)
1185 struct in_addr
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1186 memcpy(rv
, id
, sizeof(*rv
));
1190 static void format_tlv_te_router_id(const struct in_addr
*id
, struct sbuf
*buf
,
1196 char addrbuf
[INET_ADDRSTRLEN
];
1197 inet_ntop(AF_INET
, id
, addrbuf
, sizeof(addrbuf
));
1198 sbuf_push(buf
, indent
, "TE Router ID: %s\n", addrbuf
);
1201 static void free_tlv_te_router_id(struct in_addr
*id
)
1203 XFREE(MTYPE_ISIS_TLV
, id
);
1206 static int pack_tlv_te_router_id(const struct in_addr
*id
, struct stream
*s
)
1211 if (STREAM_WRITEABLE(s
) < (unsigned)(2 + sizeof(*id
)))
1214 stream_putc(s
, ISIS_TLV_TE_ROUTER_ID
);
1216 stream_put(s
, id
, 4);
1220 static int unpack_tlv_te_router_id(enum isis_tlv_context context
,
1221 uint8_t tlv_type
, uint8_t tlv_len
,
1222 struct stream
*s
, struct sbuf
*log
,
1223 void *dest
, int indent
)
1225 struct isis_tlvs
*tlvs
= dest
;
1227 sbuf_push(log
, indent
, "Unpacking TE Router ID TLV...\n");
1229 sbuf_push(log
, indent
, "WARNING: Length invalid\n");
1233 if (tlvs
->te_router_id
) {
1234 sbuf_push(log
, indent
,
1235 "WARNING: TE Router ID present multiple times.\n");
1236 stream_forward_getp(s
, tlv_len
);
1240 tlvs
->te_router_id
= XCALLOC(MTYPE_ISIS_TLV
, 4);
1241 stream_get(tlvs
->te_router_id
, s
, 4);
1242 format_tlv_te_router_id(tlvs
->te_router_id
, log
, indent
+ 2);
1247 /* Functions related to TLVs 135/235 extended IP reach/MT IP Reach */
1249 static struct isis_item
*copy_item_extended_ip_reach(struct isis_item
*i
)
1251 struct isis_extended_ip_reach
*r
= (struct isis_extended_ip_reach
*)i
;
1252 struct isis_extended_ip_reach
*rv
=
1253 XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1255 rv
->metric
= r
->metric
;
1257 rv
->prefix
= r
->prefix
;
1259 return (struct isis_item
*)rv
;
1262 static void format_item_extended_ip_reach(uint16_t mtid
, struct isis_item
*i
,
1263 struct sbuf
*buf
, int indent
)
1265 struct isis_extended_ip_reach
*r
= (struct isis_extended_ip_reach
*)i
;
1266 char prefixbuf
[PREFIX2STR_BUFFER
];
1268 sbuf_push(buf
, indent
, "%s IP Reachability: %s (Metric: %u)%s",
1269 (mtid
== ISIS_MT_IPV4_UNICAST
) ? "Extended" : "MT",
1270 prefix2str(&r
->prefix
, prefixbuf
, sizeof(prefixbuf
)), r
->metric
,
1271 r
->down
? " Down" : "");
1272 if (mtid
!= ISIS_MT_IPV4_UNICAST
)
1273 sbuf_push(buf
, 0, " %s", isis_mtid2str(mtid
));
1274 sbuf_push(buf
, 0, "\n");
1277 static void free_item_extended_ip_reach(struct isis_item
*i
)
1279 struct isis_extended_ip_reach
*item
=
1280 (struct isis_extended_ip_reach
*)i
;
1281 isis_free_subtlvs(item
->subtlvs
);
1282 XFREE(MTYPE_ISIS_TLV
, item
);
1285 static int pack_item_extended_ip_reach(struct isis_item
*i
, struct stream
*s
)
1287 struct isis_extended_ip_reach
*r
= (struct isis_extended_ip_reach
*)i
;
1290 if (STREAM_WRITEABLE(s
) < 5)
1292 stream_putl(s
, r
->metric
);
1294 control
= r
->down
? ISIS_EXTENDED_IP_REACH_DOWN
: 0;
1295 control
|= r
->prefix
.prefixlen
;
1296 control
|= r
->subtlvs
? ISIS_EXTENDED_IP_REACH_SUBTLV
: 0;
1298 stream_putc(s
, control
);
1300 if (STREAM_WRITEABLE(s
) < (unsigned)PSIZE(r
->prefix
.prefixlen
))
1302 stream_put(s
, &r
->prefix
.prefix
.s_addr
, PSIZE(r
->prefix
.prefixlen
));
1305 return pack_subtlvs(r
->subtlvs
, s
);
1309 static int unpack_item_extended_ip_reach(uint16_t mtid
, uint8_t len
,
1310 struct stream
*s
, struct sbuf
*log
,
1311 void *dest
, int indent
)
1313 struct isis_tlvs
*tlvs
= dest
;
1314 struct isis_extended_ip_reach
*rv
= NULL
;
1316 uint8_t control
, subtlv_len
;
1317 struct isis_item_list
*items
;
1319 if (mtid
== ISIS_MT_IPV4_UNICAST
) {
1320 items
= &tlvs
->extended_ip_reach
;
1322 items
= isis_get_mt_items(&tlvs
->mt_ip_reach
, mtid
);
1325 sbuf_push(log
, indent
, "Unpacking %s IPv4 reachability...\n",
1326 (mtid
== ISIS_MT_IPV4_UNICAST
) ? "extended" : "mt");
1329 if (len
< consume
) {
1330 sbuf_push(log
, indent
,
1331 "Not enough data left. (expected 5 or more bytes, got %" PRIu8
")\n",
1336 rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1338 rv
->metric
= stream_getl(s
);
1339 control
= stream_getc(s
);
1340 rv
->down
= (control
& ISIS_EXTENDED_IP_REACH_DOWN
);
1341 rv
->prefix
.family
= AF_INET
;
1342 rv
->prefix
.prefixlen
= control
& 0x3f;
1343 if (rv
->prefix
.prefixlen
> 32) {
1344 sbuf_push(log
, indent
, "Prefixlen %u is inplausible for IPv4\n",
1345 rv
->prefix
.prefixlen
);
1349 consume
+= PSIZE(rv
->prefix
.prefixlen
);
1350 if (len
< consume
) {
1351 sbuf_push(log
, indent
,
1352 "Expected %u bytes of prefix, but only %u bytes available.\n",
1353 PSIZE(rv
->prefix
.prefixlen
), len
- 5);
1356 stream_get(&rv
->prefix
.prefix
.s_addr
, s
, PSIZE(rv
->prefix
.prefixlen
));
1357 in_addr_t orig_prefix
= rv
->prefix
.prefix
.s_addr
;
1358 apply_mask_ipv4(&rv
->prefix
);
1359 if (orig_prefix
!= rv
->prefix
.prefix
.s_addr
)
1360 sbuf_push(log
, indent
+ 2,
1361 "WARNING: Prefix had hostbits set.\n");
1362 format_item_extended_ip_reach(mtid
, (struct isis_item
*)rv
, log
,
1365 if (control
& ISIS_EXTENDED_IP_REACH_SUBTLV
) {
1367 if (len
< consume
) {
1368 sbuf_push(log
, indent
,
1369 "Expected 1 byte of subtlv len, but no more data present.\n");
1372 subtlv_len
= stream_getc(s
);
1375 sbuf_push(log
, indent
+ 2,
1376 " WARNING: subtlv bit is set, but there are no subtlvs.\n");
1378 consume
+= subtlv_len
;
1379 if (len
< consume
) {
1380 sbuf_push(log
, indent
,
1382 " bytes of subtlvs, but only %u bytes available.\n",
1384 len
- 6 - PSIZE(rv
->prefix
.prefixlen
));
1388 rv
->subtlvs
= isis_alloc_subtlvs(ISIS_CONTEXT_SUBTLV_IP_REACH
);
1389 if (unpack_tlvs(ISIS_CONTEXT_SUBTLV_IP_REACH
, subtlv_len
, s
,
1390 log
, rv
->subtlvs
, indent
+ 4)) {
1395 append_item(items
, (struct isis_item
*)rv
);
1399 free_item_extended_ip_reach((struct isis_item
*)rv
);
1403 /* Functions related to TLV 137 Dynamic Hostname */
1405 static char *copy_tlv_dynamic_hostname(const char *hostname
)
1410 return XSTRDUP(MTYPE_ISIS_TLV
, hostname
);
1413 static void format_tlv_dynamic_hostname(const char *hostname
, struct sbuf
*buf
,
1419 sbuf_push(buf
, indent
, "Hostname: %s\n", hostname
);
1422 static void free_tlv_dynamic_hostname(char *hostname
)
1424 XFREE(MTYPE_ISIS_TLV
, hostname
);
1427 static int pack_tlv_dynamic_hostname(const char *hostname
, struct stream
*s
)
1432 uint8_t name_len
= strlen(hostname
);
1434 if (STREAM_WRITEABLE(s
) < (unsigned)(2 + name_len
))
1437 stream_putc(s
, ISIS_TLV_DYNAMIC_HOSTNAME
);
1438 stream_putc(s
, name_len
);
1439 stream_put(s
, hostname
, name_len
);
1443 static int unpack_tlv_dynamic_hostname(enum isis_tlv_context context
,
1444 uint8_t tlv_type
, uint8_t tlv_len
,
1445 struct stream
*s
, struct sbuf
*log
,
1446 void *dest
, int indent
)
1448 struct isis_tlvs
*tlvs
= dest
;
1450 sbuf_push(log
, indent
, "Unpacking Dynamic Hostname TLV...\n");
1452 sbuf_push(log
, indent
, "WARNING: No hostname included\n");
1456 if (tlvs
->hostname
) {
1457 sbuf_push(log
, indent
,
1458 "WARNING: Hostname present multiple times.\n");
1459 stream_forward_getp(s
, tlv_len
);
1463 tlvs
->hostname
= XCALLOC(MTYPE_ISIS_TLV
, tlv_len
+ 1);
1464 stream_get(tlvs
->hostname
, s
, tlv_len
);
1465 tlvs
->hostname
[tlv_len
] = '\0';
1468 for (uint8_t i
= 0; i
< tlv_len
; i
++) {
1469 if ((unsigned char)tlvs
->hostname
[i
] > 127
1470 || !isprint((int)tlvs
->hostname
[i
])) {
1472 tlvs
->hostname
[i
] = '?';
1478 "WARNING: Hostname contained non-printable/non-ascii characters.\n");
1484 /* Functions related to TLV 150 Spine-Leaf-Extension */
1486 static struct isis_spine_leaf
*copy_tlv_spine_leaf(
1487 const struct isis_spine_leaf
*spine_leaf
)
1492 struct isis_spine_leaf
*rv
= XMALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1493 memcpy(rv
, spine_leaf
, sizeof(*rv
));
1498 static void format_tlv_spine_leaf(const struct isis_spine_leaf
*spine_leaf
,
1499 struct sbuf
*buf
, int indent
)
1504 sbuf_push(buf
, indent
, "Spine-Leaf-Extension:\n");
1505 if (spine_leaf
->has_tier
) {
1506 if (spine_leaf
->tier
== ISIS_TIER_UNDEFINED
) {
1507 sbuf_push(buf
, indent
, " Tier: undefined\n");
1509 sbuf_push(buf
, indent
, " Tier: %" PRIu8
"\n",
1514 sbuf_push(buf
, indent
, " Flags:%s%s%s\n",
1515 spine_leaf
->is_leaf
? " LEAF" : "",
1516 spine_leaf
->is_spine
? " SPINE" : "",
1517 spine_leaf
->is_backup
? " BACKUP" : "");
1521 static void free_tlv_spine_leaf(struct isis_spine_leaf
*spine_leaf
)
1523 XFREE(MTYPE_ISIS_TLV
, spine_leaf
);
1526 #define ISIS_SPINE_LEAF_FLAG_TIER 0x08
1527 #define ISIS_SPINE_LEAF_FLAG_BACKUP 0x04
1528 #define ISIS_SPINE_LEAF_FLAG_SPINE 0x02
1529 #define ISIS_SPINE_LEAF_FLAG_LEAF 0x01
1531 static int pack_tlv_spine_leaf(const struct isis_spine_leaf
*spine_leaf
,
1537 uint8_t tlv_len
= 2;
1539 if (STREAM_WRITEABLE(s
) < (unsigned)(2 + tlv_len
))
1542 stream_putc(s
, ISIS_TLV_SPINE_LEAF_EXT
);
1543 stream_putc(s
, tlv_len
);
1545 uint16_t spine_leaf_flags
= 0;
1547 if (spine_leaf
->has_tier
) {
1548 spine_leaf_flags
|= ISIS_SPINE_LEAF_FLAG_TIER
;
1549 spine_leaf_flags
|= spine_leaf
->tier
<< 12;
1552 if (spine_leaf
->is_leaf
)
1553 spine_leaf_flags
|= ISIS_SPINE_LEAF_FLAG_LEAF
;
1555 if (spine_leaf
->is_spine
)
1556 spine_leaf_flags
|= ISIS_SPINE_LEAF_FLAG_SPINE
;
1558 if (spine_leaf
->is_backup
)
1559 spine_leaf_flags
|= ISIS_SPINE_LEAF_FLAG_BACKUP
;
1561 stream_putw(s
, spine_leaf_flags
);
1566 static int unpack_tlv_spine_leaf(enum isis_tlv_context context
,
1567 uint8_t tlv_type
, uint8_t tlv_len
,
1568 struct stream
*s
, struct sbuf
*log
,
1569 void *dest
, int indent
)
1571 struct isis_tlvs
*tlvs
= dest
;
1573 sbuf_push(log
, indent
, "Unpacking Spine Leaf Extension TLV...\n");
1575 sbuf_push(log
, indent
, "WARNING: Unexepected TLV size\n");
1576 stream_forward_getp(s
, tlv_len
);
1580 if (tlvs
->spine_leaf
) {
1581 sbuf_push(log
, indent
,
1582 "WARNING: Spine Leaf Extension TLV present multiple times.\n");
1583 stream_forward_getp(s
, tlv_len
);
1587 tlvs
->spine_leaf
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*tlvs
->spine_leaf
));
1589 uint16_t spine_leaf_flags
= stream_getw(s
);
1591 if (spine_leaf_flags
& ISIS_SPINE_LEAF_FLAG_TIER
) {
1592 tlvs
->spine_leaf
->has_tier
= true;
1593 tlvs
->spine_leaf
->tier
= spine_leaf_flags
>> 12;
1596 tlvs
->spine_leaf
->is_leaf
= spine_leaf_flags
& ISIS_SPINE_LEAF_FLAG_LEAF
;
1597 tlvs
->spine_leaf
->is_spine
= spine_leaf_flags
& ISIS_SPINE_LEAF_FLAG_SPINE
;
1598 tlvs
->spine_leaf
->is_backup
= spine_leaf_flags
& ISIS_SPINE_LEAF_FLAG_BACKUP
;
1600 stream_forward_getp(s
, tlv_len
- 2);
1604 /* Functions related to TLV 240 P2P Three-Way Adjacency */
1606 const char *isis_threeway_state_name(enum isis_threeway_state state
)
1609 case ISIS_THREEWAY_DOWN
:
1611 case ISIS_THREEWAY_INITIALIZING
:
1612 return "Initializing";
1613 case ISIS_THREEWAY_UP
:
1620 static struct isis_threeway_adj
*copy_tlv_threeway_adj(
1621 const struct isis_threeway_adj
*threeway_adj
)
1626 struct isis_threeway_adj
*rv
= XMALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1627 memcpy(rv
, threeway_adj
, sizeof(*rv
));
1632 static void format_tlv_threeway_adj(const struct isis_threeway_adj
*threeway_adj
,
1633 struct sbuf
*buf
, int indent
)
1638 sbuf_push(buf
, indent
, "P2P Three-Way Adjacency:\n");
1639 sbuf_push(buf
, indent
, " State: %s (%d)\n",
1640 isis_threeway_state_name(threeway_adj
->state
),
1641 threeway_adj
->state
);
1642 sbuf_push(buf
, indent
, " Extended Local Circuit ID: %" PRIu32
"\n",
1643 threeway_adj
->local_circuit_id
);
1644 if (!threeway_adj
->neighbor_set
)
1647 sbuf_push(buf
, indent
, " Neighbor System ID: %s\n",
1648 isis_format_id(threeway_adj
->neighbor_id
, 6));
1649 sbuf_push(buf
, indent
, " Neighbor Extended Circuit ID: %" PRIu32
"\n",
1650 threeway_adj
->neighbor_circuit_id
);
1653 static void free_tlv_threeway_adj(struct isis_threeway_adj
*threeway_adj
)
1655 XFREE(MTYPE_ISIS_TLV
, threeway_adj
);
1658 static int pack_tlv_threeway_adj(const struct isis_threeway_adj
*threeway_adj
,
1664 uint8_t tlv_len
= (threeway_adj
->neighbor_set
) ? 15 : 5;
1666 if (STREAM_WRITEABLE(s
) < (unsigned)(2 + tlv_len
))
1669 stream_putc(s
, ISIS_TLV_THREE_WAY_ADJ
);
1670 stream_putc(s
, tlv_len
);
1671 stream_putc(s
, threeway_adj
->state
);
1672 stream_putl(s
, threeway_adj
->local_circuit_id
);
1674 if (threeway_adj
->neighbor_set
) {
1675 stream_put(s
, threeway_adj
->neighbor_id
, 6);
1676 stream_putl(s
, threeway_adj
->neighbor_circuit_id
);
1682 static int unpack_tlv_threeway_adj(enum isis_tlv_context context
,
1683 uint8_t tlv_type
, uint8_t tlv_len
,
1684 struct stream
*s
, struct sbuf
*log
,
1685 void *dest
, int indent
)
1687 struct isis_tlvs
*tlvs
= dest
;
1689 sbuf_push(log
, indent
, "Unpacking P2P Three-Way Adjacency TLV...\n");
1690 if (tlv_len
!= 5 && tlv_len
!= 15) {
1691 sbuf_push(log
, indent
, "WARNING: Unexepected TLV size\n");
1692 stream_forward_getp(s
, tlv_len
);
1696 if (tlvs
->threeway_adj
) {
1697 sbuf_push(log
, indent
,
1698 "WARNING: P2P Three-Way Adjacency TLV present multiple times.\n");
1699 stream_forward_getp(s
, tlv_len
);
1703 tlvs
->threeway_adj
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*tlvs
->threeway_adj
));
1705 tlvs
->threeway_adj
->state
= stream_getc(s
);
1706 tlvs
->threeway_adj
->local_circuit_id
= stream_getl(s
);
1708 if (tlv_len
== 15) {
1709 tlvs
->threeway_adj
->neighbor_set
= true;
1710 stream_get(tlvs
->threeway_adj
->neighbor_id
, s
, 6);
1711 tlvs
->threeway_adj
->neighbor_circuit_id
= stream_getl(s
);
1717 /* Functions related to TLVs 236/237 IPv6/MT-IPv6 reach */
1719 static struct isis_item
*copy_item_ipv6_reach(struct isis_item
*i
)
1721 struct isis_ipv6_reach
*r
= (struct isis_ipv6_reach
*)i
;
1722 struct isis_ipv6_reach
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1723 rv
->metric
= r
->metric
;
1725 rv
->external
= r
->external
;
1726 rv
->prefix
= r
->prefix
;
1727 rv
->subtlvs
= copy_subtlvs(r
->subtlvs
);
1729 return (struct isis_item
*)rv
;
1732 static void format_item_ipv6_reach(uint16_t mtid
, struct isis_item
*i
,
1733 struct sbuf
*buf
, int indent
)
1735 struct isis_ipv6_reach
*r
= (struct isis_ipv6_reach
*)i
;
1736 char prefixbuf
[PREFIX2STR_BUFFER
];
1738 sbuf_push(buf
, indent
, "%sIPv6 Reachability: %s (Metric: %u)%s%s",
1739 (mtid
== ISIS_MT_IPV4_UNICAST
) ? "" : "MT ",
1740 prefix2str(&r
->prefix
, prefixbuf
, sizeof(prefixbuf
)),
1742 r
->down
? " Down" : "",
1743 r
->external
? " External" : "");
1744 if (mtid
!= ISIS_MT_IPV4_UNICAST
)
1745 sbuf_push(buf
, 0, " %s", isis_mtid2str(mtid
));
1746 sbuf_push(buf
, 0, "\n");
1749 sbuf_push(buf
, indent
, " Subtlvs:\n");
1750 format_subtlvs(r
->subtlvs
, buf
, indent
+ 4);
1754 static void free_item_ipv6_reach(struct isis_item
*i
)
1756 struct isis_ipv6_reach
*item
= (struct isis_ipv6_reach
*)i
;
1758 isis_free_subtlvs(item
->subtlvs
);
1759 XFREE(MTYPE_ISIS_TLV
, item
);
1762 static int pack_item_ipv6_reach(struct isis_item
*i
, struct stream
*s
)
1764 struct isis_ipv6_reach
*r
= (struct isis_ipv6_reach
*)i
;
1767 if (STREAM_WRITEABLE(s
) < 6)
1769 stream_putl(s
, r
->metric
);
1771 control
= r
->down
? ISIS_IPV6_REACH_DOWN
: 0;
1772 control
|= r
->external
? ISIS_IPV6_REACH_EXTERNAL
: 0;
1773 control
|= r
->subtlvs
? ISIS_IPV6_REACH_SUBTLV
: 0;
1775 stream_putc(s
, control
);
1776 stream_putc(s
, r
->prefix
.prefixlen
);
1778 if (STREAM_WRITEABLE(s
) < (unsigned)PSIZE(r
->prefix
.prefixlen
))
1780 stream_put(s
, &r
->prefix
.prefix
.s6_addr
, PSIZE(r
->prefix
.prefixlen
));
1783 return pack_subtlvs(r
->subtlvs
, s
);
1788 static int unpack_item_ipv6_reach(uint16_t mtid
, uint8_t len
, struct stream
*s
,
1789 struct sbuf
*log
, void *dest
, int indent
)
1791 struct isis_tlvs
*tlvs
= dest
;
1792 struct isis_ipv6_reach
*rv
= NULL
;
1794 uint8_t control
, subtlv_len
;
1795 struct isis_item_list
*items
;
1797 if (mtid
== ISIS_MT_IPV4_UNICAST
) {
1798 items
= &tlvs
->ipv6_reach
;
1800 items
= isis_get_mt_items(&tlvs
->mt_ipv6_reach
, mtid
);
1803 sbuf_push(log
, indent
, "Unpacking %sIPv6 reachability...\n",
1804 (mtid
== ISIS_MT_IPV4_UNICAST
) ? "" : "mt ");
1806 if (len
< consume
) {
1807 sbuf_push(log
, indent
,
1808 "Not enough data left. (expected 6 or more bytes, got %"
1814 rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1816 rv
->metric
= stream_getl(s
);
1817 control
= stream_getc(s
);
1818 rv
->down
= (control
& ISIS_IPV6_REACH_DOWN
);
1819 rv
->external
= (control
& ISIS_IPV6_REACH_EXTERNAL
);
1821 rv
->prefix
.family
= AF_INET6
;
1822 rv
->prefix
.prefixlen
= stream_getc(s
);
1823 if (rv
->prefix
.prefixlen
> 128) {
1824 sbuf_push(log
, indent
, "Prefixlen %u is inplausible for IPv6\n",
1825 rv
->prefix
.prefixlen
);
1829 consume
+= PSIZE(rv
->prefix
.prefixlen
);
1830 if (len
< consume
) {
1831 sbuf_push(log
, indent
,
1832 "Expected %u bytes of prefix, but only %u bytes available.\n",
1833 PSIZE(rv
->prefix
.prefixlen
), len
- 6);
1836 stream_get(&rv
->prefix
.prefix
.s6_addr
, s
, PSIZE(rv
->prefix
.prefixlen
));
1837 struct in6_addr orig_prefix
= rv
->prefix
.prefix
;
1838 apply_mask_ipv6(&rv
->prefix
);
1839 if (memcmp(&orig_prefix
, &rv
->prefix
.prefix
, sizeof(orig_prefix
)))
1840 sbuf_push(log
, indent
+ 2,
1841 "WARNING: Prefix had hostbits set.\n");
1842 format_item_ipv6_reach(mtid
, (struct isis_item
*)rv
, log
, indent
+ 2);
1844 if (control
& ISIS_IPV6_REACH_SUBTLV
) {
1846 if (len
< consume
) {
1847 sbuf_push(log
, indent
,
1848 "Expected 1 byte of subtlv len, but no more data persent.\n");
1851 subtlv_len
= stream_getc(s
);
1854 sbuf_push(log
, indent
+ 2,
1855 " WARNING: subtlv bit set, but there are no subtlvs.\n");
1857 consume
+= subtlv_len
;
1858 if (len
< consume
) {
1859 sbuf_push(log
, indent
,
1861 " bytes of subtlvs, but only %u bytes available.\n",
1863 len
- 6 - PSIZE(rv
->prefix
.prefixlen
));
1867 rv
->subtlvs
= isis_alloc_subtlvs(ISIS_CONTEXT_SUBTLV_IPV6_REACH
);
1868 if (unpack_tlvs(ISIS_CONTEXT_SUBTLV_IPV6_REACH
, subtlv_len
, s
,
1869 log
, rv
->subtlvs
, indent
+ 4)) {
1874 append_item(items
, (struct isis_item
*)rv
);
1878 free_item_ipv6_reach((struct isis_item
*)rv
);
1882 /* Functions related to TLV 10 Authentication */
1883 static struct isis_item
*copy_item_auth(struct isis_item
*i
)
1885 struct isis_auth
*auth
= (struct isis_auth
*)i
;
1886 struct isis_auth
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1888 rv
->type
= auth
->type
;
1889 rv
->length
= auth
->length
;
1890 memcpy(rv
->value
, auth
->value
, sizeof(rv
->value
));
1891 return (struct isis_item
*)rv
;
1894 static void format_item_auth(uint16_t mtid
, struct isis_item
*i
,
1895 struct sbuf
*buf
, int indent
)
1897 struct isis_auth
*auth
= (struct isis_auth
*)i
;
1900 sbuf_push(buf
, indent
, "Authentication:\n");
1901 switch (auth
->type
) {
1902 case ISIS_PASSWD_TYPE_CLEARTXT
:
1903 zlog_sanitize(obuf
, sizeof(obuf
), auth
->value
, auth
->length
);
1904 sbuf_push(buf
, indent
, " Password: %s\n", obuf
);
1906 case ISIS_PASSWD_TYPE_HMAC_MD5
:
1907 for (unsigned int j
= 0; j
< 16; j
++) {
1908 snprintf(obuf
+ 2 * j
, sizeof(obuf
) - 2 * j
,
1909 "%02" PRIx8
, auth
->value
[j
]);
1911 sbuf_push(buf
, indent
, " HMAC-MD5: %s\n", obuf
);
1914 sbuf_push(buf
, indent
, " Unknown (%" PRIu8
")\n", auth
->type
);
1919 static void free_item_auth(struct isis_item
*i
)
1921 XFREE(MTYPE_ISIS_TLV
, i
);
1924 static int pack_item_auth(struct isis_item
*i
, struct stream
*s
)
1926 struct isis_auth
*auth
= (struct isis_auth
*)i
;
1928 if (STREAM_WRITEABLE(s
) < 1)
1930 stream_putc(s
, auth
->type
);
1932 switch (auth
->type
) {
1933 case ISIS_PASSWD_TYPE_CLEARTXT
:
1934 if (STREAM_WRITEABLE(s
) < auth
->length
)
1936 stream_put(s
, auth
->passwd
, auth
->length
);
1938 case ISIS_PASSWD_TYPE_HMAC_MD5
:
1939 if (STREAM_WRITEABLE(s
) < 16)
1941 auth
->offset
= stream_get_endp(s
);
1942 stream_put(s
, NULL
, 16);
1951 static int unpack_item_auth(uint16_t mtid
, uint8_t len
, struct stream
*s
,
1952 struct sbuf
*log
, void *dest
, int indent
)
1954 struct isis_tlvs
*tlvs
= dest
;
1956 sbuf_push(log
, indent
, "Unpack Auth TLV...\n");
1960 "Not enough data left.(Expected 1 bytes of auth type, got %" PRIu8
1966 struct isis_auth
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1968 rv
->type
= stream_getc(s
);
1969 rv
->length
= len
- 1;
1971 if (rv
->type
== ISIS_PASSWD_TYPE_HMAC_MD5
&& rv
->length
!= 16) {
1974 "Unexpected auth length for HMAC-MD5 (expected 16, got %" PRIu8
1977 XFREE(MTYPE_ISIS_TLV
, rv
);
1981 rv
->offset
= stream_get_getp(s
);
1982 stream_get(rv
->value
, s
, rv
->length
);
1983 format_item_auth(mtid
, (struct isis_item
*)rv
, log
, indent
+ 2);
1984 append_item(&tlvs
->isis_auth
, (struct isis_item
*)rv
);
1988 /* Functions related to TLV 13 Purge Originator */
1990 static struct isis_purge_originator
*copy_tlv_purge_originator(
1991 struct isis_purge_originator
*poi
)
1996 struct isis_purge_originator
*rv
;
1998 rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
1999 rv
->sender_set
= poi
->sender_set
;
2000 memcpy(rv
->generator
, poi
->generator
, sizeof(rv
->generator
));
2001 if (poi
->sender_set
)
2002 memcpy(rv
->sender
, poi
->sender
, sizeof(rv
->sender
));
2006 static void format_tlv_purge_originator(struct isis_purge_originator
*poi
,
2007 struct sbuf
*buf
, int indent
)
2012 sbuf_push(buf
, indent
, "Purge Originator Identification:\n");
2013 sbuf_push(buf
, indent
, " Generator: %s\n",
2014 isis_format_id(poi
->generator
, sizeof(poi
->generator
)));
2015 if (poi
->sender_set
) {
2016 sbuf_push(buf
, indent
, " Received-From: %s\n",
2017 isis_format_id(poi
->sender
, sizeof(poi
->sender
)));
2021 static void free_tlv_purge_originator(struct isis_purge_originator
*poi
)
2023 XFREE(MTYPE_ISIS_TLV
, poi
);
2026 static int pack_tlv_purge_originator(struct isis_purge_originator
*poi
,
2032 uint8_t data_len
= 1 + sizeof(poi
->generator
);
2034 if (poi
->sender_set
)
2035 data_len
+= sizeof(poi
->sender
);
2037 if (STREAM_WRITEABLE(s
) < (unsigned)(2 + data_len
))
2040 stream_putc(s
, ISIS_TLV_PURGE_ORIGINATOR
);
2041 stream_putc(s
, data_len
);
2042 stream_putc(s
, poi
->sender_set
? 2 : 1);
2043 stream_put(s
, poi
->generator
, sizeof(poi
->generator
));
2044 if (poi
->sender_set
)
2045 stream_put(s
, poi
->sender
, sizeof(poi
->sender
));
2049 static int unpack_tlv_purge_originator(enum isis_tlv_context context
,
2050 uint8_t tlv_type
, uint8_t tlv_len
,
2051 struct stream
*s
, struct sbuf
*log
,
2052 void *dest
, int indent
)
2054 struct isis_tlvs
*tlvs
= dest
;
2055 struct isis_purge_originator poi
= {};
2057 sbuf_push(log
, indent
, "Unpacking Purge Originator Identification TLV...\n");
2059 sbuf_push(log
, indent
, "Not enough data left. (Expected at least 7 bytes, got %"
2060 PRIu8
")\n", tlv_len
);
2064 uint8_t number_of_ids
= stream_getc(s
);
2066 if (number_of_ids
== 1) {
2067 poi
.sender_set
= false;
2068 } else if (number_of_ids
== 2) {
2069 poi
.sender_set
= true;
2071 sbuf_push(log
, indent
, "Got invalid value for number of system IDs: %"
2072 PRIu8
")\n", number_of_ids
);
2076 if (tlv_len
!= 1 + 6 * number_of_ids
) {
2077 sbuf_push(log
, indent
, "Incorrect tlv len for number of IDs.\n");
2081 stream_get(poi
.generator
, s
, sizeof(poi
.generator
));
2083 stream_get(poi
.sender
, s
, sizeof(poi
.sender
));
2085 if (tlvs
->purge_originator
) {
2086 sbuf_push(log
, indent
,
2087 "WARNING: Purge originator present multiple times, ignoring.\n");
2091 tlvs
->purge_originator
= copy_tlv_purge_originator(&poi
);
2096 /* Functions relating to item TLVs */
2098 static void init_item_list(struct isis_item_list
*items
)
2101 items
->tail
= &items
->head
;
2105 static struct isis_item
*copy_item(enum isis_tlv_context context
,
2106 enum isis_tlv_type type
,
2107 struct isis_item
*item
)
2109 const struct tlv_ops
*ops
= tlv_table
[context
][type
];
2111 if (ops
&& ops
->copy_item
)
2112 return ops
->copy_item(item
);
2114 assert(!"Unknown item tlv type!");
2118 static void copy_items(enum isis_tlv_context context
, enum isis_tlv_type type
,
2119 struct isis_item_list
*src
, struct isis_item_list
*dest
)
2121 struct isis_item
*item
;
2123 init_item_list(dest
);
2125 for (item
= src
->head
; item
; item
= item
->next
) {
2126 append_item(dest
, copy_item(context
, type
, item
));
2130 static void format_item(uint16_t mtid
, enum isis_tlv_context context
,
2131 enum isis_tlv_type type
, struct isis_item
*i
,
2132 struct sbuf
*buf
, int indent
)
2134 const struct tlv_ops
*ops
= tlv_table
[context
][type
];
2136 if (ops
&& ops
->format_item
) {
2137 ops
->format_item(mtid
, i
, buf
, indent
);
2141 assert(!"Unknown item tlv type!");
2144 static void format_items_(uint16_t mtid
, enum isis_tlv_context context
,
2145 enum isis_tlv_type type
, struct isis_item_list
*items
,
2146 struct sbuf
*buf
, int indent
)
2148 struct isis_item
*i
;
2150 for (i
= items
->head
; i
; i
= i
->next
)
2151 format_item(mtid
, context
, type
, i
, buf
, indent
);
2154 static void free_item(enum isis_tlv_context tlv_context
,
2155 enum isis_tlv_type tlv_type
, struct isis_item
*item
)
2157 const struct tlv_ops
*ops
= tlv_table
[tlv_context
][tlv_type
];
2159 if (ops
&& ops
->free_item
) {
2160 ops
->free_item(item
);
2164 assert(!"Unknown item tlv type!");
2167 static void free_items(enum isis_tlv_context context
, enum isis_tlv_type type
,
2168 struct isis_item_list
*items
)
2170 struct isis_item
*item
, *next_item
;
2172 for (item
= items
->head
; item
; item
= next_item
) {
2173 next_item
= item
->next
;
2174 free_item(context
, type
, item
);
2178 static int pack_item(enum isis_tlv_context context
, enum isis_tlv_type type
,
2179 struct isis_item
*i
, struct stream
*s
,
2180 struct isis_tlvs
**fragment_tlvs
,
2181 struct pack_order_entry
*pe
, uint16_t mtid
)
2183 const struct tlv_ops
*ops
= tlv_table
[context
][type
];
2185 if (ops
&& ops
->pack_item
) {
2186 return ops
->pack_item(i
, s
);
2189 assert(!"Unknown item tlv type!");
2193 static void add_item_to_fragment(struct isis_item
*i
, struct pack_order_entry
*pe
,
2194 struct isis_tlvs
*fragment_tlvs
, uint16_t mtid
)
2196 struct isis_item_list
*l
;
2198 if (pe
->how_to_pack
== ISIS_ITEMS
) {
2199 l
= (struct isis_item_list
*)(((char *)fragment_tlvs
) + pe
->what_to_pack
);
2201 struct isis_mt_item_list
*m
;
2202 m
= (struct isis_mt_item_list
*)(((char *)fragment_tlvs
) + pe
->what_to_pack
);
2203 l
= isis_get_mt_items(m
, mtid
);
2206 append_item(l
, copy_item(pe
->context
, pe
->type
, i
));
2209 static int pack_items_(uint16_t mtid
, enum isis_tlv_context context
,
2210 enum isis_tlv_type type
, struct isis_item_list
*items
,
2211 struct stream
*s
, struct isis_tlvs
**fragment_tlvs
,
2212 struct pack_order_entry
*pe
,
2213 struct isis_tlvs
*(*new_fragment
)(struct list
*l
),
2214 struct list
*new_fragment_arg
)
2216 size_t len_pos
, last_len
, len
;
2217 struct isis_item
*item
= NULL
;
2224 if (STREAM_WRITEABLE(s
) < 2)
2227 stream_putc(s
, type
);
2228 len_pos
= stream_get_endp(s
);
2229 stream_putc(s
, 0); /* Put 0 as length for now */
2231 if (context
== ISIS_CONTEXT_LSP
&& IS_COMPAT_MT_TLV(type
)
2232 && mtid
!= ISIS_MT_IPV4_UNICAST
) {
2233 if (STREAM_WRITEABLE(s
) < 2)
2235 stream_putw(s
, mtid
);
2238 if (context
== ISIS_CONTEXT_LSP
&& type
== ISIS_TLV_OLDSTYLE_REACH
) {
2239 if (STREAM_WRITEABLE(s
) < 1)
2241 stream_putc(s
, 0); /* Virtual flag is set to 0 */
2245 for (item
= item
? item
: items
->head
; item
; item
= item
->next
) {
2246 rv
= pack_item(context
, type
, item
, s
, fragment_tlvs
, pe
, mtid
);
2250 len
= stream_get_endp(s
) - len_pos
- 1;
2252 /* Multiple auths don't go into one TLV, so always break */
2253 if (context
== ISIS_CONTEXT_LSP
&& type
== ISIS_TLV_AUTH
) {
2258 /* Multiple prefix-sids don't go into one TLV, so always break */
2259 if (type
== ISIS_SUBTLV_PREFIX_SID
2260 && (context
== ISIS_CONTEXT_SUBTLV_IP_REACH
2261 || context
== ISIS_CONTEXT_SUBTLV_IPV6_REACH
)) {
2267 if (!last_len
) /* strange, not a single item fit */
2269 /* drop last tlv, otherwise, its too long */
2270 stream_set_endp(s
, len_pos
+ 1 + last_len
);
2276 add_item_to_fragment(item
, pe
, *fragment_tlvs
, mtid
);
2281 stream_putc_at(s
, len_pos
, len
);
2290 *fragment_tlvs
= new_fragment(new_fragment_arg
);
2293 #define pack_items(...) pack_items_(ISIS_MT_IPV4_UNICAST, __VA_ARGS__)
2295 static void append_item(struct isis_item_list
*dest
, struct isis_item
*item
)
2298 dest
->tail
= &(*dest
->tail
)->next
;
2302 static struct isis_item
*last_item(struct isis_item_list
*list
)
2304 return container_of(list
->tail
, struct isis_item
, next
);
2307 static int unpack_item(uint16_t mtid
, enum isis_tlv_context context
,
2308 uint8_t tlv_type
, uint8_t len
, struct stream
*s
,
2309 struct sbuf
*log
, void *dest
, int indent
)
2311 const struct tlv_ops
*ops
= tlv_table
[context
][tlv_type
];
2313 if (ops
&& ops
->unpack_item
)
2314 return ops
->unpack_item(mtid
, len
, s
, log
, dest
, indent
);
2316 assert(!"Unknown item tlv type!");
2317 sbuf_push(log
, indent
, "Unknown item tlv type!\n");
2321 static int unpack_tlv_with_items(enum isis_tlv_context context
,
2322 uint8_t tlv_type
, uint8_t tlv_len
,
2323 struct stream
*s
, struct sbuf
*log
, void *dest
,
2331 tlv_start
= stream_get_getp(s
);
2334 if (context
== ISIS_CONTEXT_LSP
&& IS_COMPAT_MT_TLV(tlv_type
)) {
2336 sbuf_push(log
, indent
,
2337 "TLV is too short to contain MTID\n");
2340 mtid
= stream_getw(s
) & ISIS_MT_MASK
;
2342 sbuf_push(log
, indent
, "Unpacking as MT %s item TLV...\n",
2343 isis_mtid2str(mtid
));
2345 sbuf_push(log
, indent
, "Unpacking as item TLV...\n");
2346 mtid
= ISIS_MT_IPV4_UNICAST
;
2349 if (context
== ISIS_CONTEXT_LSP
2350 && tlv_type
== ISIS_TLV_OLDSTYLE_REACH
) {
2351 if (tlv_len
- tlv_pos
< 1) {
2352 sbuf_push(log
, indent
,
2353 "TLV is too short for old style reach\n");
2356 stream_forward_getp(s
, 1);
2360 if (context
== ISIS_CONTEXT_LSP
2361 && tlv_type
== ISIS_TLV_OLDSTYLE_IP_REACH
) {
2362 struct isis_tlvs
*tlvs
= dest
;
2363 dest
= &tlvs
->oldstyle_ip_reach
;
2364 } else if (context
== ISIS_CONTEXT_LSP
2365 && tlv_type
== ISIS_TLV_OLDSTYLE_IP_REACH_EXT
) {
2366 struct isis_tlvs
*tlvs
= dest
;
2367 dest
= &tlvs
->oldstyle_ip_reach_ext
;
2370 if (context
== ISIS_CONTEXT_LSP
2371 && tlv_type
== ISIS_TLV_MT_ROUTER_INFO
) {
2372 struct isis_tlvs
*tlvs
= dest
;
2373 tlvs
->mt_router_info_empty
= (tlv_pos
>= (size_t)tlv_len
);
2376 while (tlv_pos
< (size_t)tlv_len
) {
2377 rv
= unpack_item(mtid
, context
, tlv_type
, tlv_len
- tlv_pos
, s
,
2378 log
, dest
, indent
+ 2);
2382 tlv_pos
= stream_get_getp(s
) - tlv_start
;
2388 /* Functions to manipulate mt_item_lists */
2390 static int isis_mt_item_list_cmp(const struct isis_item_list
*a
,
2391 const struct isis_item_list
*b
)
2393 if (a
->mtid
< b
->mtid
)
2395 if (a
->mtid
> b
->mtid
)
2400 RB_PROTOTYPE(isis_mt_item_list
, isis_item_list
, mt_tree
, isis_mt_item_list_cmp
);
2401 RB_GENERATE(isis_mt_item_list
, isis_item_list
, mt_tree
, isis_mt_item_list_cmp
);
2403 struct isis_item_list
*isis_get_mt_items(struct isis_mt_item_list
*m
,
2406 struct isis_item_list
*rv
;
2408 rv
= isis_lookup_mt_items(m
, mtid
);
2410 rv
= XCALLOC(MTYPE_ISIS_MT_ITEM_LIST
, sizeof(*rv
));
2413 RB_INSERT(isis_mt_item_list
, m
, rv
);
2419 struct isis_item_list
*isis_lookup_mt_items(struct isis_mt_item_list
*m
,
2422 struct isis_item_list key
= {.mtid
= mtid
};
2424 return RB_FIND(isis_mt_item_list
, m
, &key
);
2427 static void free_mt_items(enum isis_tlv_context context
,
2428 enum isis_tlv_type type
, struct isis_mt_item_list
*m
)
2430 struct isis_item_list
*n
, *nnext
;
2432 RB_FOREACH_SAFE (n
, isis_mt_item_list
, m
, nnext
) {
2433 free_items(context
, type
, n
);
2434 RB_REMOVE(isis_mt_item_list
, m
, n
);
2435 XFREE(MTYPE_ISIS_MT_ITEM_LIST
, n
);
2439 static void format_mt_items(enum isis_tlv_context context
,
2440 enum isis_tlv_type type
,
2441 struct isis_mt_item_list
*m
, struct sbuf
*buf
,
2444 struct isis_item_list
*n
;
2446 RB_FOREACH (n
, isis_mt_item_list
, m
) {
2447 format_items_(n
->mtid
, context
, type
, n
, buf
, indent
);
2451 static int pack_mt_items(enum isis_tlv_context context
, enum isis_tlv_type type
,
2452 struct isis_mt_item_list
*m
, struct stream
*s
,
2453 struct isis_tlvs
**fragment_tlvs
,
2454 struct pack_order_entry
*pe
,
2455 struct isis_tlvs
*(*new_fragment
)(struct list
*l
),
2456 struct list
*new_fragment_arg
)
2458 struct isis_item_list
*n
;
2460 RB_FOREACH (n
, isis_mt_item_list
, m
) {
2463 rv
= pack_items_(n
->mtid
, context
, type
, n
, s
, fragment_tlvs
,
2464 pe
, new_fragment
, new_fragment_arg
);
2472 static void copy_mt_items(enum isis_tlv_context context
,
2473 enum isis_tlv_type type
,
2474 struct isis_mt_item_list
*src
,
2475 struct isis_mt_item_list
*dest
)
2477 struct isis_item_list
*n
;
2479 RB_INIT(isis_mt_item_list
, dest
);
2481 RB_FOREACH (n
, isis_mt_item_list
, src
) {
2482 copy_items(context
, type
, n
, isis_get_mt_items(dest
, n
->mtid
));
2486 /* Functions related to tlvs in general */
2488 struct isis_tlvs
*isis_alloc_tlvs(void)
2490 struct isis_tlvs
*result
;
2492 result
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*result
));
2494 init_item_list(&result
->isis_auth
);
2495 init_item_list(&result
->area_addresses
);
2496 init_item_list(&result
->mt_router_info
);
2497 init_item_list(&result
->oldstyle_reach
);
2498 init_item_list(&result
->lan_neighbor
);
2499 init_item_list(&result
->lsp_entries
);
2500 init_item_list(&result
->extended_reach
);
2501 RB_INIT(isis_mt_item_list
, &result
->mt_reach
);
2502 init_item_list(&result
->oldstyle_ip_reach
);
2503 init_item_list(&result
->oldstyle_ip_reach_ext
);
2504 init_item_list(&result
->ipv4_address
);
2505 init_item_list(&result
->ipv6_address
);
2506 init_item_list(&result
->extended_ip_reach
);
2507 RB_INIT(isis_mt_item_list
, &result
->mt_ip_reach
);
2508 init_item_list(&result
->ipv6_reach
);
2509 RB_INIT(isis_mt_item_list
, &result
->mt_ipv6_reach
);
2514 struct isis_tlvs
*isis_copy_tlvs(struct isis_tlvs
*tlvs
)
2516 struct isis_tlvs
*rv
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*rv
));
2518 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AUTH
, &tlvs
->isis_auth
,
2521 rv
->purge_originator
=
2522 copy_tlv_purge_originator(tlvs
->purge_originator
);
2524 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AREA_ADDRESSES
,
2525 &tlvs
->area_addresses
, &rv
->area_addresses
);
2527 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_ROUTER_INFO
,
2528 &tlvs
->mt_router_info
, &rv
->mt_router_info
);
2530 rv
->mt_router_info_empty
= tlvs
->mt_router_info_empty
;
2532 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_REACH
,
2533 &tlvs
->oldstyle_reach
, &rv
->oldstyle_reach
);
2535 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_LAN_NEIGHBORS
,
2536 &tlvs
->lan_neighbor
, &rv
->lan_neighbor
);
2538 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_LSP_ENTRY
, &tlvs
->lsp_entries
,
2541 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_EXTENDED_REACH
,
2542 &tlvs
->extended_reach
, &rv
->extended_reach
);
2544 copy_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_REACH
, &tlvs
->mt_reach
,
2547 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_IP_REACH
,
2548 &tlvs
->oldstyle_ip_reach
, &rv
->oldstyle_ip_reach
);
2550 copy_tlv_protocols_supported(&tlvs
->protocols_supported
,
2551 &rv
->protocols_supported
);
2553 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_IP_REACH_EXT
,
2554 &tlvs
->oldstyle_ip_reach_ext
, &rv
->oldstyle_ip_reach_ext
);
2556 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV4_ADDRESS
, &tlvs
->ipv4_address
,
2559 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV6_ADDRESS
, &tlvs
->ipv6_address
,
2562 rv
->te_router_id
= copy_tlv_te_router_id(tlvs
->te_router_id
);
2564 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_EXTENDED_IP_REACH
,
2565 &tlvs
->extended_ip_reach
, &rv
->extended_ip_reach
);
2567 copy_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_IP_REACH
,
2568 &tlvs
->mt_ip_reach
, &rv
->mt_ip_reach
);
2570 rv
->hostname
= copy_tlv_dynamic_hostname(tlvs
->hostname
);
2572 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV6_REACH
, &tlvs
->ipv6_reach
,
2575 copy_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_IPV6_REACH
,
2576 &tlvs
->mt_ipv6_reach
, &rv
->mt_ipv6_reach
);
2578 rv
->threeway_adj
= copy_tlv_threeway_adj(tlvs
->threeway_adj
);
2580 rv
->spine_leaf
= copy_tlv_spine_leaf(tlvs
->spine_leaf
);
2585 static void format_tlvs(struct isis_tlvs
*tlvs
, struct sbuf
*buf
, int indent
)
2587 format_tlv_protocols_supported(&tlvs
->protocols_supported
, buf
, indent
);
2589 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AUTH
, &tlvs
->isis_auth
, buf
,
2592 format_tlv_purge_originator(tlvs
->purge_originator
, buf
, indent
);
2594 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AREA_ADDRESSES
,
2595 &tlvs
->area_addresses
, buf
, indent
);
2597 if (tlvs
->mt_router_info_empty
) {
2598 sbuf_push(buf
, indent
, "MT Router Info: None\n");
2600 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_ROUTER_INFO
,
2601 &tlvs
->mt_router_info
, buf
, indent
);
2604 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_REACH
,
2605 &tlvs
->oldstyle_reach
, buf
, indent
);
2607 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_LAN_NEIGHBORS
,
2608 &tlvs
->lan_neighbor
, buf
, indent
);
2610 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_LSP_ENTRY
, &tlvs
->lsp_entries
,
2613 format_tlv_dynamic_hostname(tlvs
->hostname
, buf
, indent
);
2614 format_tlv_te_router_id(tlvs
->te_router_id
, buf
, indent
);
2616 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_EXTENDED_REACH
,
2617 &tlvs
->extended_reach
, buf
, indent
);
2619 format_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_REACH
, &tlvs
->mt_reach
,
2622 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_IP_REACH
,
2623 &tlvs
->oldstyle_ip_reach
, buf
, indent
);
2625 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_IP_REACH_EXT
,
2626 &tlvs
->oldstyle_ip_reach_ext
, buf
, indent
);
2628 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV4_ADDRESS
,
2629 &tlvs
->ipv4_address
, buf
, indent
);
2631 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV6_ADDRESS
,
2632 &tlvs
->ipv6_address
, buf
, indent
);
2634 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_EXTENDED_IP_REACH
,
2635 &tlvs
->extended_ip_reach
, buf
, indent
);
2637 format_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_IP_REACH
,
2638 &tlvs
->mt_ip_reach
, buf
, indent
);
2640 format_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV6_REACH
, &tlvs
->ipv6_reach
,
2643 format_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_IPV6_REACH
,
2644 &tlvs
->mt_ipv6_reach
, buf
, indent
);
2646 format_tlv_threeway_adj(tlvs
->threeway_adj
, buf
, indent
);
2648 format_tlv_spine_leaf(tlvs
->spine_leaf
, buf
, indent
);
2651 const char *isis_format_tlvs(struct isis_tlvs
*tlvs
)
2653 static struct sbuf buf
;
2655 if (!sbuf_buf(&buf
))
2656 sbuf_init(&buf
, NULL
, 0);
2659 format_tlvs(tlvs
, &buf
, 0);
2660 return sbuf_buf(&buf
);
2663 void isis_free_tlvs(struct isis_tlvs
*tlvs
)
2668 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AUTH
, &tlvs
->isis_auth
);
2669 free_tlv_purge_originator(tlvs
->purge_originator
);
2670 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AREA_ADDRESSES
,
2671 &tlvs
->area_addresses
);
2672 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_ROUTER_INFO
,
2673 &tlvs
->mt_router_info
);
2674 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_REACH
,
2675 &tlvs
->oldstyle_reach
);
2676 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_LAN_NEIGHBORS
,
2677 &tlvs
->lan_neighbor
);
2678 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_LSP_ENTRY
, &tlvs
->lsp_entries
);
2679 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_EXTENDED_REACH
,
2680 &tlvs
->extended_reach
);
2681 free_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_REACH
, &tlvs
->mt_reach
);
2682 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_IP_REACH
,
2683 &tlvs
->oldstyle_ip_reach
);
2684 free_tlv_protocols_supported(&tlvs
->protocols_supported
);
2685 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_OLDSTYLE_IP_REACH_EXT
,
2686 &tlvs
->oldstyle_ip_reach_ext
);
2687 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV4_ADDRESS
,
2688 &tlvs
->ipv4_address
);
2689 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV6_ADDRESS
,
2690 &tlvs
->ipv6_address
);
2691 free_tlv_te_router_id(tlvs
->te_router_id
);
2692 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_EXTENDED_IP_REACH
,
2693 &tlvs
->extended_ip_reach
);
2694 free_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_IP_REACH
,
2695 &tlvs
->mt_ip_reach
);
2696 free_tlv_dynamic_hostname(tlvs
->hostname
);
2697 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_IPV6_REACH
, &tlvs
->ipv6_reach
);
2698 free_mt_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_IPV6_REACH
,
2699 &tlvs
->mt_ipv6_reach
);
2700 free_tlv_threeway_adj(tlvs
->threeway_adj
);
2701 free_tlv_spine_leaf(tlvs
->spine_leaf
);
2703 XFREE(MTYPE_ISIS_TLV
, tlvs
);
2706 static void add_padding(struct stream
*s
)
2708 while (STREAM_WRITEABLE(s
)) {
2709 if (STREAM_WRITEABLE(s
) == 1)
2711 uint32_t padding_len
= STREAM_WRITEABLE(s
) - 2;
2713 if (padding_len
> 255) {
2714 if (padding_len
== 256)
2720 stream_putc(s
, ISIS_TLV_PADDING
);
2721 stream_putc(s
, padding_len
);
2722 stream_put(s
, NULL
, padding_len
);
2726 #define LSP_REM_LIFETIME_OFF 10
2727 #define LSP_CHECKSUM_OFF 24
2728 static void safe_auth_md5(struct stream
*s
, uint16_t *checksum
,
2729 uint16_t *rem_lifetime
)
2731 memcpy(rem_lifetime
, STREAM_DATA(s
) + LSP_REM_LIFETIME_OFF
,
2732 sizeof(*rem_lifetime
));
2733 memset(STREAM_DATA(s
) + LSP_REM_LIFETIME_OFF
, 0, sizeof(*rem_lifetime
));
2734 memcpy(checksum
, STREAM_DATA(s
) + LSP_CHECKSUM_OFF
, sizeof(*checksum
));
2735 memset(STREAM_DATA(s
) + LSP_CHECKSUM_OFF
, 0, sizeof(*checksum
));
2738 static void restore_auth_md5(struct stream
*s
, uint16_t checksum
,
2739 uint16_t rem_lifetime
)
2741 memcpy(STREAM_DATA(s
) + LSP_REM_LIFETIME_OFF
, &rem_lifetime
,
2742 sizeof(rem_lifetime
));
2743 memcpy(STREAM_DATA(s
) + LSP_CHECKSUM_OFF
, &checksum
, sizeof(checksum
));
2746 static void update_auth_hmac_md5(struct isis_auth
*auth
, struct stream
*s
,
2750 uint16_t checksum
, rem_lifetime
;
2753 safe_auth_md5(s
, &checksum
, &rem_lifetime
);
2755 memset(STREAM_DATA(s
) + auth
->offset
, 0, 16);
2756 hmac_md5(STREAM_DATA(s
), stream_get_endp(s
), auth
->passwd
,
2757 auth
->plength
, digest
);
2758 memcpy(auth
->value
, digest
, 16);
2759 memcpy(STREAM_DATA(s
) + auth
->offset
, digest
, 16);
2762 restore_auth_md5(s
, checksum
, rem_lifetime
);
2765 static void update_auth(struct isis_tlvs
*tlvs
, struct stream
*s
, bool is_lsp
)
2767 struct isis_auth
*auth_head
= (struct isis_auth
*)tlvs
->isis_auth
.head
;
2769 for (struct isis_auth
*auth
= auth_head
; auth
; auth
= auth
->next
) {
2770 if (auth
->type
== ISIS_PASSWD_TYPE_HMAC_MD5
)
2771 update_auth_hmac_md5(auth
, s
, is_lsp
);
2775 static int handle_pack_entry(struct pack_order_entry
*pe
,
2776 struct isis_tlvs
*tlvs
, struct stream
*stream
,
2777 struct isis_tlvs
**fragment_tlvs
,
2778 struct isis_tlvs
*(*new_fragment
)(struct list
*l
),
2779 struct list
*new_fragment_arg
)
2783 if (pe
->how_to_pack
== ISIS_ITEMS
) {
2784 struct isis_item_list
*l
;
2785 l
= (struct isis_item_list
*)(((char *)tlvs
)
2786 + pe
->what_to_pack
);
2787 rv
= pack_items(pe
->context
, pe
->type
, l
, stream
, fragment_tlvs
,
2788 pe
, new_fragment
, new_fragment_arg
);
2790 struct isis_mt_item_list
*l
;
2791 l
= (struct isis_mt_item_list
*)(((char *)tlvs
)
2792 + pe
->what_to_pack
);
2793 rv
= pack_mt_items(pe
->context
, pe
->type
, l
, stream
,
2794 fragment_tlvs
, pe
, new_fragment
,
2801 static int pack_tlvs(struct isis_tlvs
*tlvs
, struct stream
*stream
,
2802 struct isis_tlvs
*fragment_tlvs
,
2803 struct isis_tlvs
*(*new_fragment
)(struct list
*l
),
2804 struct list
*new_fragment_arg
)
2808 /* When fragmenting, don't add auth as it's already accounted for in the
2809 * size we are given. */
2810 if (!fragment_tlvs
) {
2811 rv
= pack_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AUTH
,
2812 &tlvs
->isis_auth
, stream
, NULL
, NULL
, NULL
,
2818 rv
= pack_tlv_purge_originator(tlvs
->purge_originator
, stream
);
2821 if (fragment_tlvs
) {
2822 fragment_tlvs
->purge_originator
=
2823 copy_tlv_purge_originator(tlvs
->purge_originator
);
2826 rv
= pack_tlv_protocols_supported(&tlvs
->protocols_supported
, stream
);
2829 if (fragment_tlvs
) {
2830 copy_tlv_protocols_supported(
2831 &tlvs
->protocols_supported
,
2832 &fragment_tlvs
->protocols_supported
);
2835 rv
= pack_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AREA_ADDRESSES
,
2836 &tlvs
->area_addresses
, stream
, NULL
, NULL
, NULL
, NULL
);
2839 if (fragment_tlvs
) {
2840 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AREA_ADDRESSES
,
2841 &tlvs
->area_addresses
,
2842 &fragment_tlvs
->area_addresses
);
2846 if (tlvs
->mt_router_info_empty
) {
2847 if (STREAM_WRITEABLE(stream
) < 2)
2849 stream_putc(stream
, ISIS_TLV_MT_ROUTER_INFO
);
2850 stream_putc(stream
, 0);
2852 fragment_tlvs
->mt_router_info_empty
= true;
2854 rv
= pack_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_ROUTER_INFO
,
2855 &tlvs
->mt_router_info
, stream
, NULL
, NULL
, NULL
,
2859 if (fragment_tlvs
) {
2860 copy_items(ISIS_CONTEXT_LSP
, ISIS_TLV_MT_ROUTER_INFO
,
2861 &tlvs
->mt_router_info
,
2862 &fragment_tlvs
->mt_router_info
);
2866 rv
= pack_tlv_dynamic_hostname(tlvs
->hostname
, stream
);
2870 fragment_tlvs
->hostname
=
2871 copy_tlv_dynamic_hostname(tlvs
->hostname
);
2873 rv
= pack_tlv_te_router_id(tlvs
->te_router_id
, stream
);
2876 if (fragment_tlvs
) {
2877 fragment_tlvs
->te_router_id
=
2878 copy_tlv_te_router_id(tlvs
->te_router_id
);
2881 rv
= pack_tlv_threeway_adj(tlvs
->threeway_adj
, stream
);
2884 if (fragment_tlvs
) {
2885 fragment_tlvs
->threeway_adj
=
2886 copy_tlv_threeway_adj(tlvs
->threeway_adj
);
2889 rv
= pack_tlv_spine_leaf(tlvs
->spine_leaf
, stream
);
2892 if (fragment_tlvs
) {
2893 fragment_tlvs
->spine_leaf
=
2894 copy_tlv_spine_leaf(tlvs
->spine_leaf
);
2897 for (size_t pack_idx
= 0; pack_idx
< array_size(pack_order
);
2899 rv
= handle_pack_entry(&pack_order
[pack_idx
], tlvs
, stream
,
2900 fragment_tlvs
? &fragment_tlvs
: NULL
,
2901 new_fragment
, new_fragment_arg
);
2910 int isis_pack_tlvs(struct isis_tlvs
*tlvs
, struct stream
*stream
,
2911 size_t len_pointer
, bool pad
, bool is_lsp
)
2915 rv
= pack_tlvs(tlvs
, stream
, NULL
, NULL
, NULL
);
2920 add_padding(stream
);
2922 if (len_pointer
!= (size_t)-1) {
2923 stream_putw_at(stream
, len_pointer
, stream_get_endp(stream
));
2926 update_auth(tlvs
, stream
, is_lsp
);
2931 static struct isis_tlvs
*new_fragment(struct list
*l
)
2933 struct isis_tlvs
*rv
= isis_alloc_tlvs();
2935 listnode_add(l
, rv
);
2939 struct list
*isis_fragment_tlvs(struct isis_tlvs
*tlvs
, size_t size
)
2941 struct stream
*dummy_stream
= stream_new(size
);
2942 struct list
*rv
= list_new();
2943 struct isis_tlvs
*fragment_tlvs
= new_fragment(rv
);
2945 if (pack_tlvs(tlvs
, dummy_stream
, fragment_tlvs
, new_fragment
, rv
)) {
2946 struct listnode
*node
;
2947 for (ALL_LIST_ELEMENTS_RO(rv
, node
, fragment_tlvs
))
2948 isis_free_tlvs(fragment_tlvs
);
2952 stream_free(dummy_stream
);
2956 static int unpack_tlv_unknown(enum isis_tlv_context context
, uint8_t tlv_type
,
2957 uint8_t tlv_len
, struct stream
*s
,
2958 struct sbuf
*log
, int indent
)
2960 stream_forward_getp(s
, tlv_len
);
2961 sbuf_push(log
, indent
,
2962 "Skipping unknown TLV %" PRIu8
" (%" PRIu8
" bytes)\n",
2967 static int unpack_tlv(enum isis_tlv_context context
, size_t avail_len
,
2968 struct stream
*stream
, struct sbuf
*log
, void *dest
,
2971 uint8_t tlv_type
, tlv_len
;
2972 const struct tlv_ops
*ops
;
2974 sbuf_push(log
, indent
, "Unpacking TLV...\n");
2976 if (avail_len
< 2) {
2979 "Available data %zu too short to contain a TLV header.\n",
2984 tlv_type
= stream_getc(stream
);
2985 tlv_len
= stream_getc(stream
);
2987 sbuf_push(log
, indent
+ 2,
2988 "Found TLV of type %" PRIu8
" and len %" PRIu8
".\n",
2991 if (avail_len
< ((size_t)tlv_len
) + 2) {
2992 sbuf_push(log
, indent
+ 2,
2993 "Available data %zu too short for claimed TLV len %" PRIu8
".\n",
2994 avail_len
- 2, tlv_len
);
2998 ops
= tlv_table
[context
][tlv_type
];
2999 if (ops
&& ops
->unpack
) {
3000 return ops
->unpack(context
, tlv_type
, tlv_len
, stream
, log
,
3004 return unpack_tlv_unknown(context
, tlv_type
, tlv_len
, stream
, log
,
3008 static int unpack_tlvs(enum isis_tlv_context context
, size_t avail_len
,
3009 struct stream
*stream
, struct sbuf
*log
, void *dest
,
3013 size_t tlv_start
, tlv_pos
;
3015 tlv_start
= stream_get_getp(stream
);
3018 sbuf_push(log
, indent
, "Unpacking %zu bytes of %s...\n", avail_len
,
3019 (context
== ISIS_CONTEXT_LSP
) ? "TLVs" : "sub-TLVs");
3021 while (tlv_pos
< avail_len
) {
3022 rv
= unpack_tlv(context
, avail_len
- tlv_pos
, stream
, log
, dest
,
3027 tlv_pos
= stream_get_getp(stream
) - tlv_start
;
3033 int isis_unpack_tlvs(size_t avail_len
, struct stream
*stream
,
3034 struct isis_tlvs
**dest
, const char **log
)
3036 static struct sbuf logbuf
;
3039 struct isis_tlvs
*result
;
3041 if (!sbuf_buf(&logbuf
))
3042 sbuf_init(&logbuf
, NULL
, 0);
3044 sbuf_reset(&logbuf
);
3045 if (avail_len
> STREAM_READABLE(stream
)) {
3046 sbuf_push(&logbuf
, indent
,
3047 "Stream doesn't contain sufficient data. "
3048 "Claimed %zu, available %zu\n",
3049 avail_len
, STREAM_READABLE(stream
));
3053 result
= isis_alloc_tlvs();
3054 rv
= unpack_tlvs(ISIS_CONTEXT_LSP
, avail_len
, stream
, &logbuf
, result
,
3057 *log
= sbuf_buf(&logbuf
);
3063 #define TLV_OPS(_name_, _desc_) \
3064 static const struct tlv_ops tlv_##_name_##_ops = { \
3065 .name = _desc_, .unpack = unpack_tlv_##_name_, \
3068 #define ITEM_TLV_OPS(_name_, _desc_) \
3069 static const struct tlv_ops tlv_##_name_##_ops = { \
3071 .unpack = unpack_tlv_with_items, \
3073 .pack_item = pack_item_##_name_, \
3074 .free_item = free_item_##_name_, \
3075 .unpack_item = unpack_item_##_name_, \
3076 .format_item = format_item_##_name_, \
3077 .copy_item = copy_item_##_name_}
3079 #define SUBTLV_OPS(_name_, _desc_) \
3080 static const struct tlv_ops subtlv_##_name_##_ops = { \
3081 .name = _desc_, .unpack = unpack_subtlv_##_name_, \
3084 #define ITEM_SUBTLV_OPS(_name_, _desc_) \
3085 ITEM_TLV_OPS(_name_, _desc_)
3087 ITEM_TLV_OPS(area_address
, "TLV 1 Area Addresses");
3088 ITEM_TLV_OPS(oldstyle_reach
, "TLV 2 IS Reachability");
3089 ITEM_TLV_OPS(lan_neighbor
, "TLV 6 LAN Neighbors");
3090 ITEM_TLV_OPS(lsp_entry
, "TLV 9 LSP Entries");
3091 ITEM_TLV_OPS(auth
, "TLV 10 IS-IS Auth");
3092 TLV_OPS(purge_originator
, "TLV 13 Purge Originator Identification");
3093 ITEM_TLV_OPS(extended_reach
, "TLV 22 Extended Reachability");
3094 ITEM_TLV_OPS(oldstyle_ip_reach
, "TLV 128/130 IP Reachability");
3095 TLV_OPS(protocols_supported
, "TLV 129 Protocols Supported");
3096 ITEM_TLV_OPS(ipv4_address
, "TLV 132 IPv4 Interface Address");
3097 TLV_OPS(te_router_id
, "TLV 134 TE Router ID");
3098 ITEM_TLV_OPS(extended_ip_reach
, "TLV 135 Extended IP Reachability");
3099 TLV_OPS(dynamic_hostname
, "TLV 137 Dynamic Hostname");
3100 TLV_OPS(spine_leaf
, "TLV 150 Spine Leaf Extensions");
3101 ITEM_TLV_OPS(mt_router_info
, "TLV 229 MT Router Information");
3102 TLV_OPS(threeway_adj
, "TLV 240 P2P Three-Way Adjacency");
3103 ITEM_TLV_OPS(ipv6_address
, "TLV 232 IPv6 Interface Address");
3104 ITEM_TLV_OPS(ipv6_reach
, "TLV 236 IPv6 Reachability");
3106 ITEM_SUBTLV_OPS(prefix_sid
, "Sub-TLV 3 SR Prefix-SID");
3107 SUBTLV_OPS(ipv6_source_prefix
, "Sub-TLV 22 IPv6 Source Prefix");
3109 static const struct tlv_ops
*tlv_table
[ISIS_CONTEXT_MAX
][ISIS_TLV_MAX
] = {
3110 [ISIS_CONTEXT_LSP
] = {
3111 [ISIS_TLV_AREA_ADDRESSES
] = &tlv_area_address_ops
,
3112 [ISIS_TLV_OLDSTYLE_REACH
] = &tlv_oldstyle_reach_ops
,
3113 [ISIS_TLV_LAN_NEIGHBORS
] = &tlv_lan_neighbor_ops
,
3114 [ISIS_TLV_LSP_ENTRY
] = &tlv_lsp_entry_ops
,
3115 [ISIS_TLV_AUTH
] = &tlv_auth_ops
,
3116 [ISIS_TLV_PURGE_ORIGINATOR
] = &tlv_purge_originator_ops
,
3117 [ISIS_TLV_EXTENDED_REACH
] = &tlv_extended_reach_ops
,
3118 [ISIS_TLV_MT_REACH
] = &tlv_extended_reach_ops
,
3119 [ISIS_TLV_OLDSTYLE_IP_REACH
] = &tlv_oldstyle_ip_reach_ops
,
3120 [ISIS_TLV_PROTOCOLS_SUPPORTED
] = &tlv_protocols_supported_ops
,
3121 [ISIS_TLV_OLDSTYLE_IP_REACH_EXT
] = &tlv_oldstyle_ip_reach_ops
,
3122 [ISIS_TLV_IPV4_ADDRESS
] = &tlv_ipv4_address_ops
,
3123 [ISIS_TLV_TE_ROUTER_ID
] = &tlv_te_router_id_ops
,
3124 [ISIS_TLV_EXTENDED_IP_REACH
] = &tlv_extended_ip_reach_ops
,
3125 [ISIS_TLV_MT_IP_REACH
] = &tlv_extended_ip_reach_ops
,
3126 [ISIS_TLV_DYNAMIC_HOSTNAME
] = &tlv_dynamic_hostname_ops
,
3127 [ISIS_TLV_SPINE_LEAF_EXT
] = &tlv_spine_leaf_ops
,
3128 [ISIS_TLV_MT_ROUTER_INFO
] = &tlv_mt_router_info_ops
,
3129 [ISIS_TLV_THREE_WAY_ADJ
] = &tlv_threeway_adj_ops
,
3130 [ISIS_TLV_IPV6_ADDRESS
] = &tlv_ipv6_address_ops
,
3131 [ISIS_TLV_IPV6_REACH
] = &tlv_ipv6_reach_ops
,
3132 [ISIS_TLV_MT_IPV6_REACH
] = &tlv_ipv6_reach_ops
,
3134 [ISIS_CONTEXT_SUBTLV_NE_REACH
] = {},
3135 [ISIS_CONTEXT_SUBTLV_IP_REACH
] = {
3136 [ISIS_SUBTLV_PREFIX_SID
] = &tlv_prefix_sid_ops
,
3138 [ISIS_CONTEXT_SUBTLV_IPV6_REACH
] = {
3139 [ISIS_SUBTLV_PREFIX_SID
] = &tlv_prefix_sid_ops
,
3140 [ISIS_SUBTLV_IPV6_SOURCE_PREFIX
] = &subtlv_ipv6_source_prefix_ops
,
3144 /* Accessor functions */
3146 void isis_tlvs_add_auth(struct isis_tlvs
*tlvs
, struct isis_passwd
*passwd
)
3148 free_items(ISIS_CONTEXT_LSP
, ISIS_TLV_AUTH
, &tlvs
->isis_auth
);
3149 init_item_list(&tlvs
->isis_auth
);
3151 if (passwd
->type
== ISIS_PASSWD_TYPE_UNUSED
)
3154 struct isis_auth
*auth
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*auth
));
3156 auth
->type
= passwd
->type
;
3158 auth
->plength
= passwd
->len
;
3159 memcpy(auth
->passwd
, passwd
->passwd
,
3160 MIN(sizeof(auth
->passwd
), sizeof(passwd
->passwd
)));
3162 if (auth
->type
== ISIS_PASSWD_TYPE_CLEARTXT
) {
3163 auth
->length
= passwd
->len
;
3164 memcpy(auth
->value
, passwd
->passwd
,
3165 MIN(sizeof(auth
->value
), sizeof(passwd
->passwd
)));
3168 append_item(&tlvs
->isis_auth
, (struct isis_item
*)auth
);
3171 void isis_tlvs_add_area_addresses(struct isis_tlvs
*tlvs
,
3172 struct list
*addresses
)
3174 struct listnode
*node
;
3175 struct area_addr
*area_addr
;
3177 for (ALL_LIST_ELEMENTS_RO(addresses
, node
, area_addr
)) {
3178 struct isis_area_address
*a
=
3179 XCALLOC(MTYPE_ISIS_TLV
, sizeof(*a
));
3181 a
->len
= area_addr
->addr_len
;
3182 memcpy(a
->addr
, area_addr
->area_addr
, 20);
3183 append_item(&tlvs
->area_addresses
, (struct isis_item
*)a
);
3187 void isis_tlvs_add_lan_neighbors(struct isis_tlvs
*tlvs
, struct list
*neighbors
)
3189 struct listnode
*node
;
3192 for (ALL_LIST_ELEMENTS_RO(neighbors
, node
, snpa
)) {
3193 struct isis_lan_neighbor
*n
=
3194 XCALLOC(MTYPE_ISIS_TLV
, sizeof(*n
));
3196 memcpy(n
->mac
, snpa
, 6);
3197 append_item(&tlvs
->lan_neighbor
, (struct isis_item
*)n
);
3201 void isis_tlvs_set_protocols_supported(struct isis_tlvs
*tlvs
,
3202 struct nlpids
*nlpids
)
3204 tlvs
->protocols_supported
.count
= nlpids
->count
;
3205 XFREE(MTYPE_ISIS_TLV
, tlvs
->protocols_supported
.protocols
);
3206 if (nlpids
->count
) {
3207 tlvs
->protocols_supported
.protocols
=
3208 XCALLOC(MTYPE_ISIS_TLV
, nlpids
->count
);
3209 memcpy(tlvs
->protocols_supported
.protocols
, nlpids
->nlpids
,
3212 tlvs
->protocols_supported
.protocols
= NULL
;
3216 void isis_tlvs_add_mt_router_info(struct isis_tlvs
*tlvs
, uint16_t mtid
,
3217 bool overload
, bool attached
)
3219 struct isis_mt_router_info
*i
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*i
));
3221 i
->overload
= overload
;
3222 i
->attached
= attached
;
3224 append_item(&tlvs
->mt_router_info
, (struct isis_item
*)i
);
3227 void isis_tlvs_add_ipv4_address(struct isis_tlvs
*tlvs
, struct in_addr
*addr
)
3229 struct isis_ipv4_address
*a
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*a
));
3231 append_item(&tlvs
->ipv4_address
, (struct isis_item
*)a
);
3235 void isis_tlvs_add_ipv4_addresses(struct isis_tlvs
*tlvs
,
3236 struct list
*addresses
)
3238 struct listnode
*node
;
3239 struct prefix_ipv4
*ip_addr
;
3240 unsigned int addr_count
= 0;
3242 for (ALL_LIST_ELEMENTS_RO(addresses
, node
, ip_addr
)) {
3243 isis_tlvs_add_ipv4_address(tlvs
, &ip_addr
->prefix
);
3245 if (addr_count
>= 63)
3250 void isis_tlvs_add_ipv6_addresses(struct isis_tlvs
*tlvs
,
3251 struct list
*addresses
)
3253 struct listnode
*node
;
3254 struct prefix_ipv6
*ip_addr
;
3256 for (ALL_LIST_ELEMENTS_RO(addresses
, node
, ip_addr
)) {
3257 struct isis_ipv6_address
*a
=
3258 XCALLOC(MTYPE_ISIS_TLV
, sizeof(*a
));
3260 a
->addr
= ip_addr
->prefix
;
3261 append_item(&tlvs
->ipv6_address
, (struct isis_item
*)a
);
3265 typedef bool (*auth_validator_func
)(struct isis_passwd
*passwd
,
3266 struct stream
*stream
,
3267 struct isis_auth
*auth
, bool is_lsp
);
3269 static bool auth_validator_cleartxt(struct isis_passwd
*passwd
,
3270 struct stream
*stream
,
3271 struct isis_auth
*auth
, bool is_lsp
)
3273 return (auth
->length
== passwd
->len
3274 && !memcmp(auth
->value
, passwd
->passwd
, passwd
->len
));
3277 static bool auth_validator_hmac_md5(struct isis_passwd
*passwd
,
3278 struct stream
*stream
,
3279 struct isis_auth
*auth
, bool is_lsp
)
3283 uint16_t rem_lifetime
;
3286 safe_auth_md5(stream
, &checksum
, &rem_lifetime
);
3288 memset(STREAM_DATA(stream
) + auth
->offset
, 0, 16);
3289 hmac_md5(STREAM_DATA(stream
), stream_get_endp(stream
), passwd
->passwd
,
3290 passwd
->len
, digest
);
3291 memcpy(STREAM_DATA(stream
) + auth
->offset
, auth
->value
, 16);
3293 bool rv
= !memcmp(digest
, auth
->value
, 16);
3296 restore_auth_md5(stream
, checksum
, rem_lifetime
);
3301 static const auth_validator_func auth_validators
[] = {
3302 [ISIS_PASSWD_TYPE_CLEARTXT
] = auth_validator_cleartxt
,
3303 [ISIS_PASSWD_TYPE_HMAC_MD5
] = auth_validator_hmac_md5
,
3306 int isis_tlvs_auth_is_valid(struct isis_tlvs
*tlvs
, struct isis_passwd
*passwd
,
3307 struct stream
*stream
, bool is_lsp
)
3309 /* If no auth is set, always pass authentication */
3311 return ISIS_AUTH_OK
;
3313 /* If we don't known how to validate the auth, return invalid */
3314 if (passwd
->type
>= array_size(auth_validators
)
3315 || !auth_validators
[passwd
->type
])
3316 return ISIS_AUTH_NO_VALIDATOR
;
3318 struct isis_auth
*auth_head
= (struct isis_auth
*)tlvs
->isis_auth
.head
;
3319 struct isis_auth
*auth
;
3320 for (auth
= auth_head
; auth
; auth
= auth
->next
) {
3321 if (auth
->type
== passwd
->type
)
3325 /* If matching auth TLV could not be found, return invalid */
3327 return ISIS_AUTH_TYPE_FAILURE
;
3330 /* Perform validation and return result */
3331 if (auth_validators
[passwd
->type
](passwd
, stream
, auth
, is_lsp
))
3332 return ISIS_AUTH_OK
;
3334 return ISIS_AUTH_FAILURE
;
3337 bool isis_tlvs_area_addresses_match(struct isis_tlvs
*tlvs
,
3338 struct list
*addresses
)
3340 struct isis_area_address
*addr_head
;
3342 addr_head
= (struct isis_area_address
*)tlvs
->area_addresses
.head
;
3343 for (struct isis_area_address
*addr
= addr_head
; addr
;
3344 addr
= addr
->next
) {
3345 struct listnode
*node
;
3346 struct area_addr
*a
;
3348 for (ALL_LIST_ELEMENTS_RO(addresses
, node
, a
)) {
3349 if (a
->addr_len
== addr
->len
3350 && !memcmp(a
->area_addr
, addr
->addr
, addr
->len
))
3358 static void tlvs_area_addresses_to_adj(struct isis_tlvs
*tlvs
,
3359 struct isis_adjacency
*adj
,
3362 if (adj
->area_address_count
!= tlvs
->area_addresses
.count
) {
3364 adj
->area_address_count
= tlvs
->area_addresses
.count
;
3365 adj
->area_addresses
= XREALLOC(
3366 MTYPE_ISIS_ADJACENCY_INFO
, adj
->area_addresses
,
3367 adj
->area_address_count
* sizeof(*adj
->area_addresses
));
3370 struct isis_area_address
*addr
= NULL
;
3371 for (unsigned int i
= 0; i
< tlvs
->area_addresses
.count
; i
++) {
3373 addr
= (struct isis_area_address
*)
3374 tlvs
->area_addresses
.head
;
3378 if (adj
->area_addresses
[i
].addr_len
== addr
->len
3379 && !memcmp(adj
->area_addresses
[i
].area_addr
, addr
->addr
,
3385 adj
->area_addresses
[i
].addr_len
= addr
->len
;
3386 memcpy(adj
->area_addresses
[i
].area_addr
, addr
->addr
, addr
->len
);
3390 static void tlvs_protocols_supported_to_adj(struct isis_tlvs
*tlvs
,
3391 struct isis_adjacency
*adj
,
3394 bool ipv4_supported
= false, ipv6_supported
= false;
3396 for (uint8_t i
= 0; i
< tlvs
->protocols_supported
.count
; i
++) {
3397 if (tlvs
->protocols_supported
.protocols
[i
] == NLPID_IP
)
3398 ipv4_supported
= true;
3399 if (tlvs
->protocols_supported
.protocols
[i
] == NLPID_IPV6
)
3400 ipv6_supported
= true;
3403 struct nlpids reduced
= {};
3405 if (ipv4_supported
&& ipv6_supported
) {
3407 reduced
.nlpids
[0] = NLPID_IP
;
3408 reduced
.nlpids
[1] = NLPID_IPV6
;
3409 } else if (ipv4_supported
) {
3411 reduced
.nlpids
[0] = NLPID_IP
;
3412 } else if (ipv6_supported
) {
3414 reduced
.nlpids
[0] = NLPID_IPV6
;
3419 if (adj
->nlpids
.count
== reduced
.count
3420 && !memcmp(adj
->nlpids
.nlpids
, reduced
.nlpids
, reduced
.count
))
3424 adj
->nlpids
.count
= reduced
.count
;
3425 memcpy(adj
->nlpids
.nlpids
, reduced
.nlpids
, reduced
.count
);
3428 static void tlvs_ipv4_addresses_to_adj(struct isis_tlvs
*tlvs
,
3429 struct isis_adjacency
*adj
,
3432 if (adj
->ipv4_address_count
!= tlvs
->ipv4_address
.count
) {
3434 adj
->ipv4_address_count
= tlvs
->ipv4_address
.count
;
3435 adj
->ipv4_addresses
= XREALLOC(
3436 MTYPE_ISIS_ADJACENCY_INFO
, adj
->ipv4_addresses
,
3437 adj
->ipv4_address_count
* sizeof(*adj
->ipv4_addresses
));
3440 struct isis_ipv4_address
*addr
= NULL
;
3441 for (unsigned int i
= 0; i
< tlvs
->ipv4_address
.count
; i
++) {
3443 addr
= (struct isis_ipv4_address
*)
3444 tlvs
->ipv4_address
.head
;
3448 if (!memcmp(&adj
->ipv4_addresses
[i
], &addr
->addr
,
3449 sizeof(addr
->addr
)))
3453 adj
->ipv4_addresses
[i
] = addr
->addr
;
3457 static void tlvs_ipv6_addresses_to_adj(struct isis_tlvs
*tlvs
,
3458 struct isis_adjacency
*adj
,
3461 if (adj
->ipv6_address_count
!= tlvs
->ipv6_address
.count
) {
3463 adj
->ipv6_address_count
= tlvs
->ipv6_address
.count
;
3464 adj
->ipv6_addresses
= XREALLOC(
3465 MTYPE_ISIS_ADJACENCY_INFO
, adj
->ipv6_addresses
,
3466 adj
->ipv6_address_count
* sizeof(*adj
->ipv6_addresses
));
3469 struct isis_ipv6_address
*addr
= NULL
;
3470 for (unsigned int i
= 0; i
< tlvs
->ipv6_address
.count
; i
++) {
3472 addr
= (struct isis_ipv6_address
*)
3473 tlvs
->ipv6_address
.head
;
3477 if (!memcmp(&adj
->ipv6_addresses
[i
], &addr
->addr
,
3478 sizeof(addr
->addr
)))
3482 adj
->ipv6_addresses
[i
] = addr
->addr
;
3486 void isis_tlvs_to_adj(struct isis_tlvs
*tlvs
, struct isis_adjacency
*adj
,
3491 tlvs_area_addresses_to_adj(tlvs
, adj
, changed
);
3492 tlvs_protocols_supported_to_adj(tlvs
, adj
, changed
);
3493 tlvs_ipv4_addresses_to_adj(tlvs
, adj
, changed
);
3494 tlvs_ipv6_addresses_to_adj(tlvs
, adj
, changed
);
3497 bool isis_tlvs_own_snpa_found(struct isis_tlvs
*tlvs
, uint8_t *snpa
)
3499 struct isis_lan_neighbor
*ne_head
;
3501 ne_head
= (struct isis_lan_neighbor
*)tlvs
->lan_neighbor
.head
;
3502 for (struct isis_lan_neighbor
*ne
= ne_head
; ne
; ne
= ne
->next
) {
3503 if (!memcmp(ne
->mac
, snpa
, ETH_ALEN
))
3510 void isis_tlvs_add_lsp_entry(struct isis_tlvs
*tlvs
, struct isis_lsp
*lsp
)
3512 struct isis_lsp_entry
*entry
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*entry
));
3514 entry
->rem_lifetime
= lsp
->hdr
.rem_lifetime
;
3515 memcpy(entry
->id
, lsp
->hdr
.lsp_id
, ISIS_SYS_ID_LEN
+ 2);
3516 entry
->checksum
= lsp
->hdr
.checksum
;
3517 entry
->seqno
= lsp
->hdr
.seqno
;
3520 append_item(&tlvs
->lsp_entries
, (struct isis_item
*)entry
);
3523 void isis_tlvs_add_csnp_entries(struct isis_tlvs
*tlvs
, uint8_t *start_id
,
3524 uint8_t *stop_id
, uint16_t num_lsps
,
3525 struct lspdb_head
*head
,
3526 struct isis_lsp
**last_lsp
)
3528 struct isis_lsp searchfor
;
3529 struct isis_lsp
*first
, *lsp
;
3531 memcpy(&searchfor
.hdr
.lsp_id
, start_id
, sizeof(searchfor
.hdr
.lsp_id
));
3532 first
= lspdb_find_gteq(head
, &searchfor
);
3536 for_each_from (lspdb
, head
, lsp
, first
) {
3537 if (memcmp(lsp
->hdr
.lsp_id
, stop_id
, sizeof(lsp
->hdr
.lsp_id
))
3538 > 0 || tlvs
->lsp_entries
.count
== num_lsps
)
3541 isis_tlvs_add_lsp_entry(tlvs
, lsp
);
3546 void isis_tlvs_set_dynamic_hostname(struct isis_tlvs
*tlvs
,
3547 const char *hostname
)
3549 XFREE(MTYPE_ISIS_TLV
, tlvs
->hostname
);
3551 tlvs
->hostname
= XSTRDUP(MTYPE_ISIS_TLV
, hostname
);
3554 void isis_tlvs_set_te_router_id(struct isis_tlvs
*tlvs
,
3555 const struct in_addr
*id
)
3557 XFREE(MTYPE_ISIS_TLV
, tlvs
->te_router_id
);
3560 tlvs
->te_router_id
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*id
));
3561 memcpy(tlvs
->te_router_id
, id
, sizeof(*id
));
3564 void isis_tlvs_add_oldstyle_ip_reach(struct isis_tlvs
*tlvs
,
3565 struct prefix_ipv4
*dest
, uint8_t metric
)
3567 struct isis_oldstyle_ip_reach
*r
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*r
));
3570 memcpy(&r
->prefix
, dest
, sizeof(*dest
));
3571 apply_mask_ipv4(&r
->prefix
);
3572 append_item(&tlvs
->oldstyle_ip_reach
, (struct isis_item
*)r
);
3575 void isis_tlvs_add_extended_ip_reach(struct isis_tlvs
*tlvs
,
3576 struct prefix_ipv4
*dest
, uint32_t metric
)
3578 struct isis_extended_ip_reach
*r
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*r
));
3581 memcpy(&r
->prefix
, dest
, sizeof(*dest
));
3582 apply_mask_ipv4(&r
->prefix
);
3583 append_item(&tlvs
->extended_ip_reach
, (struct isis_item
*)r
);
3586 void isis_tlvs_add_ipv6_reach(struct isis_tlvs
*tlvs
, uint16_t mtid
,
3587 struct prefix_ipv6
*dest
, uint32_t metric
)
3589 struct isis_ipv6_reach
*r
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*r
));
3592 memcpy(&r
->prefix
, dest
, sizeof(*dest
));
3593 apply_mask_ipv6(&r
->prefix
);
3595 struct isis_item_list
*l
;
3596 l
= (mtid
== ISIS_MT_IPV4_UNICAST
)
3598 : isis_get_mt_items(&tlvs
->mt_ipv6_reach
, mtid
);
3599 append_item(l
, (struct isis_item
*)r
);
3602 void isis_tlvs_add_ipv6_dstsrc_reach(struct isis_tlvs
*tlvs
, uint16_t mtid
,
3603 struct prefix_ipv6
*dest
,
3604 struct prefix_ipv6
*src
,
3607 isis_tlvs_add_ipv6_reach(tlvs
, mtid
, dest
, metric
);
3608 struct isis_item_list
*l
= isis_get_mt_items(&tlvs
->mt_ipv6_reach
,
3611 struct isis_ipv6_reach
*r
= (struct isis_ipv6_reach
*)last_item(l
);
3612 r
->subtlvs
= isis_alloc_subtlvs(ISIS_CONTEXT_SUBTLV_IPV6_REACH
);
3613 r
->subtlvs
->source_prefix
= XCALLOC(MTYPE_ISIS_SUBTLV
, sizeof(*src
));
3614 memcpy(r
->subtlvs
->source_prefix
, src
, sizeof(*src
));
3617 void isis_tlvs_add_oldstyle_reach(struct isis_tlvs
*tlvs
, uint8_t *id
,
3620 struct isis_oldstyle_reach
*r
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*r
));
3623 memcpy(r
->id
, id
, sizeof(r
->id
));
3624 append_item(&tlvs
->oldstyle_reach
, (struct isis_item
*)r
);
3627 void isis_tlvs_add_extended_reach(struct isis_tlvs
*tlvs
, uint16_t mtid
,
3628 uint8_t *id
, uint32_t metric
,
3629 uint8_t *subtlvs
, uint8_t subtlv_len
)
3631 struct isis_extended_reach
*r
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*r
));
3633 memcpy(r
->id
, id
, sizeof(r
->id
));
3635 if (subtlvs
&& subtlv_len
) {
3636 r
->subtlvs
= XCALLOC(MTYPE_ISIS_TLV
, subtlv_len
);
3637 memcpy(r
->subtlvs
, subtlvs
, subtlv_len
);
3638 r
->subtlv_len
= subtlv_len
;
3641 struct isis_item_list
*l
;
3642 if (mtid
== ISIS_MT_IPV4_UNICAST
)
3643 l
= &tlvs
->extended_reach
;
3645 l
= isis_get_mt_items(&tlvs
->mt_reach
, mtid
);
3646 append_item(l
, (struct isis_item
*)r
);
3649 void isis_tlvs_add_threeway_adj(struct isis_tlvs
*tlvs
,
3650 enum isis_threeway_state state
,
3651 uint32_t local_circuit_id
,
3652 const uint8_t *neighbor_id
,
3653 uint32_t neighbor_circuit_id
)
3655 assert(!tlvs
->threeway_adj
);
3657 tlvs
->threeway_adj
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*tlvs
->threeway_adj
));
3658 tlvs
->threeway_adj
->state
= state
;
3659 tlvs
->threeway_adj
->local_circuit_id
= local_circuit_id
;
3662 tlvs
->threeway_adj
->neighbor_set
= true;
3663 memcpy(tlvs
->threeway_adj
->neighbor_id
, neighbor_id
, 6);
3664 tlvs
->threeway_adj
->neighbor_circuit_id
= neighbor_circuit_id
;
3668 void isis_tlvs_add_spine_leaf(struct isis_tlvs
*tlvs
, uint8_t tier
,
3669 bool has_tier
, bool is_leaf
, bool is_spine
,
3672 assert(!tlvs
->spine_leaf
);
3674 tlvs
->spine_leaf
= XCALLOC(MTYPE_ISIS_TLV
, sizeof(*tlvs
->spine_leaf
));
3677 tlvs
->spine_leaf
->tier
= tier
;
3680 tlvs
->spine_leaf
->has_tier
= has_tier
;
3681 tlvs
->spine_leaf
->is_leaf
= is_leaf
;
3682 tlvs
->spine_leaf
->is_spine
= is_spine
;
3683 tlvs
->spine_leaf
->is_backup
= is_backup
;
3686 struct isis_mt_router_info
*
3687 isis_tlvs_lookup_mt_router_info(struct isis_tlvs
*tlvs
, uint16_t mtid
)
3689 if (tlvs
->mt_router_info_empty
)
3692 struct isis_mt_router_info
*rv
;
3693 for (rv
= (struct isis_mt_router_info
*)tlvs
->mt_router_info
.head
; rv
;
3695 if (rv
->mtid
== mtid
)
3702 void isis_tlvs_set_purge_originator(struct isis_tlvs
*tlvs
,
3703 const uint8_t *generator
,
3704 const uint8_t *sender
)
3706 assert(!tlvs
->purge_originator
);
3708 tlvs
->purge_originator
= XCALLOC(MTYPE_ISIS_TLV
,
3709 sizeof(*tlvs
->purge_originator
));
3710 memcpy(tlvs
->purge_originator
->generator
, generator
,
3711 sizeof(tlvs
->purge_originator
->generator
));
3713 tlvs
->purge_originator
->sender_set
= true;
3714 memcpy(tlvs
->purge_originator
->sender
, sender
,
3715 sizeof(tlvs
->purge_originator
->sender
));