[mirror_iproute2.git] / tc / f_tcindex.c

/*
 * f_tcindex.c		Traffic control index filter
 *
 * Written 1998,1999 by Werner Almesberger
 */

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <syslog.h>
#include <fcntl.h>
#include <string.h>
#include <netinet/in.h>

#include "utils.h"
#include "tc_util.h"

static void explain(void)
{
	fprintf(stderr," Usage: ... tcindex [ hash SIZE ] [ mask MASK ]"
	    " [ shift SHIFT ]\n");
	fprintf(stderr,"                    [ pass_on | fall_through ]\n");
	fprintf(stderr,"                    [ classid CLASSID ] "
	    "[ police POLICE_SPEC ]\n");
}

static int tcindex_parse_opt(struct filter_util *qu, char *handle, int argc,
    char **argv, struct nlmsghdr *n)
{
	struct tcmsg *t = NLMSG_DATA(n);
	struct rtattr *tail;
	char *end;

	if (handle) {
		t->tcm_handle = strtoul(handle,&end,0);
		if (*end) {
			fprintf(stderr, "Illegal filter ID\n");
			return -1;
		}
	}
	if (!argc) return 0;
	tail = NLMSG_TAIL(n);
	addattr_l(n,4096,TCA_OPTIONS,NULL,0);
	while (argc) {
		if (!strcmp(*argv,"hash")) {
			int hash;

			NEXT_ARG();
			hash = strtoul(*argv,&end,0);
			if (*end || !hash || hash > 0x10000) {
				explain();
				return -1;
			}
			addattr_l(n,4096,TCA_TCINDEX_HASH,&hash,sizeof(hash));
		}
		else if (!strcmp(*argv,"mask")) {
			__u16 mask;

			NEXT_ARG();
			mask = strtoul(*argv,&end,0);
			if (*end) {
				explain();
				return -1;
			}
			addattr_l(n,4096,TCA_TCINDEX_MASK,&mask,sizeof(mask));
		}
		else if (!strcmp(*argv,"shift")) {
			int shift;

			NEXT_ARG();
			shift = strtoul(*argv,&end,0);
			if (*end) {
				explain();
				return -1;
			}
			addattr_l(n,4096,TCA_TCINDEX_SHIFT,&shift,
			    sizeof(shift));
		}
		else if (!strcmp(*argv,"fall_through")) {
			int value = 1;

			addattr_l(n,4096,TCA_TCINDEX_FALL_THROUGH,&value,
			    sizeof(value));
		}
		else if (!strcmp(*argv,"pass_on")) {
			int value = 0;

			addattr_l(n,4096,TCA_TCINDEX_FALL_THROUGH,&value,
			    sizeof(value));
		}
		else if (!strcmp(*argv,"classid")) {
			__u32 handle;

			NEXT_ARG();
			if (get_tc_classid(&handle,*argv)) {
				fprintf(stderr, "Illegal \"classid\"\n");
				return -1;
			}
			addattr_l(n, 4096, TCA_TCINDEX_CLASSID, &handle, 4);
		}
		else if (!strcmp(*argv,"police")) {
			NEXT_ARG();
			if (parse_police(&argc, &argv, TCA_TCINDEX_POLICE, n)) {
				fprintf(stderr, "Illegal \"police\"\n");
				return -1;
			}
			continue;
		}
		else {
			explain();
			return -1;
		}
		argc--;
		argv++;
	}
	tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
	return 0;
}


static int tcindex_print_opt(struct filter_util *qu, FILE *f,
     struct rtattr *opt, __u32 handle)
{
	struct rtattr *tb[TCA_TCINDEX_MAX+1];

	if (opt == NULL)
		return 0;

	parse_rtattr_nested(tb, TCA_TCINDEX_MAX, opt);

	if (handle != ~0) fprintf(f,"handle 0x%04x ",handle);
	if (tb[TCA_TCINDEX_HASH]) {
		__u16 hash;

		if (RTA_PAYLOAD(tb[TCA_TCINDEX_HASH]) < sizeof(hash))
			return -1;
		hash = rta_getattr_u16(tb[TCA_TCINDEX_HASH]);
		fprintf(f,"hash %d ",hash);
	}
	if (tb[TCA_TCINDEX_MASK]) {
		__u16 mask;

		if (RTA_PAYLOAD(tb[TCA_TCINDEX_MASK]) < sizeof(mask))
			return -1;
		mask = rta_getattr_u16(tb[TCA_TCINDEX_MASK]);
		fprintf(f,"mask 0x%04x ",mask);
	}
	if (tb[TCA_TCINDEX_SHIFT]) {
		int shift;

		if (RTA_PAYLOAD(tb[TCA_TCINDEX_SHIFT]) < sizeof(shift))
			return -1;
		shift = *(int *) RTA_DATA(tb[TCA_TCINDEX_SHIFT]);
		fprintf(f,"shift %d ",shift);
	}
	if (tb[TCA_TCINDEX_FALL_THROUGH]) {
		int fall_through;

		if (RTA_PAYLOAD(tb[TCA_TCINDEX_FALL_THROUGH]) <
		    sizeof(fall_through))
			return -1;
		fall_through = *(int *) RTA_DATA(tb[TCA_TCINDEX_FALL_THROUGH]);
		fprintf(f,fall_through ? "fall_through " : "pass_on ");
	}
	if (tb[TCA_TCINDEX_CLASSID]) {
		SPRINT_BUF(b1);
		fprintf(f, "classid %s ",sprint_tc_classid(*(__u32 *)
		    RTA_DATA(tb[TCA_TCINDEX_CLASSID]), b1));
	}
	if (tb[TCA_TCINDEX_POLICE]) {
		fprintf(f, "\n");
		tc_print_police(f, tb[TCA_TCINDEX_POLICE]);
	}
	return 0;
}

struct filter_util tcindex_filter_util = {
	.id = "tcindex",
	.parse_fopt = tcindex_parse_opt,
	.print_fopt = tcindex_print_opt,
};
Commit	Line	Data
aba5acdf SH	1	/*
	2	* f_tcindex.c Traffic control index filter
	3	*
	4	* Written 1998,1999 by Werner Almesberger
	5	*/
	6
	7	#include <stdio.h>
	8	#include <stdlib.h>
	9	#include <unistd.h>
	10	#include <syslog.h>
	11	#include <fcntl.h>
	12	#include <string.h>
	13	#include <netinet/in.h>
	14
	15	#include "utils.h"
	16	#include "tc_util.h"
	17
	18	static void explain(void)
	19	{
	20	fprintf(stderr," Usage: ... tcindex [ hash SIZE ] [ mask MASK ]"
	21	" [ shift SHIFT ]\n");
	22	fprintf(stderr," [ pass_on \| fall_through ]\n");
	23	fprintf(stderr," [ classid CLASSID ] "
	24	"[ police POLICE_SPEC ]\n");
	25	}
	26
aba5acdf SH	27	static int tcindex_parse_opt(struct filter_util qu, char handle, int argc,
	28	char *argv, struct nlmsghdr n)
	29	{
	30	struct tcmsg *t = NLMSG_DATA(n);
	31	struct rtattr *tail;
	32	char *end;
	33
	34	if (handle) {
	35	t->tcm_handle = strtoul(handle,&end,0);
	36	if (*end) {
	37	fprintf(stderr, "Illegal filter ID\n");
	38	return -1;
	39	}
	40	}
	41	if (!argc) return 0;
3b3ecd31	42	tail = NLMSG_TAIL(n);
aba5acdf SH	43	addattr_l(n,4096,TCA_OPTIONS,NULL,0);
	44	while (argc) {
	45	if (!strcmp(*argv,"hash")) {
	46	int hash;
	47
	48	NEXT_ARG();
	49	hash = strtoul(*argv,&end,0);
	50	if (*end \|\| !hash \|\| hash > 0x10000) {
	51	explain();
	52	return -1;
	53	}
	54	addattr_l(n,4096,TCA_TCINDEX_HASH,&hash,sizeof(hash));
	55	}
	56	else if (!strcmp(*argv,"mask")) {
	57	__u16 mask;
	58
	59	NEXT_ARG();
	60	mask = strtoul(*argv,&end,0);
	61	if (*end) {
	62	explain();
	63	return -1;
	64	}
	65	addattr_l(n,4096,TCA_TCINDEX_MASK,&mask,sizeof(mask));
	66	}
	67	else if (!strcmp(*argv,"shift")) {
	68	int shift;
	69
	70	NEXT_ARG();
	71	shift = strtoul(*argv,&end,0);
	72	if (*end) {
	73	explain();
	74	return -1;
	75	}
	76	addattr_l(n,4096,TCA_TCINDEX_SHIFT,&shift,
	77	sizeof(shift));
	78	}
	79	else if (!strcmp(*argv,"fall_through")) {
	80	int value = 1;
	81
	82	addattr_l(n,4096,TCA_TCINDEX_FALL_THROUGH,&value,
	83	sizeof(value));
	84	}
	85	else if (!strcmp(*argv,"pass_on")) {
	86	int value = 0;
	87
	88	addattr_l(n,4096,TCA_TCINDEX_FALL_THROUGH,&value,
	89	sizeof(value));
	90	}
	91	else if (!strcmp(*argv,"classid")) {
	92	__u32 handle;
	93
	94	NEXT_ARG();
	95	if (get_tc_classid(&handle,*argv)) {
	96	fprintf(stderr, "Illegal \"classid\"\n");
	97	return -1;
	98	}
	99	addattr_l(n, 4096, TCA_TCINDEX_CLASSID, &handle, 4);
	100	}
	101	else if (!strcmp(*argv,"police")) {
	102	NEXT_ARG();
	103	if (parse_police(&argc, &argv, TCA_TCINDEX_POLICE, n)) {
	104	fprintf(stderr, "Illegal \"police\"\n");
	105	return -1;
	106	}
107	continue;
108	}
109	else {
110	explain();
111	return -1;
112	}
113	argc--;
114	argv++;
115	}
3b3ecd31	116	tail->rta_len = (void ) NLMSG_TAIL(n) - (void ) tail;
aba5acdf SH	117	return 0;
	118	}
	119
	120
	121	static int tcindex_print_opt(struct filter_util qu, FILE f,
	122	struct rtattr *opt, __u32 handle)
	123	{
	124	struct rtattr *tb[TCA_TCINDEX_MAX+1];
	125
3b3ecd31	126	if (opt == NULL)
3b3ecd31	127	return 0;
aba5acdf	128
3b3ecd31	129	parse_rtattr_nested(tb, TCA_TCINDEX_MAX, opt);
aba5acdf SH	130
	131	if (handle != ~0) fprintf(f,"handle 0x%04x ",handle);
	132	if (tb[TCA_TCINDEX_HASH]) {
	133	__u16 hash;
	134
	135	if (RTA_PAYLOAD(tb[TCA_TCINDEX_HASH]) < sizeof(hash))
	136	return -1;
ff24746c	137	hash = rta_getattr_u16(tb[TCA_TCINDEX_HASH]);
aba5acdf SH	138	fprintf(f,"hash %d ",hash);
	139	}
	140	if (tb[TCA_TCINDEX_MASK]) {
	141	__u16 mask;
	142
	143	if (RTA_PAYLOAD(tb[TCA_TCINDEX_MASK]) < sizeof(mask))
	144	return -1;
ff24746c	145	mask = rta_getattr_u16(tb[TCA_TCINDEX_MASK]);
aba5acdf SH	146	fprintf(f,"mask 0x%04x ",mask);
	147	}
	148	if (tb[TCA_TCINDEX_SHIFT]) {
	149	int shift;
	150
	151	if (RTA_PAYLOAD(tb[TCA_TCINDEX_SHIFT]) < sizeof(shift))
	152	return -1;
	153	shift = (int ) RTA_DATA(tb[TCA_TCINDEX_SHIFT]);
	154	fprintf(f,"shift %d ",shift);
	155	}
	156	if (tb[TCA_TCINDEX_FALL_THROUGH]) {
	157	int fall_through;
	158
	159	if (RTA_PAYLOAD(tb[TCA_TCINDEX_FALL_THROUGH]) <
	160	sizeof(fall_through))
	161	return -1;
	162	fall_through = (int ) RTA_DATA(tb[TCA_TCINDEX_FALL_THROUGH]);
	163	fprintf(f,fall_through ? "fall_through " : "pass_on ");
	164	}
	165	if (tb[TCA_TCINDEX_CLASSID]) {
	166	SPRINT_BUF(b1);
	167	fprintf(f, "classid %s ",sprint_tc_classid((__u32 )
	168	RTA_DATA(tb[TCA_TCINDEX_CLASSID]), b1));
	169	}
	170	if (tb[TCA_TCINDEX_POLICE]) {
	171	fprintf(f, "\n");
	172	tc_print_police(f, tb[TCA_TCINDEX_POLICE]);
	173	}
	174	return 0;
	175	}
	176
6b7dff17 SH	177	struct filter_util tcindex_filter_util = {
	178	.id = "tcindex",
	179	.parse_fopt = tcindex_parse_opt,
	180	.print_fopt = tcindex_print_opt,
aba5acdf	181	};