]> git.proxmox.com Git - mirror_frr.git/blame - bgpd/bgp_encap_tlv.c
projects / mirror_frr.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge pull request #5717 from pguibert6WIND/flowspec_issue_redistribute
[mirror_frr.git] / bgpd / bgp_encap_tlv.c
CommitLineData
f4c89855
LB		 1/*
2 * Copyright 2015, LabN Consulting, L.L.C.
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version 2
7 * of the License, or (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
896014f4
DL		 14 * You should have received a copy of the GNU General Public License along
15 * with this program; see the file COPYING; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
f4c89855
LB		 17 */
18
19#include <zebra.h>
20
5bf15956 21#include "command.h"
f4c89855
LB		 22#include "memory.h"
23#include "prefix.h"
f4c89855 24#include "filter.h"
937652c6 25#include "stream.h"
f4c89855
LB		 26
27#include "bgpd.h"
28#include "bgp_attr.h"
29
30#include "bgp_encap_types.h"
31#include "bgp_encap_tlv.h"
32
33/***********************************************************************
34 * SUBTLV ENCODE
35 ***********************************************************************/
36
37/* rfc5512 4.1 */
d62a17ae 38static struct bgp_attr_encap_subtlv *subtlv_encode_encap_l2tpv3_over_ip(
39 struct bgp_tea_subtlv_encap_l2tpv3_over_ip *st)
f4c89855 40{
d62a17ae 41 struct bgp_attr_encap_subtlv *new;
42 uint8_t *p;
43 int total = 4 + st->cookie_length;
f4c89855 44
d62a17ae 45 /* sanity check */
46 assert(st->cookie_length <= sizeof(st->cookie));
47 assert(total <= 0xff);
f4c89855 48
d62a17ae 49 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 50 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 51 assert(new);
52 new->type = BGP_ENCAP_SUBTLV_TYPE_ENCAPSULATION;
53 new->length = total;
54 p = new->value;
f4c89855 55
d62a17ae 56 *p++ = (st->sessionid & 0xff000000) >> 24;
57 *p++ = (st->sessionid & 0xff0000) >> 16;
58 *p++ = (st->sessionid & 0xff00) >> 8;
59 *p++ = (st->sessionid & 0xff);
60 memcpy(p, st->cookie, st->cookie_length);
61 return new;
f4c89855
LB		 62}
63
64/* rfc5512 4.1 */
65static struct bgp_attr_encap_subtlv *
d62a17ae 66subtlv_encode_encap_gre(struct bgp_tea_subtlv_encap_gre_key *st)
f4c89855 67{
d62a17ae 68 struct bgp_attr_encap_subtlv *new;
69 uint8_t *p;
70 int total = 4;
f4c89855 71
d62a17ae 72 assert(total <= 0xff);
f4c89855 73
d62a17ae 74 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 75 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 76 assert(new);
77 new->type = BGP_ENCAP_SUBTLV_TYPE_ENCAPSULATION;
78 new->length = total;
79 p = new->value;
f4c89855 80
d62a17ae 81 *p++ = (st->gre_key & 0xff000000) >> 24;
82 *p++ = (st->gre_key & 0xff0000) >> 16;
83 *p++ = (st->gre_key & 0xff00) >> 8;
84 *p++ = (st->gre_key & 0xff);
85 return new;
f4c89855
LB		 86}
87
88static struct bgp_attr_encap_subtlv *
d62a17ae 89subtlv_encode_encap_pbb(struct bgp_tea_subtlv_encap_pbb *st)
90{
91 struct bgp_attr_encap_subtlv *new;
92 uint8_t *p;
93 int total = 1 + 3 + 6 + 2; /* flags + isid + madaddr + vid */
94
95 assert(total <= 0xff);
96
97 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 98 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 99 assert(new);
100 new->type = BGP_ENCAP_SUBTLV_TYPE_ENCAPSULATION;
101 new->length = total;
102 p = new->value;
103
104 *p++ = (st->flag_isid ? 0x80 : 0) | (st->flag_vid ? 0x40 : 0) | 0;
105 if (st->flag_isid) {
106 *p = (st->isid & 0xff0000) >> 16;
107 *(p + 1) = (st->isid & 0xff00) >> 8;
108 *(p + 2) = (st->isid & 0xff);
109 }
110 p += 3;
111 memcpy(p, st->macaddr, 6);
112 p += 6;
113 if (st->flag_vid) {
114 *p++ = (st->vid & 0xf00) >> 8;
115 *p++ = st->vid & 0xff;
116 }
117 return new;
f4c89855
LB		 118}
119
120/* rfc5512 4.2 */
121static struct bgp_attr_encap_subtlv *
d62a17ae 122subtlv_encode_proto_type(struct bgp_tea_subtlv_proto_type *st)
f4c89855 123{
d62a17ae 124 struct bgp_attr_encap_subtlv *new;
125 uint8_t *p;
126 int total = 2;
f4c89855 127
d62a17ae 128 assert(total <= 0xff);
f4c89855 129
d62a17ae 130 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 131 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 132 assert(new);
133 new->type = BGP_ENCAP_SUBTLV_TYPE_PROTO_TYPE;
134 new->length = total;
135 p = new->value;
f4c89855 136
d62a17ae 137 *p++ = (st->proto & 0xff00) >> 8;
138 *p++ = (st->proto & 0xff);
139 return new;
f4c89855
LB		 140}
141
142/* rfc5512 4.3 */
143static struct bgp_attr_encap_subtlv *
d62a17ae 144subtlv_encode_color(struct bgp_tea_subtlv_color *st)
f4c89855 145{
d62a17ae 146 struct bgp_attr_encap_subtlv *new;
147 uint8_t *p;
148 int total = 8;
f4c89855 149
d62a17ae 150 assert(total <= 0xff);
f4c89855 151
d62a17ae 152 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 153 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 154 assert(new);
155 new->type = BGP_ENCAP_SUBTLV_TYPE_COLOR;
156 new->length = total;
157 p = new->value;
f4c89855 158
d62a17ae 159 *p++ = 0x03; /* transitive*/
160 *p++ = 0x0b;
161 *p++ = 0; /* reserved */
162 *p++ = 0; /* reserved */
f4c89855 163
d62a17ae 164 *p++ = (st->color & 0xff000000) >> 24;
165 *p++ = (st->color & 0xff0000) >> 16;
166 *p++ = (st->color & 0xff00) >> 8;
167 *p++ = (st->color & 0xff);
f4c89855 168
d62a17ae 169 return new;
f4c89855
LB		 170}
171
172/* rfc 5566 4. */
173static struct bgp_attr_encap_subtlv *
d62a17ae 174subtlv_encode_ipsec_ta(struct bgp_tea_subtlv_ipsec_ta *st)
f4c89855 175{
d62a17ae 176 struct bgp_attr_encap_subtlv *new;
177 uint8_t *p;
178 int total = 2 + st->authenticator_length;
f4c89855 179
d62a17ae 180 /* sanity check */
181 assert(st->authenticator_length <= sizeof(st->value));
182 assert(total <= 0xff);
f4c89855 183
d62a17ae 184 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 185 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 186 assert(new);
187 new->type = BGP_ENCAP_SUBTLV_TYPE_IPSEC_TA;
188 new->length = total;
189 p = new->value;
f4c89855 190
d62a17ae 191 *p++ = (st->authenticator_type & 0xff00) >> 8;
192 *p++ = st->authenticator_type & 0xff;
193 memcpy(p, st->value, st->authenticator_length);
194 return new;
f4c89855
LB		 195}
196
587ff0fd
LB		 197/* draft-rosen-idr-tunnel-encaps 2.1 */
198static struct bgp_attr_encap_subtlv *
d62a17ae 199subtlv_encode_remote_endpoint(struct bgp_tea_subtlv_remote_endpoint *st)
200{
201 struct bgp_attr_encap_subtlv *new;
202 uint8_t *p;
203
204 int total = (st->family == AF_INET ? 8 : 20);
205
206 assert(total <= 0xff);
207
208 new = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 209 sizeof(struct bgp_attr_encap_subtlv) + total);
d62a17ae 210 assert(new);
211 new->type = BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT;
212 new->length = total;
213 p = new->value;
214 if (st->family == AF_INET) {
215 memcpy(p, &(st->ip_address.v4.s_addr), 4);
216 p += 4;
217 } else {
218 assert(st->family == AF_INET6);
219 memcpy(p, &(st->ip_address.v6.s6_addr), 16);
220 p += 16;
221 }
222 memcpy(p, &(st->as4), 4);
223 return new;
587ff0fd 224}
f4c89855
LB		 225
226/***********************************************************************
227 * TUNNEL TYPE-SPECIFIC TLV ENCODE
228 ***********************************************************************/
229
230/*
231 * requires "extra" and "last" to be defined in caller
232 */
d62a17ae 233#define ENC_SUBTLV(flag, function, field) \
234 do { \
235 struct bgp_attr_encap_subtlv *new; \
236 if (CHECK_FLAG(bet->valid_subtlvs, (flag))) { \
237 new = function(&bet->field); \
238 if (last) { \
239 last->next = new; \
240 } else { \
241 attr->encap_subtlvs = new; \
242 } \
243 last = new; \
244 } \
245 } while (0)
f4c89855 246
d62a17ae 247void bgp_encap_type_l2tpv3overip_to_tlv(
248 struct bgp_encap_type_l2tpv3_over_ip *bet, /* input structure */
249 struct attr *attr)
f4c89855 250{
d62a17ae 251 struct bgp_attr_encap_subtlv *last;
f4c89855 252
d62a17ae 253 /* advance to last subtlv */
254 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
255 ;
f4c89855 256
d62a17ae 257 attr->encap_tunneltype = BGP_ENCAP_TYPE_L2TPV3_OVER_IP;
f4c89855 258
d62a17ae 259 assert(CHECK_FLAG(bet->valid_subtlvs, BGP_TEA_SUBTLV_ENCAP));
f4c89855 260
d62a17ae 261 ENC_SUBTLV(BGP_TEA_SUBTLV_ENCAP, subtlv_encode_encap_l2tpv3_over_ip,
262 st_encap);
263 ENC_SUBTLV(BGP_TEA_SUBTLV_PROTO_TYPE, subtlv_encode_proto_type,
264 st_proto);
265 ENC_SUBTLV(BGP_TEA_SUBTLV_COLOR, subtlv_encode_color, st_color);
266 ENC_SUBTLV(BGP_TEA_SUBTLV_REMOTE_ENDPOINT,
267 subtlv_encode_remote_endpoint, st_endpoint);
f4c89855
LB		 268}
269
d62a17ae 270void bgp_encap_type_gre_to_tlv(
271 struct bgp_encap_type_gre *bet, /* input structure */
272 struct attr *attr)
f4c89855 273{
d62a17ae 274 struct bgp_attr_encap_subtlv *last;
f4c89855 275
d62a17ae 276 /* advance to last subtlv */
277 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
278 ;
f4c89855 279
d62a17ae 280 attr->encap_tunneltype = BGP_ENCAP_TYPE_GRE;
f4c89855 281
d62a17ae 282 ENC_SUBTLV(BGP_TEA_SUBTLV_ENCAP, subtlv_encode_encap_gre, st_encap);
283 ENC_SUBTLV(BGP_TEA_SUBTLV_PROTO_TYPE, subtlv_encode_proto_type,
284 st_proto);
285 ENC_SUBTLV(BGP_TEA_SUBTLV_COLOR, subtlv_encode_color, st_color);
286 ENC_SUBTLV(BGP_TEA_SUBTLV_REMOTE_ENDPOINT,
287 subtlv_encode_remote_endpoint, st_endpoint);
f4c89855
LB		 288}
289
d62a17ae 290void bgp_encap_type_ip_in_ip_to_tlv(
291 struct bgp_encap_type_ip_in_ip *bet, /* input structure */
292 struct attr *attr)
f4c89855 293{
d62a17ae 294 struct bgp_attr_encap_subtlv *last;
f4c89855 295
d62a17ae 296 /* advance to last subtlv */
297 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
298 ;
f4c89855 299
d62a17ae 300 attr->encap_tunneltype = BGP_ENCAP_TYPE_IP_IN_IP;
f4c89855 301
d62a17ae 302 ENC_SUBTLV(BGP_TEA_SUBTLV_PROTO_TYPE, subtlv_encode_proto_type,
303 st_proto);
304 ENC_SUBTLV(BGP_TEA_SUBTLV_COLOR, subtlv_encode_color, st_color);
305 ENC_SUBTLV(BGP_TEA_SUBTLV_REMOTE_ENDPOINT,
306 subtlv_encode_remote_endpoint, st_endpoint);
f4c89855
LB		 307}
308
d62a17ae 309void bgp_encap_type_transmit_tunnel_endpoint(
310 struct bgp_encap_type_transmit_tunnel_endpoint
311 *bet, /* input structure */
312 struct attr *attr)
f4c89855 313{
d62a17ae 314 struct bgp_attr_encap_subtlv *last;
f4c89855 315
d62a17ae 316 /* advance to last subtlv */
317 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
318 ;
f4c89855 319
d62a17ae 320 attr->encap_tunneltype = BGP_ENCAP_TYPE_TRANSMIT_TUNNEL_ENDPOINT;
f4c89855 321
d62a17ae 322 /* no subtlvs for this type */
f4c89855
LB		 323}
324
d62a17ae 325void bgp_encap_type_ipsec_in_tunnel_mode_to_tlv(
326 struct bgp_encap_type_ipsec_in_tunnel_mode *bet, /* input structure */
327 struct attr *attr)
f4c89855 328{
d62a17ae 329 struct bgp_attr_encap_subtlv *last;
f4c89855 330
d62a17ae 331 /* advance to last subtlv */
332 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
333 ;
f4c89855 334
d62a17ae 335 attr->encap_tunneltype = BGP_ENCAP_TYPE_IPSEC_IN_TUNNEL_MODE;
f4c89855 336
d62a17ae 337 ENC_SUBTLV(BGP_TEA_SUBTLV_IPSEC_TA, subtlv_encode_ipsec_ta,
338 st_ipsec_ta);
f4c89855
LB		 339}
340
d62a17ae 341void bgp_encap_type_ip_in_ip_tunnel_with_ipsec_transport_mode_to_tlv(
342 struct bgp_encap_type_ip_in_ip_tunnel_with_ipsec_transport_mode
343 *bet, /* input structure */
344 struct attr *attr)
f4c89855 345{
d62a17ae 346 struct bgp_attr_encap_subtlv *last;
f4c89855 347
d62a17ae 348 /* advance to last subtlv */
349 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
350 ;
f4c89855 351
d62a17ae 352 attr->encap_tunneltype =
353 BGP_ENCAP_TYPE_IP_IN_IP_TUNNEL_WITH_IPSEC_TRANSPORT_MODE;
f4c89855 354
d62a17ae 355 ENC_SUBTLV(BGP_TEA_SUBTLV_IPSEC_TA, subtlv_encode_ipsec_ta,
356 st_ipsec_ta);
f4c89855
LB		 357}
358
d62a17ae 359void bgp_encap_type_mpls_in_ip_tunnel_with_ipsec_transport_mode_to_tlv(
360 struct bgp_encap_type_mpls_in_ip_tunnel_with_ipsec_transport_mode
361 *bet, /* input structure */
362 struct attr *attr)
f4c89855 363{
d62a17ae 364 struct bgp_attr_encap_subtlv *last;
f4c89855 365
d62a17ae 366 /* advance to last subtlv */
367 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
368 ;
f4c89855 369
d62a17ae 370 attr->encap_tunneltype =
371 BGP_ENCAP_TYPE_MPLS_IN_IP_TUNNEL_WITH_IPSEC_TRANSPORT_MODE;
f4c89855 372
d62a17ae 373 ENC_SUBTLV(BGP_TEA_SUBTLV_IPSEC_TA, subtlv_encode_ipsec_ta,
374 st_ipsec_ta);
f4c89855
LB		 375}
376
d62a17ae 377void bgp_encap_type_pbb_to_tlv(
378 struct bgp_encap_type_pbb *bet, /* input structure */
379 struct attr *attr)
f4c89855 380{
d62a17ae 381 struct bgp_attr_encap_subtlv *last;
f4c89855 382
d62a17ae 383 /* advance to last subtlv */
384 for (last = attr->encap_subtlvs; last && last->next; last = last->next)
385 ;
f4c89855 386
d62a17ae 387 attr->encap_tunneltype = BGP_ENCAP_TYPE_PBB;
f4c89855 388
d62a17ae 389 assert(CHECK_FLAG(bet->valid_subtlvs, BGP_TEA_SUBTLV_ENCAP));
390 ENC_SUBTLV(BGP_TEA_SUBTLV_ENCAP, subtlv_encode_encap_pbb, st_encap);
f4c89855
LB		 391}
392
d62a17ae 393void bgp_encap_type_vxlan_to_tlv(
394 struct bgp_encap_type_vxlan *bet, /* input structure */
395 struct attr *attr)
f4c89855 396{
d62a17ae 397 struct bgp_attr_encap_subtlv *tlv;
398 uint32_t vnid;
f4c89855 399
d62a17ae 400 attr->encap_tunneltype = BGP_ENCAP_TYPE_VXLAN;
aee875b5 401
d62a17ae 402 if (bet == NULL || !bet->vnid)
403 return;
0a22ddfb 404 XFREE(MTYPE_ENCAP_TLV, attr->encap_subtlvs);
d62a17ae 405 tlv = XCALLOC(MTYPE_ENCAP_TLV,
12f70478 406 sizeof(struct bgp_attr_encap_subtlv) + 12);
d62a17ae 407 tlv->type = 1; /* encapsulation type */
408 tlv->length = 12;
409 if (bet->vnid) {
410 vnid = htonl(bet->vnid | VXLAN_ENCAP_MASK_VNID_VALID);
411 memcpy(&tlv->value, &vnid, 4);
412 }
413 if (bet->mac_address) {
414 char *ptr = (char *)&tlv->value + 4;
415 memcpy(ptr, bet->mac_address, 6);
416 }
417 attr->encap_subtlvs = tlv;
418 return;
f4c89855
LB		 419}
420
d62a17ae 421void bgp_encap_type_nvgre_to_tlv(
422 struct bgp_encap_type_nvgre *bet, /* input structure */
423 struct attr *attr)
f4c89855 424{
d62a17ae 425 attr->encap_tunneltype = BGP_ENCAP_TYPE_NVGRE;
f4c89855
LB		 426}
427
d62a17ae 428void bgp_encap_type_mpls_to_tlv(
429 struct bgp_encap_type_mpls *bet, /* input structure */
430 struct attr *attr)
f4c89855 431{
d62a17ae 432 return; /* no encap attribute for MPLS */
f4c89855
LB		 433}
434
d62a17ae 435void bgp_encap_type_mpls_in_gre_to_tlv(
436 struct bgp_encap_type_mpls_in_gre *bet, /* input structure */
437 struct attr *attr)
f4c89855 438{
d62a17ae 439 attr->encap_tunneltype = BGP_ENCAP_TYPE_MPLS_IN_GRE;
f4c89855
LB		 440}
441
d62a17ae 442void bgp_encap_type_vxlan_gpe_to_tlv(
443 struct bgp_encap_type_vxlan_gpe *bet, /* input structure */
444 struct attr *attr)
f4c89855 445{
f4c89855 446
d62a17ae 447 attr->encap_tunneltype = BGP_ENCAP_TYPE_VXLAN_GPE;
f4c89855
LB		 448}
449
d62a17ae 450void bgp_encap_type_mpls_in_udp_to_tlv(
451 struct bgp_encap_type_mpls_in_udp *bet, /* input structure */
452 struct attr *attr)
f4c89855 453{
f4c89855 454
d62a17ae 455 attr->encap_tunneltype = BGP_ENCAP_TYPE_MPLS_IN_UDP;
f4c89855
LB		 456}
457
458
459/***********************************************************************
460 * SUBTLV DECODE
461 ***********************************************************************/
462/* rfc5512 4.1 */
d62a17ae 463static int subtlv_decode_encap_l2tpv3_over_ip(
464 struct bgp_attr_encap_subtlv *subtlv,
465 struct bgp_tea_subtlv_encap_l2tpv3_over_ip *st)
466{
467 if (subtlv->length < 4) {
468 zlog_debug("%s, subtlv length %d is less than 4", __func__,
469 subtlv->length);
470 return -1;
471 }
472
937652c6 473 ptr_get_be32(subtlv->value, &st->sessionid);
d62a17ae 474 st->cookie_length = subtlv->length - 4;
475 if (st->cookie_length > sizeof(st->cookie)) {
476 zlog_debug("%s, subtlv length %d is greater than %d", __func__,
477 st->cookie_length, (int)sizeof(st->cookie));
478 return -1;
479 }
480 memcpy(st->cookie, subtlv->value + 4, st->cookie_length);
481 return 0;
f4c89855
LB		 482}
483
484/* rfc5512 4.1 */
d62a17ae 485static int subtlv_decode_encap_gre(struct bgp_attr_encap_subtlv *subtlv,
486 struct bgp_tea_subtlv_encap_gre_key *st)
487{
488 if (subtlv->length != 4) {
489 zlog_debug("%s, subtlv length %d does not equal 4", __func__,
490 subtlv->length);
491 return -1;
492 }
937652c6 493 ptr_get_be32(subtlv->value, &st->gre_key);
d62a17ae 494 return 0;
f4c89855
LB		 495}
496
d62a17ae 497static int subtlv_decode_encap_pbb(struct bgp_attr_encap_subtlv *subtlv,
498 struct bgp_tea_subtlv_encap_pbb *st)
499{
500 if (subtlv->length != 1 + 3 + 6 + 2) {
501 zlog_debug("%s, subtlv length %d does not equal %d", __func__,
502 subtlv->length, 1 + 3 + 6 + 2);
503 return -1;
504 }
505 if (subtlv->value[0] & 0x80) {
506 st->flag_isid = 1;
507 st->isid = (subtlv->value[1] << 16) | (subtlv->value[2] << 8)
508 | subtlv->value[3];
509 }
510 if (subtlv->value[0] & 0x40) {
511 st->flag_vid = 1;
512 st->vid = ((subtlv->value[10] & 0x0f) << 8) | subtlv->value[11];
513 }
514 memcpy(st->macaddr, subtlv->value + 4, 6);
515 return 0;
f4c89855
LB		 516}
517
518/* rfc5512 4.2 */
d62a17ae 519static int subtlv_decode_proto_type(struct bgp_attr_encap_subtlv *subtlv,
520 struct bgp_tea_subtlv_proto_type *st)
f4c89855 521{
d62a17ae 522 if (subtlv->length != 2) {
523 zlog_debug("%s, subtlv length %d does not equal 2", __func__,
524 subtlv->length);
525 return -1;
526 }
527 st->proto = (subtlv->value[0] << 8) | subtlv->value[1];
528 return 0;
f4c89855
LB		 529}
530
531/* rfc5512 4.3 */
d62a17ae 532static int subtlv_decode_color(struct bgp_attr_encap_subtlv *subtlv,
533 struct bgp_tea_subtlv_color *st)
534{
535 if (subtlv->length != 8) {
536 zlog_debug("%s, subtlv length %d does not equal 8", __func__,
537 subtlv->length);
538 return -1;
539 }
540 if ((subtlv->value[0] != 0x03) || (subtlv->value[1] != 0x0b)
541 || (subtlv->value[2] != 0) || (subtlv->value[3] != 0)) {
542 zlog_debug("%s, subtlv value 1st 4 bytes are not 0x030b0000",
543 __func__);
544 return -1;
545 }
937652c6 546 ptr_get_be32(subtlv->value + 4, &st->color);
d62a17ae 547 return 0;
f4c89855
LB		 548}
549
550/* rfc 5566 4. */
d62a17ae 551static int subtlv_decode_ipsec_ta(struct bgp_attr_encap_subtlv *subtlv,
552 struct bgp_tea_subtlv_ipsec_ta *st)
553{
554 st->authenticator_length = subtlv->length - 2;
555 if (st->authenticator_length > sizeof(st->value)) {
556 zlog_debug(
557 "%s, authenticator length %d exceeds storage maximum %d",
558 __func__, st->authenticator_length,
559 (int)sizeof(st->value));
560 return -1;
561 }
562 st->authenticator_type = (subtlv->value[0] << 8) | subtlv->value[1];
563 memcpy(st->value, subtlv->value + 2, st->authenticator_length);
564 return 0;
f4c89855
LB		 565}
566
587ff0fd
LB		 567/* draft-rosen-idr-tunnel-encaps 2.1 */
568static int
d62a17ae 569subtlv_decode_remote_endpoint(struct bgp_attr_encap_subtlv *subtlv,
570 struct bgp_tea_subtlv_remote_endpoint *st)
571{
572 int i;
573 if (subtlv->length != 8 && subtlv->length != 20) {
574 zlog_debug("%s, subtlv length %d does not equal 8 or 20",
575 __func__, subtlv->length);
576 return -1;
577 }
578 if (subtlv->length == 8) {
579 st->family = AF_INET;
937652c6 580 memcpy(&st->ip_address.v4.s_addr, subtlv->value, 4);
d62a17ae 581 } else {
582 st->family = AF_INET6;
583 memcpy(&(st->ip_address.v6.s6_addr), subtlv->value, 16);
584 }
585 i = subtlv->length - 4;
937652c6 586 ptr_get_be32(subtlv->value + i, &st->as4);
d62a17ae 587 return 0;
587ff0fd
LB		 588}
589
f4c89855
LB		 590/***********************************************************************
591 * TUNNEL TYPE-SPECIFIC TLV DECODE
592 ***********************************************************************/
593
d62a17ae 594int tlv_to_bgp_encap_type_l2tpv3overip(
595 struct bgp_attr_encap_subtlv *stlv, /* subtlv chain */
596 struct bgp_encap_type_l2tpv3_over_ip *bet) /* caller-allocated */
597{
598 struct bgp_attr_encap_subtlv *st;
599 int rc = 0;
600
601 for (st = stlv; st; st = st->next) {
602 switch (st->type) {
603 case BGP_ENCAP_SUBTLV_TYPE_ENCAPSULATION:
604 rc |= subtlv_decode_encap_l2tpv3_over_ip(
605 st, &bet->st_encap);
606 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_ENCAP);
607 break;
608
609 case BGP_ENCAP_SUBTLV_TYPE_PROTO_TYPE:
610 rc |= subtlv_decode_proto_type(st, &bet->st_proto);
611 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_PROTO_TYPE);
612 break;
613
614 case BGP_ENCAP_SUBTLV_TYPE_COLOR:
615 rc |= subtlv_decode_color(st, &bet->st_color);
616 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_COLOR);
617 break;
618
619 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
620 rc |= subtlv_decode_remote_endpoint(st,
621 &bet->st_endpoint);
622 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
623 break;
624
625 default:
626 zlog_debug("%s: unexpected subtlv type %d", __func__,
627 st->type);
628 rc |= -1;
629 break;
630 }
f4c89855 631 }
d62a17ae 632 return rc;
633}
634
635int tlv_to_bgp_encap_type_gre(
636 struct bgp_attr_encap_subtlv *stlv, /* subtlv chain */
637 struct bgp_encap_type_gre *bet) /* caller-allocated */
638{
639 struct bgp_attr_encap_subtlv *st;
640 int rc = 0;
641
642 for (st = stlv; st; st = st->next) {
643 switch (st->type) {
644 case BGP_ENCAP_SUBTLV_TYPE_ENCAPSULATION:
645 rc |= subtlv_decode_encap_gre(st, &bet->st_encap);
646 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_ENCAP);
647 break;
648
649 case BGP_ENCAP_SUBTLV_TYPE_PROTO_TYPE:
650 rc |= subtlv_decode_proto_type(st, &bet->st_proto);
651 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_PROTO_TYPE);
652 break;
653
654 case BGP_ENCAP_SUBTLV_TYPE_COLOR:
655 rc |= subtlv_decode_color(st, &bet->st_color);
656 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_COLOR);
657 break;
658
659 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
660 rc |= subtlv_decode_remote_endpoint(st,
661 &bet->st_endpoint);
662 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
663 break;
664
665 default:
666 zlog_debug("%s: unexpected subtlv type %d", __func__,
667 st->type);
668 rc |= -1;
669 break;
670 }
f4c89855 671 }
d62a17ae 672 return rc;
673}
674
675int tlv_to_bgp_encap_type_ip_in_ip(
676 struct bgp_attr_encap_subtlv *stlv, /* subtlv chain */
677 struct bgp_encap_type_ip_in_ip *bet) /* caller-allocated */
678{
679 struct bgp_attr_encap_subtlv *st;
680 int rc = 0;
681
682 for (st = stlv; st; st = st->next) {
683 switch (st->type) {
684 case BGP_ENCAP_SUBTLV_TYPE_PROTO_TYPE:
685 rc |= subtlv_decode_proto_type(st, &bet->st_proto);
686 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_PROTO_TYPE);
687 break;
688
689 case BGP_ENCAP_SUBTLV_TYPE_COLOR:
690 rc |= subtlv_decode_color(st, &bet->st_color);
691 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_COLOR);
692 break;
693
694 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
695 rc |= subtlv_decode_remote_endpoint(st,
696 &bet->st_endpoint);
697 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
698 break;
699
700 default:
701 zlog_debug("%s: unexpected subtlv type %d", __func__,
702 st->type);
703 rc |= -1;
704 break;
705 }
f4c89855 706 }
d62a17ae 707 return rc;
f4c89855
LB		 708}
709
d62a17ae 710int tlv_to_bgp_encap_type_transmit_tunnel_endpoint(
711 struct bgp_attr_encap_subtlv *stlv,
712 struct bgp_encap_type_transmit_tunnel_endpoint *bet)
f4c89855 713{
d62a17ae 714 struct bgp_attr_encap_subtlv *st;
715 int rc = 0;
f4c89855 716
d62a17ae 717 for (st = stlv; st; st = st->next) {
718 switch (st->type) {
587ff0fd 719
d62a17ae 720 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
721 rc |= subtlv_decode_remote_endpoint(st,
722 &bet->st_endpoint);
723 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
724 break;
587ff0fd 725
d62a17ae 726 default:
727 zlog_debug("%s: unexpected subtlv type %d", __func__,
728 st->type);
729 rc |= -1;
730 break;
731 }
f4c89855 732 }
d62a17ae 733 return rc;
734}
735
736int tlv_to_bgp_encap_type_ipsec_in_tunnel_mode(
737 struct bgp_attr_encap_subtlv *stlv, /* subtlv chain */
738 struct bgp_encap_type_ipsec_in_tunnel_mode *bet) /* caller-allocated */
739{
740 struct bgp_attr_encap_subtlv *st;
741 int rc = 0;
742
743 for (st = stlv; st; st = st->next) {
744 switch (st->type) {
745 case BGP_ENCAP_SUBTLV_TYPE_IPSEC_TA:
746 rc |= subtlv_decode_ipsec_ta(st, &bet->st_ipsec_ta);
747 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_IPSEC_TA);
748 break;
749
750 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
751 rc |= subtlv_decode_remote_endpoint(st,
752 &bet->st_endpoint);
753 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
754 break;
755
756 default:
757 zlog_debug("%s: unexpected subtlv type %d", __func__,
758 st->type);
759 rc |= -1;
760 break;
761 }
f4c89855 762 }
d62a17ae 763 return rc;
764}
765
766int tlv_to_bgp_encap_type_ip_in_ip_tunnel_with_ipsec_transport_mode(
767 struct bgp_attr_encap_subtlv *stlv,
768 struct bgp_encap_type_ip_in_ip_tunnel_with_ipsec_transport_mode *bet)
769{
770 struct bgp_attr_encap_subtlv *st;
771 int rc = 0;
772
773 for (st = stlv; st; st = st->next) {
774 switch (st->type) {
775 case BGP_ENCAP_SUBTLV_TYPE_IPSEC_TA:
776 rc |= subtlv_decode_ipsec_ta(st, &bet->st_ipsec_ta);
777 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_IPSEC_TA);
778 break;
779
780 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
781 rc |= subtlv_decode_remote_endpoint(st,
782 &bet->st_endpoint);
783 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
784 break;
785
786 default:
787 zlog_debug("%s: unexpected subtlv type %d", __func__,
788 st->type);
789 rc |= -1;
790 break;
791 }
f4c89855 792 }
d62a17ae 793 return rc;
794}
795
796int tlv_to_bgp_encap_type_mpls_in_ip_tunnel_with_ipsec_transport_mode(
797 struct bgp_attr_encap_subtlv *stlv,
798 struct bgp_encap_type_mpls_in_ip_tunnel_with_ipsec_transport_mode *bet)
799{
800 struct bgp_attr_encap_subtlv *st;
801 int rc = 0;
802
803 for (st = stlv; st; st = st->next) {
804 switch (st->type) {
805 case BGP_ENCAP_SUBTLV_TYPE_IPSEC_TA:
806 rc |= subtlv_decode_ipsec_ta(st, &bet->st_ipsec_ta);
807 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_IPSEC_TA);
808 break;
809
810 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
811 rc |= subtlv_decode_remote_endpoint(st,
812 &bet->st_endpoint);
813 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
814 break;
815
816 default:
817 zlog_debug("%s: unexpected subtlv type %d", __func__,
818 st->type);
819 rc |= -1;
820 break;
821 }
f4c89855 822 }
d62a17ae 823 return rc;
f4c89855
LB		 824}
825
d62a17ae 826int tlv_to_bgp_encap_type_vxlan(struct bgp_attr_encap_subtlv *stlv,
827 struct bgp_encap_type_vxlan *bet)
f4c89855 828{
d62a17ae 829 struct bgp_attr_encap_subtlv *st;
830 int rc = 0;
f4c89855 831
d62a17ae 832 for (st = stlv; st; st = st->next) {
833 switch (st->type) {
587ff0fd 834
d62a17ae 835 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
836 rc |= subtlv_decode_remote_endpoint(st,
837 &bet->st_endpoint);
838 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
839 break;
587ff0fd 840
d62a17ae 841 default:
842 zlog_debug("%s: unexpected subtlv type %d", __func__,
843 st->type);
844 rc |= -1;
845 break;
846 }
f4c89855 847 }
d62a17ae 848 return rc;
f4c89855
LB		 849}
850
d62a17ae 851int tlv_to_bgp_encap_type_nvgre(struct bgp_attr_encap_subtlv *stlv,
852 struct bgp_encap_type_nvgre *bet)
f4c89855 853{
d62a17ae 854 struct bgp_attr_encap_subtlv *st;
855 int rc = 0;
f4c89855 856
d62a17ae 857 for (st = stlv; st; st = st->next) {
858 switch (st->type) {
587ff0fd 859
d62a17ae 860 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
861 rc |= subtlv_decode_remote_endpoint(st,
862 &bet->st_endpoint);
863 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
864 break;
587ff0fd 865
d62a17ae 866 default:
867 zlog_debug("%s: unexpected subtlv type %d", __func__,
868 st->type);
869 rc |= -1;
870 break;
871 }
f4c89855 872 }
d62a17ae 873 return rc;
f4c89855
LB		 874}
875
d62a17ae 876int tlv_to_bgp_encap_type_mpls(struct bgp_attr_encap_subtlv *stlv,
877 struct bgp_encap_type_mpls *bet)
f4c89855 878{
d62a17ae 879 struct bgp_attr_encap_subtlv *st;
880 int rc = 0;
f4c89855 881
d62a17ae 882 for (st = stlv; st; st = st->next) {
883 switch (st->type) {
587ff0fd 884
d62a17ae 885 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
886 rc |= subtlv_decode_remote_endpoint(st,
887 &bet->st_endpoint);
888 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
889 break;
587ff0fd 890
d62a17ae 891 default:
892 zlog_debug("%s: unexpected subtlv type %d", __func__,
893 st->type);
894 rc |= -1;
895 break;
896 }
f4c89855 897 }
d62a17ae 898 return rc;
f4c89855
LB		 899}
900
d62a17ae 901int tlv_to_bgp_encap_type_mpls_in_gre(struct bgp_attr_encap_subtlv *stlv,
902 struct bgp_encap_type_mpls_in_gre *bet)
f4c89855 903{
d62a17ae 904 struct bgp_attr_encap_subtlv *st;
905 int rc = 0;
f4c89855 906
d62a17ae 907 for (st = stlv; st; st = st->next) {
908 switch (st->type) {
587ff0fd 909
d62a17ae 910 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
911 rc |= subtlv_decode_remote_endpoint(st,
912 &bet->st_endpoint);
913 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
914 break;
587ff0fd 915
d62a17ae 916 default:
917 zlog_debug("%s: unexpected subtlv type %d", __func__,
918 st->type);
919 rc |= -1;
920 break;
921 }
f4c89855 922 }
d62a17ae 923 return rc;
f4c89855
LB		 924}
925
d62a17ae 926int tlv_to_bgp_encap_type_vxlan_gpe(struct bgp_attr_encap_subtlv *stlv,
927 struct bgp_encap_type_vxlan_gpe *bet)
f4c89855 928{
d62a17ae 929 struct bgp_attr_encap_subtlv *st;
930 int rc = 0;
f4c89855 931
d62a17ae 932 for (st = stlv; st; st = st->next) {
933 switch (st->type) {
587ff0fd 934
d62a17ae 935 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
936 rc |= subtlv_decode_remote_endpoint(st,
937 &bet->st_endpoint);
938 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
939 break;
587ff0fd 940
d62a17ae 941 default:
942 zlog_debug("%s: unexpected subtlv type %d", __func__,
943 st->type);
944 rc |= -1;
945 break;
946 }
f4c89855 947 }
d62a17ae 948 return rc;
f4c89855
LB		 949}
950
d62a17ae 951int tlv_to_bgp_encap_type_mpls_in_udp(struct bgp_attr_encap_subtlv *stlv,
952 struct bgp_encap_type_mpls_in_udp *bet)
f4c89855 953{
d62a17ae 954 struct bgp_attr_encap_subtlv *st;
955 int rc = 0;
f4c89855 956
d62a17ae 957 for (st = stlv; st; st = st->next) {
958 switch (st->type) {
587ff0fd 959
d62a17ae 960 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
961 rc |= subtlv_decode_remote_endpoint(st,
962 &bet->st_endpoint);
963 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
964 break;
587ff0fd 965
d62a17ae 966 default:
967 zlog_debug("%s: unexpected subtlv type %d", __func__,
968 st->type);
969 rc |= -1;
970 break;
971 }
f4c89855 972 }
d62a17ae 973 return rc;
974}
975
976int tlv_to_bgp_encap_type_pbb(
977 struct bgp_attr_encap_subtlv *stlv, /* subtlv chain */
978 struct bgp_encap_type_pbb *bet) /* caller-allocated */
979{
980 struct bgp_attr_encap_subtlv *st;
981 int rc = 0;
982
983 for (st = stlv; st; st = st->next) {
984 switch (st->type) {
985 case BGP_ENCAP_SUBTLV_TYPE_ENCAPSULATION:
986 rc |= subtlv_decode_encap_pbb(st, &bet->st_encap);
987 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_ENCAP);
988 break;
989
990 case BGP_ENCAP_SUBTLV_TYPE_REMOTE_ENDPOINT:
991 rc |= subtlv_decode_remote_endpoint(st,
992 &bet->st_endpoint);
993 SET_SUBTLV_FLAG(bet, BGP_TEA_SUBTLV_REMOTE_ENDPOINT);
994 break;
995
996 default:
997 zlog_debug("%s: unexpected subtlv type %d", __func__,
998 st->type);
999 rc |= -1;
1000 break;
1001 }
f4c89855 1002 }
d62a17ae 1003 return rc;
f4c89855 1004}
FRRouting mirror