[mirror_iproute2.git] / ip / iplink_vlan.c

/*
 * iplink_vlan.c	VLAN device support
 *
 *              This program is free software; you can redistribute it and/or
 *              modify it under the terms of the GNU General Public License
 *              as published by the Free Software Foundation; either version
 *              2 of the License, or (at your option) any later version.
 *
 * Authors:     Patrick McHardy <kaber@trash.net>
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <linux/if_vlan.h>

#include "rt_names.h"
#include "utils.h"
#include "ip_common.h"

static void print_explain(FILE *f)
{
	fprintf(f,
		"Usage: ... vlan [ protocol VLANPROTO ] id VLANID"
		"                [ FLAG-LIST ]\n"
		"                [ ingress-qos-map QOS-MAP ] [ egress-qos-map QOS-MAP ]\n"
		"\n"
		"VLANPROTO: [ 802.1Q / 802.1ad ]\n"
		"VLANID := 0-4095\n"
		"FLAG-LIST := [ FLAG-LIST ] FLAG\n"
		"FLAG := [ reorder_hdr { on | off } ] [ gvrp { on | off } ] [ mvrp { on | off } ]\n"
		"        [ loose_binding { on | off } ]\n"
		"QOS-MAP := [ QOS-MAP ] QOS-MAPPING\n"
		"QOS-MAPPING := FROM:TO\n"
	);
}

static void explain(void)
{
	print_explain(stderr);
}

static int on_off(const char *msg, const char *arg)
{
	fprintf(stderr, "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n", msg, arg);
	return -1;
}

static int vlan_parse_qos_map(int *argcp, char ***argvp, struct nlmsghdr *n,
			      int attrtype)
{
	int argc = *argcp;
	char **argv = *argvp;
	struct ifla_vlan_qos_mapping m;
	struct rtattr *tail;

	tail = NLMSG_TAIL(n);
	addattr_l(n, 1024, attrtype, NULL, 0);

	while (argc > 0) {
		char *colon = strchr(*argv, ':');

		if (!colon)
			break;
		*colon = '\0';

		if (get_u32(&m.from, *argv, 0))
			return 1;
		if (get_u32(&m.to, colon + 1, 0))
			return 1;
		argc--, argv++;

		addattr_l(n, 1024, IFLA_VLAN_QOS_MAPPING, &m, sizeof(m));
	}

	tail->rta_len = (void *) NLMSG_TAIL(n) - (void *)tail;

	*argcp = argc;
	*argvp = argv;
	return 0;
}

static int vlan_parse_opt(struct link_util *lu, int argc, char **argv,
			  struct nlmsghdr *n)
{
	struct ifla_vlan_flags flags = { 0 };
	__u16 id, proto;

	while (argc > 0) {
		if (matches(*argv, "protocol") == 0) {
			NEXT_ARG();
			if (ll_proto_a2n(&proto, *argv))
				invarg("protocol is invalid", *argv);
			addattr_l(n, 1024, IFLA_VLAN_PROTOCOL, &proto, 2);
		} else if (matches(*argv, "id") == 0) {
			NEXT_ARG();
			if (get_u16(&id, *argv, 0))
				invarg("id is invalid", *argv);
			addattr_l(n, 1024, IFLA_VLAN_ID, &id, 2);
		} else if (matches(*argv, "reorder_hdr") == 0) {
			NEXT_ARG();
			flags.mask |= VLAN_FLAG_REORDER_HDR;
			if (strcmp(*argv, "on") == 0)
				flags.flags |= VLAN_FLAG_REORDER_HDR;
			else if (strcmp(*argv, "off") == 0)
				flags.flags &= ~VLAN_FLAG_REORDER_HDR;
			else
				return on_off("reorder_hdr", *argv);
		} else if (matches(*argv, "gvrp") == 0) {
			NEXT_ARG();
			flags.mask |= VLAN_FLAG_GVRP;
			if (strcmp(*argv, "on") == 0)
				flags.flags |= VLAN_FLAG_GVRP;
			else if (strcmp(*argv, "off") == 0)
				flags.flags &= ~VLAN_FLAG_GVRP;
			else
				return on_off("gvrp", *argv);
		} else if (matches(*argv, "mvrp") == 0) {
			NEXT_ARG();
			flags.mask |= VLAN_FLAG_MVRP;
			if (strcmp(*argv, "on") == 0)
				flags.flags |= VLAN_FLAG_MVRP;
			else if (strcmp(*argv, "off") == 0)
				flags.flags &= ~VLAN_FLAG_MVRP;
			else
				return on_off("mvrp", *argv);
		} else if (matches(*argv, "loose_binding") == 0) {
			NEXT_ARG();
			flags.mask |= VLAN_FLAG_LOOSE_BINDING;
			if (strcmp(*argv, "on") == 0)
				flags.flags |= VLAN_FLAG_LOOSE_BINDING;
			else if (strcmp(*argv, "off") == 0)
				flags.flags &= ~VLAN_FLAG_LOOSE_BINDING;
			else
				return on_off("loose_binding", *argv);
		} else if (matches(*argv, "ingress-qos-map") == 0) {
			NEXT_ARG();
			if (vlan_parse_qos_map(&argc, &argv, n,
					       IFLA_VLAN_INGRESS_QOS))
				invarg("invalid ingress-qos-map", *argv);
			continue;
		} else if (matches(*argv, "egress-qos-map") == 0) {
			NEXT_ARG();
			if (vlan_parse_qos_map(&argc, &argv, n,
					       IFLA_VLAN_EGRESS_QOS))
				invarg("invalid egress-qos-map", *argv);
			continue;
		} else if (matches(*argv, "help") == 0) {
			explain();
			return -1;
		} else {
			fprintf(stderr, "vlan: unknown command \"%s\"?\n", *argv);
			explain();
			return -1;
		}
		argc--, argv++;
	}

	if (flags.mask)
		addattr_l(n, 1024, IFLA_VLAN_FLAGS, &flags, sizeof(flags));

	return 0;
}

static void vlan_print_map(FILE *f, char *name, struct rtattr *attr)
{
	struct ifla_vlan_qos_mapping *m;
	struct rtattr *i;
	int rem;

	fprintf(f, "\n      %s { ", name);

	rem = RTA_PAYLOAD(attr);
	for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) {
		m = RTA_DATA(i);
		fprintf(f, "%u:%u ", m->from, m->to);
	}
	fprintf(f, "} ");
}

static void vlan_print_flags(FILE *fp, __u32 flags)
{
	fprintf(fp, "<");
#define _PF(f)	if (flags & VLAN_FLAG_##f) { \
			flags &= ~ VLAN_FLAG_##f; \
			fprintf(fp, #f "%s", flags ? "," : ""); \
		}
	_PF(REORDER_HDR);
	_PF(GVRP);
	_PF(MVRP);
	_PF(LOOSE_BINDING);
#undef _PF
	if (flags)
		fprintf(fp, "%x", flags);
	fprintf(fp, "> ");
}

static void vlan_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[])
{
	struct ifla_vlan_flags *flags;
	SPRINT_BUF(b1);

	if (!tb)
		return;

	if (tb[IFLA_VLAN_PROTOCOL] &&
	    RTA_PAYLOAD(tb[IFLA_VLAN_PROTOCOL]) < sizeof(__u16))
		return;
	if (!tb[IFLA_VLAN_ID] ||
	    RTA_PAYLOAD(tb[IFLA_VLAN_ID]) < sizeof(__u16))
		return;

	if (tb[IFLA_VLAN_PROTOCOL])
		fprintf(f, "protocol %s ",
			ll_proto_n2a(rta_getattr_u16(tb[IFLA_VLAN_PROTOCOL]),
				     b1, sizeof(b1)));
	else
		fprintf(f, "protocol 802.1q ");

	fprintf(f, "id %u ", rta_getattr_u16(tb[IFLA_VLAN_ID]));

	if (tb[IFLA_VLAN_FLAGS]) {
		if (RTA_PAYLOAD(tb[IFLA_VLAN_FLAGS]) < sizeof(*flags))
			return;
		flags = RTA_DATA(tb[IFLA_VLAN_FLAGS]);
		vlan_print_flags(f, flags->flags);
	}
	if (tb[IFLA_VLAN_INGRESS_QOS])
		vlan_print_map(f, "ingress-qos-map", tb[IFLA_VLAN_INGRESS_QOS]);
	if (tb[IFLA_VLAN_EGRESS_QOS])
		vlan_print_map(f, "egress-qos-map", tb[IFLA_VLAN_EGRESS_QOS]);
}

static void vlan_print_help(struct link_util *lu, int argc, char **argv,
	FILE *f)
{
	print_explain(f);
}

struct link_util vlan_link_util = {
	.id		= "vlan",
	.maxattr	= IFLA_VLAN_MAX,
	.parse_opt	= vlan_parse_opt,
	.print_opt	= vlan_print_opt,
	.print_help	= vlan_print_help,
};
Commit	Line	Data
5c302d51 PM	1	/*
	2	* iplink_vlan.c VLAN device support
	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
	7	* 2 of the License, or (at your option) any later version.
	8	*
	9	* Authors: Patrick McHardy <kaber@trash.net>
	10	*/
	11
	12	#include <stdio.h>
	13	#include <stdlib.h>
	14	#include <string.h>
	15	#include <linux/if_vlan.h>
	16
	17	#include "rt_names.h"
	18	#include "utils.h"
	19	#include "ip_common.h"
	20
561e650e	21	static void print_explain(FILE *f)
5c302d51	22	{
561e650e	23	fprintf(f,
8fd8f6ed PM	24	"Usage: ... vlan [ protocol VLANPROTO ] id VLANID"
	25	" [ FLAG-LIST ]\n"
	26	" [ ingress-qos-map QOS-MAP ] [ egress-qos-map QOS-MAP ]\n"
5c302d51	27	"\n"
8fd8f6ed	28	"VLANPROTO: [ 802.1Q / 802.1ad ]\n"
5c302d51 PM	29	"VLANID := 0-4095\n"
5c302d51 PM	30	"FLAG-LIST := [ FLAG-LIST ] FLAG\n"
4e9a6860	31	"FLAG := [ reorder_hdr { on \| off } ] [ gvrp { on \| off } ] [ mvrp { on \| off } ]\n"
2180b6b5	32	" [ loose_binding { on \| off } ]\n"
5c302d51 PM	33	"QOS-MAP := [ QOS-MAP ] QOS-MAPPING\n"
	34	"QOS-MAPPING := FROM:TO\n"
	35	);
	36	}
	37
561e650e	38	static void explain(void)
	39	{
	40	print_explain(stderr);
	41	}
	42
14645ec2	43	static int on_off(const char msg, const char arg)
5c302d51	44	{
14645ec2	45	fprintf(stderr, "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n", msg, arg);
5c302d51 PM	46	return -1;
	47	}
	48
	49	static int vlan_parse_qos_map(int argcp, char *argvp, struct nlmsghdr n,
	50	int attrtype)
	51	{
	52	int argc = *argcp;
	53	char *argv = argvp;
	54	struct ifla_vlan_qos_mapping m;
	55	struct rtattr *tail;
	56
	57	tail = NLMSG_TAIL(n);
	58	addattr_l(n, 1024, attrtype, NULL, 0);
	59
	60	while (argc > 0) {
	61	char colon = strchr(argv, ':');
	62
	63	if (!colon)
	64	break;
	65	*colon = '\0';
	66
	67	if (get_u32(&m.from, *argv, 0))
	68	return 1;
	69	if (get_u32(&m.to, colon + 1, 0))
	70	return 1;
	71	argc--, argv++;
	72
	73	addattr_l(n, 1024, IFLA_VLAN_QOS_MAPPING, &m, sizeof(m));
	74	}
	75
	76	tail->rta_len = (void ) NLMSG_TAIL(n) - (void )tail;
	77
	78	*argcp = argc;
	79	*argvp = argv;
	80	return 0;
	81	}
	82
	83	static int vlan_parse_opt(struct link_util lu, int argc, char *argv,
	84	struct nlmsghdr *n)
	85	{
	86	struct ifla_vlan_flags flags = { 0 };
8fd8f6ed	87	__u16 id, proto;
5c302d51 PM	88
5c302d51 PM	89	while (argc > 0) {
8fd8f6ed PM	90	if (matches(*argv, "protocol") == 0) {
	91	NEXT_ARG();
	92	if (ll_proto_a2n(&proto, *argv))
	93	invarg("protocol is invalid", *argv);
	94	addattr_l(n, 1024, IFLA_VLAN_PROTOCOL, &proto, 2);
	95	} else if (matches(*argv, "id") == 0) {
5c302d51 PM	96	NEXT_ARG();
	97	if (get_u16(&id, *argv, 0))
	98	invarg("id is invalid", *argv);
	99	addattr_l(n, 1024, IFLA_VLAN_ID, &id, 2);
	100	} else if (matches(*argv, "reorder_hdr") == 0) {
	101	NEXT_ARG();
	102	flags.mask \|= VLAN_FLAG_REORDER_HDR;
	103	if (strcmp(*argv, "on") == 0)
	104	flags.flags \|= VLAN_FLAG_REORDER_HDR;
	105	else if (strcmp(*argv, "off") == 0)
	106	flags.flags &= ~VLAN_FLAG_REORDER_HDR;
	107	else
14645ec2	108	return on_off("reorder_hdr", *argv);
47420640 PM	109	} else if (matches(*argv, "gvrp") == 0) {
	110	NEXT_ARG();
	111	flags.mask \|= VLAN_FLAG_GVRP;
	112	if (strcmp(*argv, "on") == 0)
	113	flags.flags \|= VLAN_FLAG_GVRP;
	114	else if (strcmp(*argv, "off") == 0)
	115	flags.flags &= ~VLAN_FLAG_GVRP;
	116	else
14645ec2	117	return on_off("gvrp", *argv);
4e9a6860 DW	118	} else if (matches(*argv, "mvrp") == 0) {
	119	NEXT_ARG();
	120	flags.mask \|= VLAN_FLAG_MVRP;
	121	if (strcmp(*argv, "on") == 0)
	122	flags.flags \|= VLAN_FLAG_MVRP;
	123	else if (strcmp(*argv, "off") == 0)
	124	flags.flags &= ~VLAN_FLAG_MVRP;
	125	else
	126	return on_off("mvrp", *argv);
2180b6b5 PM	127	} else if (matches(*argv, "loose_binding") == 0) {
	128	NEXT_ARG();
	129	flags.mask \|= VLAN_FLAG_LOOSE_BINDING;
	130	if (strcmp(*argv, "on") == 0)
	131	flags.flags \|= VLAN_FLAG_LOOSE_BINDING;
	132	else if (strcmp(*argv, "off") == 0)
	133	flags.flags &= ~VLAN_FLAG_LOOSE_BINDING;
	134	else
14645ec2	135	return on_off("loose_binding", *argv);
5c302d51 PM	136	} else if (matches(*argv, "ingress-qos-map") == 0) {
	137	NEXT_ARG();
	138	if (vlan_parse_qos_map(&argc, &argv, n,
	139	IFLA_VLAN_INGRESS_QOS))
	140	invarg("invalid ingress-qos-map", *argv);
	141	continue;
	142	} else if (matches(*argv, "egress-qos-map") == 0) {
	143	NEXT_ARG();
	144	if (vlan_parse_qos_map(&argc, &argv, n,
	145	IFLA_VLAN_EGRESS_QOS))
	146	invarg("invalid egress-qos-map", *argv);
	147	continue;
	148	} else if (matches(*argv, "help") == 0) {
	149	explain();
	150	return -1;
	151	} else {
14645ec2	152	fprintf(stderr, "vlan: unknown command \"%s\"?\n", *argv);
5c302d51 PM	153	explain();
	154	return -1;
	155	}
	156	argc--, argv++;
	157	}
	158
	159	if (flags.mask)
	160	addattr_l(n, 1024, IFLA_VLAN_FLAGS, &flags, sizeof(flags));
	161
	162	return 0;
	163	}
	164
	165	static void vlan_print_map(FILE f, char name, struct rtattr *attr)
	166	{
	167	struct ifla_vlan_qos_mapping *m;
	168	struct rtattr *i;
	169	int rem;
	170
	171	fprintf(f, "\n %s { ", name);
	172
	173	rem = RTA_PAYLOAD(attr);
	174	for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) {
	175	m = RTA_DATA(i);
	176	fprintf(f, "%u:%u ", m->from, m->to);
	177	}
	178	fprintf(f, "} ");
	179	}
	180
	181	static void vlan_print_flags(FILE *fp, __u32 flags)
	182	{
	183	fprintf(fp, "<");
	184	#define _PF(f) if (flags & VLAN_FLAG_##f) { \
	185	flags &= ~ VLAN_FLAG_##f; \
	186	fprintf(fp, #f "%s", flags ? "," : ""); \
	187	}
	188	_PF(REORDER_HDR);
47420640	189	_PF(GVRP);
4e9a6860	190	_PF(MVRP);
2180b6b5	191	_PF(LOOSE_BINDING);
5c302d51 PM	192	#undef _PF
	193	if (flags)
	194	fprintf(fp, "%x", flags);
	195	fprintf(fp, "> ");
	196	}
	197
	198	static void vlan_print_opt(struct link_util lu, FILE f, struct rtattr *tb[])
	199	{
	200	struct ifla_vlan_flags *flags;
8fd8f6ed PM	201	SPRINT_BUF(b1);
8fd8f6ed PM	202
5c302d51 PM	203	if (!tb)
	204	return;
	205
8fd8f6ed PM	206	if (tb[IFLA_VLAN_PROTOCOL] &&
	207	RTA_PAYLOAD(tb[IFLA_VLAN_PROTOCOL]) < sizeof(__u16))
	208	return;
5c302d51 PM	209	if (!tb[IFLA_VLAN_ID] \|\|
	210	RTA_PAYLOAD(tb[IFLA_VLAN_ID]) < sizeof(__u16))
	211	return;
	212
8fd8f6ed PM	213	if (tb[IFLA_VLAN_PROTOCOL])
	214	fprintf(f, "protocol %s ",
	215	ll_proto_n2a(rta_getattr_u16(tb[IFLA_VLAN_PROTOCOL]),
	216	b1, sizeof(b1)));
	217	else
	218	fprintf(f, "protocol 802.1q ");
	219
ff24746c	220	fprintf(f, "id %u ", rta_getattr_u16(tb[IFLA_VLAN_ID]));
5c302d51 PM	221
	222	if (tb[IFLA_VLAN_FLAGS]) {
	223	if (RTA_PAYLOAD(tb[IFLA_VLAN_FLAGS]) < sizeof(*flags))
	224	return;
	225	flags = RTA_DATA(tb[IFLA_VLAN_FLAGS]);
	226	vlan_print_flags(f, flags->flags);
	227	}
	228	if (tb[IFLA_VLAN_INGRESS_QOS])
	229	vlan_print_map(f, "ingress-qos-map", tb[IFLA_VLAN_INGRESS_QOS]);
	230	if (tb[IFLA_VLAN_EGRESS_QOS])
	231	vlan_print_map(f, "egress-qos-map", tb[IFLA_VLAN_EGRESS_QOS]);
	232	}
	233
561e650e	234	static void vlan_print_help(struct link_util lu, int argc, char *argv,
	235	FILE *f)
	236	{
	237	print_explain(f);
	238	}
	239
5c302d51 PM	240	struct link_util vlan_link_util = {
	241	.id = "vlan",
	242	.maxattr = IFLA_VLAN_MAX,
	243	.parse_opt = vlan_parse_opt,
	244	.print_opt = vlan_print_opt,
561e650e	245	.print_help = vlan_print_help,
5c302d51	246	};