|
Packit Service |
3880ab |
// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
|
|
Packit Service |
3880ab |
/* Copyright (C) 2019 Netronome Systems, Inc. */
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
#include <linux/if_ether.h>
|
|
Packit Service |
3880ab |
#include <linux/tc_act/tc_mpls.h>
|
|
Packit Service |
3880ab |
#include <stdio.h>
|
|
Packit Service |
3880ab |
#include <stdlib.h>
|
|
Packit Service |
3880ab |
#include <string.h>
|
|
Packit Service |
3880ab |
#include <unistd.h>
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
#include "utils.h"
|
|
Packit Service |
3880ab |
#include "rt_names.h"
|
|
Packit Service |
3880ab |
#include "tc_util.h"
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static const char * const action_names[] = {
|
|
Packit Service |
3880ab |
[TCA_MPLS_ACT_POP] = "pop",
|
|
Packit Service |
3880ab |
[TCA_MPLS_ACT_PUSH] = "push",
|
|
Packit Service |
3880ab |
[TCA_MPLS_ACT_MODIFY] = "modify",
|
|
Packit Service |
3880ab |
[TCA_MPLS_ACT_DEC_TTL] = "dec_ttl",
|
|
Packit Service |
3880ab |
};
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static void explain(void)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
fprintf(stderr,
|
|
Packit Service |
bd02ce |
"Usage: mpls pop [ protocol MPLS_PROTO ]\n"
|
|
Packit Service |
3880ab |
" mpls push [ protocol MPLS_PROTO ] [ label MPLS_LABEL ] [ tc MPLS_TC ]\n"
|
|
Packit Service |
3880ab |
" [ ttl MPLS_TTL ] [ bos MPLS_BOS ] [CONTROL]\n"
|
|
Packit Service |
bd02ce |
" mpls modify [ label MPLS_LABEL ] [ tc MPLS_TC ] [ ttl MPLS_TTL ] [CONTROL]\n"
|
|
Packit Service |
bd02ce |
" for pop MPLS_PROTO is next header of packet - e.g. ip or mpls_uc\n"
|
|
Packit Service |
bd02ce |
" for push MPLS_PROTO is one of mpls_uc or mpls_mc\n"
|
|
Packit Service |
3880ab |
" with default: mpls_uc\n"
|
|
Packit Service |
3880ab |
" CONTROL := reclassify | pipe | drop | continue | pass |\n"
|
|
Packit Service |
3880ab |
" goto chain <CHAIN_INDEX>\n");
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static void usage(void)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
explain();
|
|
Packit Service |
3880ab |
exit(-1);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static bool can_modify_mpls_fields(unsigned int action)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
bd02ce |
return action == TCA_MPLS_ACT_PUSH || action == TCA_MPLS_ACT_MODIFY;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
bd02ce |
static bool can_modify_ethtype(unsigned int action)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
bd02ce |
return action == TCA_MPLS_ACT_PUSH || action == TCA_MPLS_ACT_POP;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static bool is_valid_label(__u32 label)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
return label <= 0xfffff;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static bool check_double_action(unsigned int action, const char *arg)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
if (!action)
|
|
Packit Service |
3880ab |
return false;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
fprintf(stderr,
|
|
Packit Service |
3880ab |
"Error: got \"%s\" but action already set to \"%s\"\n",
|
|
Packit Service |
3880ab |
arg, action_names[action]);
|
|
Packit Service |
3880ab |
explain();
|
|
Packit Service |
3880ab |
return true;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static int parse_mpls(struct action_util *a, int *argc_p, char ***argv_p,
|
|
Packit Service |
3880ab |
int tca_id, struct nlmsghdr *n)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
struct tc_mpls parm = {};
|
|
Packit Service |
3880ab |
__u32 label = 0xffffffff;
|
|
Packit Service |
3880ab |
unsigned int action = 0;
|
|
Packit Service |
3880ab |
char **argv = *argv_p;
|
|
Packit Service |
3880ab |
struct rtattr *tail;
|
|
Packit Service |
3880ab |
int argc = *argc_p;
|
|
Packit Service |
3880ab |
__u16 proto = 0;
|
|
Packit Service |
3880ab |
__u8 bos = 0xff;
|
|
Packit Service |
3880ab |
__u8 tc = 0xff;
|
|
Packit Service |
3880ab |
__u8 ttl = 0;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (matches(*argv, "mpls") != 0)
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
while (argc > 0) {
|
|
Packit Service |
3880ab |
if (matches(*argv, "pop") == 0) {
|
|
Packit Service |
3880ab |
if (check_double_action(action, *argv))
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
action = TCA_MPLS_ACT_POP;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "push") == 0) {
|
|
Packit Service |
3880ab |
if (check_double_action(action, *argv))
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
action = TCA_MPLS_ACT_PUSH;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "modify") == 0) {
|
|
Packit Service |
3880ab |
if (check_double_action(action, *argv))
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
action = TCA_MPLS_ACT_MODIFY;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "dec_ttl") == 0) {
|
|
Packit Service |
3880ab |
if (check_double_action(action, *argv))
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
action = TCA_MPLS_ACT_DEC_TTL;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "label") == 0) {
|
|
Packit Service |
3880ab |
if (!can_modify_mpls_fields(action))
|
|
Packit Service |
bd02ce |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u32(&label, *argv, 0) || !is_valid_label(label))
|
|
Packit Service |
3880ab |
invarg("label must be <=0xFFFFF", *argv);
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "tc") == 0) {
|
|
Packit Service |
3880ab |
if (!can_modify_mpls_fields(action))
|
|
Packit Service |
bd02ce |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u8(&tc, *argv, 0) || (tc & ~0x7))
|
|
Packit Service |
3880ab |
invarg("tc field is 3 bits max", *argv);
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "ttl") == 0) {
|
|
Packit Service |
3880ab |
if (!can_modify_mpls_fields(action))
|
|
Packit Service |
bd02ce |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u8(&ttl, *argv, 0) || !ttl)
|
|
Packit Service |
3880ab |
invarg("ttl must be >0 and <=255", *argv);
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "bos") == 0) {
|
|
Packit Service |
3880ab |
if (!can_modify_mpls_fields(action))
|
|
Packit Service |
bd02ce |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u8(&bos, *argv, 0) || (bos & ~0x1))
|
|
Packit Service |
3880ab |
invarg("bos must be 0 or 1", *argv);
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "protocol") == 0) {
|
|
Packit Service |
bd02ce |
if (!can_modify_ethtype(action))
|
|
Packit Service |
bd02ce |
invarg("only valid for push/pop", *argv);
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (ll_proto_a2n(&proto, *argv))
|
|
Packit Service |
3880ab |
invarg("protocol is invalid", *argv);
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "help") == 0) {
|
|
Packit Service |
3880ab |
usage();
|
|
Packit Service |
3880ab |
} else {
|
|
Packit Service |
3880ab |
break;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
NEXT_ARG_FWD();
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (!action)
|
|
Packit Service |
3880ab |
incomplete_command();
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
parse_action_control_dflt(&argc, &argv, &parm.action,
|
|
Packit Service |
3880ab |
false, TC_ACT_PIPE);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (argc) {
|
|
Packit Service |
3880ab |
if (matches(*argv, "index") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u32(&parm.index, *argv, 10))
|
|
Packit Service |
3880ab |
invarg("illegal index", *argv);
|
|
Packit Service |
3880ab |
NEXT_ARG_FWD();
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (action == TCA_MPLS_ACT_PUSH && label == 0xffffffff)
|
|
Packit Service |
3880ab |
missarg("label");
|
|
Packit Service |
3880ab |
|
|
Packit Service |
bd02ce |
if (action == TCA_MPLS_ACT_PUSH && proto &&
|
|
Packit Service |
3880ab |
proto != htons(ETH_P_MPLS_UC) && proto != htons(ETH_P_MPLS_MC)) {
|
|
Packit Service |
3880ab |
fprintf(stderr,
|
|
Packit Service |
bd02ce |
"invalid push protocol \"0x%04x\" - use mpls_(uc|mc)\n",
|
|
Packit Service |
3880ab |
ntohs(proto));
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (action == TCA_MPLS_ACT_POP && !proto)
|
|
Packit Service |
3880ab |
missarg("protocol");
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
parm.m_action = action;
|
|
Packit Service |
3880ab |
tail = addattr_nest(n, MAX_MSG, tca_id | NLA_F_NESTED);
|
|
Packit Service |
3880ab |
addattr_l(n, MAX_MSG, TCA_MPLS_PARMS, &parm, sizeof(parm));
|
|
Packit Service |
3880ab |
if (label != 0xffffffff)
|
|
Packit Service |
3880ab |
addattr_l(n, MAX_MSG, TCA_MPLS_LABEL, &label, sizeof(label));
|
|
Packit Service |
3880ab |
if (proto)
|
|
Packit Service |
3880ab |
addattr_l(n, MAX_MSG, TCA_MPLS_PROTO, &proto, sizeof(proto));
|
|
Packit Service |
3880ab |
if (tc != 0xff)
|
|
Packit Service |
3880ab |
addattr8(n, MAX_MSG, TCA_MPLS_TC, tc);
|
|
Packit Service |
3880ab |
if (ttl)
|
|
Packit Service |
3880ab |
addattr8(n, MAX_MSG, TCA_MPLS_TTL, ttl);
|
|
Packit Service |
3880ab |
if (bos != 0xff)
|
|
Packit Service |
3880ab |
addattr8(n, MAX_MSG, TCA_MPLS_BOS, bos);
|
|
Packit Service |
3880ab |
addattr_nest_end(n, tail);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
*argc_p = argc;
|
|
Packit Service |
3880ab |
*argv_p = argv;
|
|
Packit Service |
3880ab |
return 0;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static int print_mpls(struct action_util *au, FILE *f, struct rtattr *arg)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
struct rtattr *tb[TCA_MPLS_MAX + 1];
|
|
Packit Service |
3880ab |
struct tc_mpls *parm;
|
|
Packit Service |
3880ab |
SPRINT_BUF(b1);
|
|
Packit Service |
3880ab |
__u32 val;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (!arg)
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
parse_rtattr_nested(tb, TCA_MPLS_MAX, arg);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (!tb[TCA_MPLS_PARMS]) {
|
|
Packit Service |
3880ab |
fprintf(stderr, "[NULL mpls parameters]\n");
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
parm = RTA_DATA(tb[TCA_MPLS_PARMS]);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
print_string(PRINT_ANY, "kind", "%s ", "mpls");
|
|
Packit Service |
3880ab |
print_string(PRINT_ANY, "mpls_action", " %s",
|
|
Packit Service |
3880ab |
action_names[parm->m_action]);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
switch (parm->m_action) {
|
|
Packit Service |
3880ab |
case TCA_MPLS_ACT_POP:
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_PROTO]) {
|
|
Packit Service |
3880ab |
__u16 proto;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
proto = rta_getattr_u16(tb[TCA_MPLS_PROTO]);
|
|
Packit Service |
3880ab |
print_string(PRINT_ANY, "protocol", " protocol %s",
|
|
Packit Service |
3880ab |
ll_proto_n2a(proto, b1, sizeof(b1)));
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
break;
|
|
Packit Service |
3880ab |
case TCA_MPLS_ACT_PUSH:
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_PROTO]) {
|
|
Packit Service |
3880ab |
__u16 proto;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
proto = rta_getattr_u16(tb[TCA_MPLS_PROTO]);
|
|
Packit Service |
3880ab |
print_string(PRINT_ANY, "protocol", " protocol %s",
|
|
Packit Service |
3880ab |
ll_proto_n2a(proto, b1, sizeof(b1)));
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
/* Fallthrough */
|
|
Packit Service |
3880ab |
case TCA_MPLS_ACT_MODIFY:
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_LABEL]) {
|
|
Packit Service |
3880ab |
val = rta_getattr_u32(tb[TCA_MPLS_LABEL]);
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "label", " label %u", val);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_TC]) {
|
|
Packit Service |
3880ab |
val = rta_getattr_u8(tb[TCA_MPLS_TC]);
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "tc", " tc %u", val);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_BOS]) {
|
|
Packit Service |
3880ab |
val = rta_getattr_u8(tb[TCA_MPLS_BOS]);
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "bos", " bos %u", val);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_TTL]) {
|
|
Packit Service |
3880ab |
val = rta_getattr_u8(tb[TCA_MPLS_TTL]);
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "ttl", " ttl %u", val);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
break;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
print_action_control(f, " ", parm->action, "");
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
print_nl();
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "index", "\t index %u", parm->index);
|
|
Packit Service |
3880ab |
print_int(PRINT_ANY, "ref", " ref %d", parm->refcnt);
|
|
Packit Service |
3880ab |
print_int(PRINT_ANY, "bind", " bind %d", parm->bindcnt);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (show_stats) {
|
|
Packit Service |
3880ab |
if (tb[TCA_MPLS_TM]) {
|
|
Packit Service |
3880ab |
struct tcf_t *tm = RTA_DATA(tb[TCA_MPLS_TM]);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
print_tm(f, tm);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
print_nl();
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
return 0;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
struct action_util mpls_action_util = {
|
|
Packit Service |
3880ab |
.id = "mpls",
|
|
Packit Service |
3880ab |
.parse_aopt = parse_mpls,
|
|
Packit Service |
3880ab |
.print_aopt = print_mpls,
|
|
Packit Service |
3880ab |
};
|