|
Packit Service |
3880ab |
/*
|
|
Packit Service |
3880ab |
* m_vlan.c vlan manipulation module
|
|
Packit Service |
3880ab |
*
|
|
Packit Service |
3880ab |
* This program is free software; you can redistribute it and/or
|
|
Packit Service |
3880ab |
* modify it under the terms of the GNU General Public License
|
|
Packit Service |
3880ab |
* as published by the Free Software Foundation; either version
|
|
Packit Service |
3880ab |
* 2 of the License, or (at your option) any later version.
|
|
Packit Service |
3880ab |
*
|
|
Packit Service |
3880ab |
* Authors: Jiri Pirko <jiri@resnulli.us>
|
|
Packit Service |
3880ab |
*/
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
#include <stdio.h>
|
|
Packit Service |
3880ab |
#include <stdlib.h>
|
|
Packit Service |
3880ab |
#include <unistd.h>
|
|
Packit Service |
3880ab |
#include <string.h>
|
|
Packit Service |
3880ab |
#include <linux/if_ether.h>
|
|
Packit Service |
3880ab |
#include "utils.h"
|
|
Packit Service |
3880ab |
#include "rt_names.h"
|
|
Packit Service |
3880ab |
#include "tc_util.h"
|
|
Packit Service |
3880ab |
#include <linux/tc_act/tc_vlan.h>
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static const char * const action_names[] = {
|
|
Packit Service |
3880ab |
[TCA_VLAN_ACT_POP] = "pop",
|
|
Packit Service |
3880ab |
[TCA_VLAN_ACT_PUSH] = "push",
|
|
Packit Service |
3880ab |
[TCA_VLAN_ACT_MODIFY] = "modify",
|
|
Packit Service |
52590c |
[TCA_VLAN_ACT_POP_ETH] = "pop_eth",
|
|
Packit Service |
52590c |
[TCA_VLAN_ACT_PUSH_ETH] = "push_eth",
|
|
Packit Service |
3880ab |
};
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static void explain(void)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
fprintf(stderr,
|
|
Packit Service |
860483 |
"Usage: vlan pop [CONTROL]\n"
|
|
Packit Service |
3880ab |
" vlan push [ protocol VLANPROTO ] id VLANID [ priority VLANPRIO ] [CONTROL]\n"
|
|
Packit Service |
3880ab |
" vlan modify [ protocol VLANPROTO ] id VLANID [ priority VLANPRIO ] [CONTROL]\n"
|
|
Packit Service |
52590c |
" vlan pop_eth [CONTROL]\n"
|
|
Packit Service |
52590c |
" vlan push_eth dst_mac LLADDR src_mac LLADDR [CONTROL]\n"
|
|
Packit Service |
3880ab |
" VLANPROTO is one of 802.1Q or 802.1AD\n"
|
|
Packit Service |
3880ab |
" with default: 802.1Q\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 has_push_attribs(int action)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
return action == TCA_VLAN_ACT_PUSH || action == TCA_VLAN_ACT_MODIFY;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static void unexpected(const char *arg)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
fprintf(stderr,
|
|
Packit Service |
3880ab |
"unexpected \"%s\" - action already specified\n",
|
|
Packit Service |
3880ab |
arg);
|
|
Packit Service |
3880ab |
explain();
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static int parse_vlan(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 |
int argc = *argc_p;
|
|
Packit Service |
3880ab |
char **argv = *argv_p;
|
|
Packit Service |
3880ab |
struct rtattr *tail;
|
|
Packit Service |
3880ab |
int action = 0;
|
|
Packit Service |
52590c |
char dst_mac[ETH_ALEN] = {};
|
|
Packit Service |
52590c |
int dst_mac_set = 0;
|
|
Packit Service |
52590c |
char src_mac[ETH_ALEN] = {};
|
|
Packit Service |
52590c |
int src_mac_set = 0;
|
|
Packit Service |
3880ab |
__u16 id;
|
|
Packit Service |
3880ab |
int id_set = 0;
|
|
Packit Service |
3880ab |
__u16 proto;
|
|
Packit Service |
3880ab |
int proto_set = 0;
|
|
Packit Service |
3880ab |
__u8 prio;
|
|
Packit Service |
3880ab |
int prio_set = 0;
|
|
Packit Service |
3880ab |
struct tc_vlan parm = {};
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (matches(*argv, "vlan") != 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 (action) {
|
|
Packit Service |
3880ab |
unexpected(*argv);
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
action = TCA_VLAN_ACT_POP;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "push") == 0) {
|
|
Packit Service |
3880ab |
if (action) {
|
|
Packit Service |
3880ab |
unexpected(*argv);
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
action = TCA_VLAN_ACT_PUSH;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "modify") == 0) {
|
|
Packit Service |
3880ab |
if (action) {
|
|
Packit Service |
3880ab |
unexpected(*argv);
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
action = TCA_VLAN_ACT_MODIFY;
|
|
Packit Service |
52590c |
} else if (matches(*argv, "pop_eth") == 0) {
|
|
Packit Service |
52590c |
if (action) {
|
|
Packit Service |
52590c |
unexpected(*argv);
|
|
Packit Service |
52590c |
return -1;
|
|
Packit Service |
52590c |
}
|
|
Packit Service |
52590c |
action = TCA_VLAN_ACT_POP_ETH;
|
|
Packit Service |
52590c |
} else if (matches(*argv, "push_eth") == 0) {
|
|
Packit Service |
52590c |
if (action) {
|
|
Packit Service |
52590c |
unexpected(*argv);
|
|
Packit Service |
52590c |
return -1;
|
|
Packit Service |
52590c |
}
|
|
Packit Service |
52590c |
action = TCA_VLAN_ACT_PUSH_ETH;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "id") == 0) {
|
|
Packit Service |
3880ab |
if (!has_push_attribs(action))
|
|
Packit Service |
3880ab |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u16(&id, *argv, 0))
|
|
Packit Service |
3880ab |
invarg("id is invalid", *argv);
|
|
Packit Service |
3880ab |
id_set = 1;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "protocol") == 0) {
|
|
Packit Service |
3880ab |
if (!has_push_attribs(action))
|
|
Packit Service |
3880ab |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
|
|
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 |
proto_set = 1;
|
|
Packit Service |
3880ab |
} else if (matches(*argv, "priority") == 0) {
|
|
Packit Service |
3880ab |
if (!has_push_attribs(action))
|
|
Packit Service |
3880ab |
invarg("only valid for push/modify", *argv);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
if (get_u8(&prio, *argv, 0) || (prio & ~0x7))
|
|
Packit Service |
3880ab |
invarg("prio is invalid", *argv);
|
|
Packit Service |
3880ab |
prio_set = 1;
|
|
Packit Service |
52590c |
} else if (matches(*argv, "dst_mac") == 0) {
|
|
Packit Service |
52590c |
if (action != TCA_VLAN_ACT_PUSH_ETH)
|
|
Packit Service |
52590c |
invarg("only valid for push_eth", *argv);
|
|
Packit Service |
52590c |
|
|
Packit Service |
52590c |
NEXT_ARG();
|
|
Packit Service |
52590c |
if (ll_addr_a2n(dst_mac, sizeof(dst_mac), *argv) < 0)
|
|
Packit Service |
52590c |
invarg("dst_mac is invalid", *argv);
|
|
Packit Service |
52590c |
dst_mac_set = 1;
|
|
Packit Service |
52590c |
} else if (matches(*argv, "src_mac") == 0) {
|
|
Packit Service |
52590c |
if (action != TCA_VLAN_ACT_PUSH_ETH)
|
|
Packit Service |
52590c |
invarg("only valid for push_eth", *argv);
|
|
Packit Service |
52590c |
|
|
Packit Service |
52590c |
NEXT_ARG();
|
|
Packit Service |
52590c |
if (ll_addr_a2n(src_mac, sizeof(src_mac), *argv) < 0)
|
|
Packit Service |
52590c |
invarg("src_mac is invalid", *argv);
|
|
Packit Service |
52590c |
src_mac_set = 1;
|
|
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 |
argc--;
|
|
Packit Service |
3880ab |
argv++;
|
|
Packit Service |
3880ab |
}
|
|
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 |
fprintf(stderr, "vlan: Illegal \"index\"\n");
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
argc--;
|
|
Packit Service |
3880ab |
argv++;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (has_push_attribs(action) && !id_set) {
|
|
Packit Service |
3880ab |
fprintf(stderr, "id needs to be set for %s\n",
|
|
Packit Service |
3880ab |
action_names[action]);
|
|
Packit Service |
3880ab |
explain();
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
52590c |
if (action == TCA_VLAN_ACT_PUSH_ETH) {
|
|
Packit Service |
52590c |
if (!dst_mac_set) {
|
|
Packit Service |
52590c |
fprintf(stderr, "dst_mac needs to be set for %s\n",
|
|
Packit Service |
52590c |
action_names[action]);
|
|
Packit Service |
52590c |
explain();
|
|
Packit Service |
52590c |
return -1;
|
|
Packit Service |
52590c |
} else if (!src_mac_set) {
|
|
Packit Service |
52590c |
fprintf(stderr, "src_mac needs to be set for %s\n",
|
|
Packit Service |
52590c |
action_names[action]);
|
|
Packit Service |
52590c |
explain();
|
|
Packit Service |
52590c |
return -1;
|
|
Packit Service |
52590c |
}
|
|
Packit Service |
52590c |
}
|
|
Packit Service |
52590c |
|
|
Packit Service |
3880ab |
parm.v_action = action;
|
|
Packit Service |
3880ab |
tail = addattr_nest(n, MAX_MSG, tca_id);
|
|
Packit Service |
3880ab |
addattr_l(n, MAX_MSG, TCA_VLAN_PARMS, &parm, sizeof(parm));
|
|
Packit Service |
3880ab |
if (id_set)
|
|
Packit Service |
3880ab |
addattr_l(n, MAX_MSG, TCA_VLAN_PUSH_VLAN_ID, &id, 2);
|
|
Packit Service |
3880ab |
if (proto_set) {
|
|
Packit Service |
3880ab |
if (proto != htons(ETH_P_8021Q) &&
|
|
Packit Service |
3880ab |
proto != htons(ETH_P_8021AD)) {
|
|
Packit Service |
3880ab |
fprintf(stderr, "protocol not supported\n");
|
|
Packit Service |
3880ab |
explain();
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
addattr_l(n, MAX_MSG, TCA_VLAN_PUSH_VLAN_PROTOCOL, &proto, 2);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (prio_set)
|
|
Packit Service |
3880ab |
addattr8(n, MAX_MSG, TCA_VLAN_PUSH_VLAN_PRIORITY, prio);
|
|
Packit Service |
52590c |
if (dst_mac_set)
|
|
Packit Service |
52590c |
addattr_l(n, MAX_MSG, TCA_VLAN_PUSH_ETH_DST, dst_mac,
|
|
Packit Service |
52590c |
sizeof(dst_mac));
|
|
Packit Service |
52590c |
if (src_mac_set)
|
|
Packit Service |
52590c |
addattr_l(n, MAX_MSG, TCA_VLAN_PUSH_ETH_SRC, src_mac,
|
|
Packit Service |
52590c |
sizeof(src_mac));
|
|
Packit Service |
3880ab |
|
|
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_vlan(struct action_util *au, FILE *f, struct rtattr *arg)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
SPRINT_BUF(b1);
|
|
Packit Service |
3880ab |
struct rtattr *tb[TCA_VLAN_MAX + 1];
|
|
Packit Service |
3880ab |
__u16 val;
|
|
Packit Service |
3880ab |
struct tc_vlan *parm;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (arg == NULL)
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
parse_rtattr_nested(tb, TCA_VLAN_MAX, arg);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (!tb[TCA_VLAN_PARMS]) {
|
|
Packit Service |
860483 |
fprintf(stderr, "Missing vlan parameters\n");
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
parm = RTA_DATA(tb[TCA_VLAN_PARMS]);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
print_string(PRINT_ANY, "kind", "%s ", "vlan");
|
|
Packit Service |
3880ab |
print_string(PRINT_ANY, "vlan_action", " %s",
|
|
Packit Service |
3880ab |
action_names[parm->v_action]);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
switch (parm->v_action) {
|
|
Packit Service |
3880ab |
case TCA_VLAN_ACT_PUSH:
|
|
Packit Service |
3880ab |
case TCA_VLAN_ACT_MODIFY:
|
|
Packit Service |
3880ab |
if (tb[TCA_VLAN_PUSH_VLAN_ID]) {
|
|
Packit Service |
3880ab |
val = rta_getattr_u16(tb[TCA_VLAN_PUSH_VLAN_ID]);
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "id", " id %u", val);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (tb[TCA_VLAN_PUSH_VLAN_PROTOCOL]) {
|
|
Packit Service |
3880ab |
__u16 proto;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
proto = rta_getattr_u16(tb[TCA_VLAN_PUSH_VLAN_PROTOCOL]);
|
|
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 |
if (tb[TCA_VLAN_PUSH_VLAN_PRIORITY]) {
|
|
Packit Service |
3880ab |
val = rta_getattr_u8(tb[TCA_VLAN_PUSH_VLAN_PRIORITY]);
|
|
Packit Service |
3880ab |
print_uint(PRINT_ANY, "priority", " priority %u", val);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
break;
|
|
Packit Service |
52590c |
case TCA_VLAN_ACT_PUSH_ETH:
|
|
Packit Service |
52590c |
if (tb[TCA_VLAN_PUSH_ETH_DST] &&
|
|
Packit Service |
52590c |
RTA_PAYLOAD(tb[TCA_VLAN_PUSH_ETH_DST]) == ETH_ALEN) {
|
|
Packit Service |
52590c |
ll_addr_n2a(RTA_DATA(tb[TCA_VLAN_PUSH_ETH_DST]),
|
|
Packit Service |
52590c |
ETH_ALEN, 0, b1, sizeof(b1));
|
|
Packit Service |
52590c |
print_string(PRINT_ANY, "dst_mac", " dst_mac %s", b1);
|
|
Packit Service |
52590c |
}
|
|
Packit Service |
52590c |
if (tb[TCA_VLAN_PUSH_ETH_SRC &&
|
|
Packit Service |
52590c |
RTA_PAYLOAD(tb[TCA_VLAN_PUSH_ETH_SRC]) == ETH_ALEN]) {
|
|
Packit Service |
52590c |
ll_addr_n2a(RTA_DATA(tb[TCA_VLAN_PUSH_ETH_SRC]),
|
|
Packit Service |
52590c |
ETH_ALEN, 0, b1, sizeof(b1));
|
|
Packit Service |
52590c |
print_string(PRINT_ANY, "src_mac", " src_mac %s", b1);
|
|
Packit Service |
52590c |
}
|
|
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_VLAN_TM]) {
|
|
Packit Service |
3880ab |
struct tcf_t *tm = RTA_DATA(tb[TCA_VLAN_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 vlan_action_util = {
|
|
Packit Service |
3880ab |
.id = "vlan",
|
|
Packit Service |
3880ab |
.parse_aopt = parse_vlan,
|
|
Packit Service |
3880ab |
.print_aopt = print_vlan,
|
|
Packit Service |
3880ab |
};
|