proxmox-mirrors/mirror_iproute2
1
0
Fork 0
mirror of https://git.proxmox.com/git/mirror_iproute2 synced 2025-10-14 03:12:54 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

iproute: add helper functions for SRH processing

Browse Source 
This patch adds two helper functions to print and parse
Segment Routing Headers.

Signed-off-by: David Lebrun <david.lebrun@uclouvain.be>
This commit is contained in:
David Lebrun 2017-08-09 17:33:24 +02:00 committed by Stephen Hemminger
parent b7f7c1b817
commit 00e76d4da3
1 changed files with 72 additions and 52 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

124
ip/iproute_lwtunnel.c
View File

@ -83,24 +83,10 @@ static int read_encap_type(const char *name)
return LWTUNNEL_ENCAP_NONE; return LWTUNNEL_ENCAP_NONE;
} }
static void print_encap_seg6(FILE *fp, struct rtattr *encap) static void print_srh(FILE *fp, struct ipv6_sr_hdr *srh)
{ {
struct rtattr *tb[SEG6_IPTUNNEL_MAX+1];
struct seg6_iptunnel_encap *tuninfo;
struct ipv6_sr_hdr *srh;
int i; int i;
parse_rtattr_nested(tb, SEG6_IPTUNNEL_MAX, encap);
if (!tb[SEG6_IPTUNNEL_SRH])
return;
tuninfo = RTA_DATA(tb[SEG6_IPTUNNEL_SRH]);
fprintf(fp, "mode %s ",
(tuninfo->mode == SEG6_IPTUN_MODE_ENCAP) ? "encap" : "inline");
srh = tuninfo->srh;
fprintf(fp, "segs %d [ ", srh->first_segment + 1); fprintf(fp, "segs %d [ ", srh->first_segment + 1);
for (i = srh->first_segment; i >= 0; i--) for (i = srh->first_segment; i >= 0; i--)
@ -118,6 +104,23 @@ static void print_encap_seg6(FILE *fp, struct rtattr *encap)
} }
} }
static void print_encap_seg6(FILE *fp, struct rtattr *encap)
{
struct rtattr *tb[SEG6_IPTUNNEL_MAX+1];
struct seg6_iptunnel_encap *tuninfo;
parse_rtattr_nested(tb, SEG6_IPTUNNEL_MAX, encap);
if (!tb[SEG6_IPTUNNEL_SRH])
return;
tuninfo = RTA_DATA(tb[SEG6_IPTUNNEL_SRH]);
fprintf(fp, "mode %s ",
(tuninfo->mode == SEG6_IPTUN_MODE_ENCAP) ? "encap" : "inline");
print_srh(fp, tuninfo->srh);
}
static void print_encap_mpls(FILE *fp, struct rtattr *encap) static void print_encap_mpls(FILE *fp, struct rtattr *encap)
{ {
struct rtattr *tb[MPLS_IPTUNNEL_MAX+1]; struct rtattr *tb[MPLS_IPTUNNEL_MAX+1];
@ -290,6 +293,55 @@ void lwt_print_encap(FILE *fp, struct rtattr *encap_type,
} }
} }
static struct ipv6_sr_hdr *parse_srh(char *segbuf, int hmac, bool encap)
{
struct ipv6_sr_hdr *srh;
int nsegs = 0;
int srhlen;
char *s;
int i;
s = segbuf;
for (i = 0; *s; *s++ == ',' ? i++ : *s);
nsegs = i + 1;
if (!encap)
nsegs++;
srhlen = 8 + 16*nsegs;
if (hmac)
srhlen += 40;
srh = malloc(srhlen);
memset(srh, 0, srhlen);
srh->hdrlen = (srhlen >> 3) - 1;
srh->type = 4;
srh->segments_left = nsegs - 1;
srh->first_segment = nsegs - 1;
if (hmac)
srh->flags |= SR6_FLAG1_HMAC;
i = srh->first_segment;
for (s = strtok(segbuf, ","); s; s = strtok(NULL, ",")) {
inet_get_addr(s, NULL, &srh->segments[i]);
i--;
}
if (hmac) {
struct sr6_tlv_hmac *tlv;
tlv = (struct sr6_tlv_hmac *)((char *)srh + srhlen - 40);
tlv->tlvhdr.type = SR6_TLV_HMAC;
tlv->tlvhdr.len = 38;
tlv->hmackeyid = htonl(hmac);
}
return srh;
}
static int parse_encap_seg6(struct rtattr *rta, size_t len, int *argcp, static int parse_encap_seg6(struct rtattr *rta, size_t len, int *argcp,
char ***argvp) char ***argvp)
{ {
@ -301,10 +353,7 @@ static int parse_encap_seg6(struct rtattr *rta, size_t len, int *argcp,
int argc = *argcp; int argc = *argcp;
int encap = -1; int encap = -1;
__u32 hmac = 0; __u32 hmac = 0;
int nsegs = 0;
int srhlen; int srhlen;
char *s;
int i;
while (argc > 0) { while (argc > 0) {
if (strcmp(*argv, "mode") == 0) { if (strcmp(*argv, "mode") == 0) {
@ -338,17 +387,8 @@ static int parse_encap_seg6(struct rtattr *rta, size_t len, int *argcp,
argc--; argv++; argc--; argv++;
} }
s = segbuf; srh = parse_srh(segbuf, hmac, encap);
for (i = 0; *s; *s++ == ',' ? i++ : *s); srhlen = (srh->hdrlen + 1) << 3;
nsegs = i + 1;
if (!encap)
nsegs++;
srhlen = 8 + 16*nsegs;
if (hmac)
srhlen += 40;
tuninfo = malloc(sizeof(*tuninfo) + srhlen); tuninfo = malloc(sizeof(*tuninfo) + srhlen);
memset(tuninfo, 0, sizeof(*tuninfo) + srhlen); memset(tuninfo, 0, sizeof(*tuninfo) + srhlen);
@ -358,33 +398,13 @@ static int parse_encap_seg6(struct rtattr *rta, size_t len, int *argcp,
else else
tuninfo->mode = SEG6_IPTUN_MODE_INLINE; tuninfo->mode = SEG6_IPTUN_MODE_INLINE;
srh = tuninfo->srh; memcpy(tuninfo->srh, srh, srhlen);
srh->hdrlen = (srhlen >> 3) - 1;
srh->type = 4;
srh->segments_left = nsegs - 1;
srh->first_segment = nsegs - 1;
if (hmac)
srh->flags |= SR6_FLAG1_HMAC;
i = srh->first_segment;
for (s = strtok(segbuf, ","); s; s = strtok(NULL, ",")) {
inet_get_addr(s, NULL, &srh->segments[i]);
i--;
}
if (hmac) {
struct sr6_tlv_hmac *tlv;
tlv = (struct sr6_tlv_hmac *)((char *)srh + srhlen - 40);
tlv->tlvhdr.type = SR6_TLV_HMAC;
tlv->tlvhdr.len = 38;
tlv->hmackeyid = htonl(hmac);
}
rta_addattr_l(rta, len, SEG6_IPTUNNEL_SRH, tuninfo, rta_addattr_l(rta, len, SEG6_IPTUNNEL_SRH, tuninfo,
sizeof(*tuninfo) + srhlen); sizeof(*tuninfo) + srhlen);
free(tuninfo); free(tuninfo);
free(srh);
*argcp = argc + 1; *argcp = argc + 1;
*argvp = argv - 1; *argvp = argv - 1;